rtw89: add Realtek 802.11ax driver
Subsystems (3)
Ping-Ke Shih
maintainercover rtw89: add Realtek 802.11ax driver
This driver named rtw89, which is the next generation of rtw88, supports Realtek 8852AE 802.11ax 2x2 chip whose new features are OFDMA, DBCC, Spatial reuse, TWT and BSS coloring; now some of them aren't implemented though.
The chip architecture is entirely different from the chips supported by rtw88 like RTL8822CE 802.11ac chip. First of all, register address ranges are totally redefined, so it's impossible to reuse register definition. To communicate with firmware, new H2C/C2H format is proposed. In order to have better utilization, TX DMA flow is changed to two stages DMA. To provide rich RX status information, additional RX PPDU packets are added.
Since there are so many differences mentioned above, we decide to propose a new driver. It has many authors, they are listed in alphabetic order:
Chin-Yen Lee <[email protected]>
Ping-Ke Shih <[email protected]>
Po Hao Huang <[email protected]>
Tzu-En Huang <[email protected]>
Vincent Fann <[email protected]>
Yan-Hsuan Chuang <[email protected]>
Zong-Zhe Yang <[email protected]>
v5:
- add OFDMA feature
- improve BT coexistence performance
- improve power save mode
- support SAR
- fine tune performance
- firmware: rtw89: 8852a: update fw to v0.13.24.0
https://github.com/pkshih/linux-firmware.git pick the commit a5b79c4790da3eb3690e23554225ef8db464f2c6
v4:
- add basic BT coexistence features
- add power save mode, so an new patch (two files) is added
- fine tune performance
- add debugfs for debugging coex, bb, ...
v3:
- fix "networking block comments" reported by checkpatch
- Add MODULE_DEVICE_TABLE() generated by Thomas Backlund <[email protected]>
- Add missed BB settings
- error handle of RX BD and DESC length
- reduce debug level of C2H ACKs
- fix rekey failure due to wrong operator
v2:
- fix compiler warnings made by W=1
- sort header file alphabetically
- fix "networking block comments" reported by checkpatch
Ping-Ke Shih (24):
rtw89: add CAM files
rtw89: add BT coexistence files
rtw89: add core and trx files
rtw89: add debug files
rtw89: add efuse files
rtw89: add files to download and communicate with firmware
rtw89: add MAC files
rtw89: implement mac80211 ops
rtw89: add pci files
rtw89: add phy files
rtw89: define register names
rtw89: add regulatory support
rtw89: 8852a: add 8852a specific files
rtw89: 8852a: add 8852a RFK files
rtw89: 8852a: add 8852a RFK tables
rtw89: 8852a: add 8852a tables (1 of 5)
rtw89: 8852a: add 8852a tables (2 of 5)
rtw89: 8852a: add 8852a tables (3 of 5)
rtw89: 8852a: add 8852a tables (4 of 5)
rtw89: 8852a: add 8852a tables (5 of 5)
rtw89: add ser to recover error reported by firmware
rtw89: add PS files
rtw89: add SAR files
rtw89: add Kconfig and Makefile
drivers/net/wireless/realtek/Kconfig | 1 + drivers/net/wireless/realtek/Makefile | 1 + drivers/net/wireless/realtek/rtw89/Kconfig | 50 + drivers/net/wireless/realtek/rtw89/Makefile | 26 + drivers/net/wireless/realtek/rtw89/cam.c | 700 + drivers/net/wireless/realtek/rtw89/cam.h | 165 + drivers/net/wireless/realtek/rtw89/coex.c | 5620 ++ drivers/net/wireless/realtek/rtw89/coex.h | 152 + drivers/net/wireless/realtek/rtw89/core.c | 2359 + drivers/net/wireless/realtek/rtw89/core.h | 3336 ++ drivers/net/wireless/realtek/rtw89/debug.c | 2404 + drivers/net/wireless/realtek/rtw89/debug.h | 77 + drivers/net/wireless/realtek/rtw89/efuse.c | 188 + drivers/net/wireless/realtek/rtw89/efuse.h | 13 + drivers/net/wireless/realtek/rtw89/fw.c | 1599 + drivers/net/wireless/realtek/rtw89/fw.h | 1378 + drivers/net/wireless/realtek/rtw89/mac.c | 4070 ++ drivers/net/wireless/realtek/rtw89/mac.h | 905 + drivers/net/wireless/realtek/rtw89/mac80211.c | 667 + drivers/net/wireless/realtek/rtw89/pci.c | 3030 + drivers/net/wireless/realtek/rtw89/pci.h | 601 + drivers/net/wireless/realtek/rtw89/phy.c | 2736 + drivers/net/wireless/realtek/rtw89/phy.h | 305 + drivers/net/wireless/realtek/rtw89/ps.c | 149 + drivers/net/wireless/realtek/rtw89/ps.h | 15 + drivers/net/wireless/realtek/rtw89/reg.h | 2116 + drivers/net/wireless/realtek/rtw89/regd.c | 353 + drivers/net/wireless/realtek/rtw89/rtw8852a.c | 2083 + drivers/net/wireless/realtek/rtw89/rtw8852a.h | 109 + .../net/wireless/realtek/rtw89/rtw8852a_rfk.c | 3806 ++ .../net/wireless/realtek/rtw89/rtw8852a_rfk.h | 22 + .../realtek/rtw89/rtw8852a_rfk_table.c | 1596 + .../realtek/rtw89/rtw8852a_rfk_table.h | 132 + .../wireless/realtek/rtw89/rtw8852a_table.c | 48725 ++++++++++++++++ .../wireless/realtek/rtw89/rtw8852a_table.h | 28 + drivers/net/wireless/realtek/rtw89/sar.c | 190 + drivers/net/wireless/realtek/rtw89/sar.h | 26 + drivers/net/wireless/realtek/rtw89/ser.c | 491 + drivers/net/wireless/realtek/rtw89/ser.h | 15 + drivers/net/wireless/realtek/rtw89/txrx.h | 393 + drivers/net/wireless/realtek/rtw89/util.c | 37 + drivers/net/wireless/realtek/rtw89/util.h | 31 + 42 files changed, 90700 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/Kconfig create mode 100644 drivers/net/wireless/realtek/rtw89/Makefile create mode 100644 drivers/net/wireless/realtek/rtw89/cam.c create mode 100644 drivers/net/wireless/realtek/rtw89/cam.h create mode 100644 drivers/net/wireless/realtek/rtw89/coex.c create mode 100644 drivers/net/wireless/realtek/rtw89/coex.h create mode 100644 drivers/net/wireless/realtek/rtw89/core.c create mode 100644 drivers/net/wireless/realtek/rtw89/core.h create mode 100644 drivers/net/wireless/realtek/rtw89/debug.c create mode 100644 drivers/net/wireless/realtek/rtw89/debug.h create mode 100644 drivers/net/wireless/realtek/rtw89/efuse.c create mode 100644 drivers/net/wireless/realtek/rtw89/efuse.h create mode 100644 drivers/net/wireless/realtek/rtw89/fw.c create mode 100644 drivers/net/wireless/realtek/rtw89/fw.h create mode 100644 drivers/net/wireless/realtek/rtw89/mac.c create mode 100644 drivers/net/wireless/realtek/rtw89/mac.h create mode 100644 drivers/net/wireless/realtek/rtw89/mac80211.c create mode 100644 drivers/net/wireless/realtek/rtw89/pci.c create mode 100644 drivers/net/wireless/realtek/rtw89/pci.h create mode 100644 drivers/net/wireless/realtek/rtw89/phy.c create mode 100644 drivers/net/wireless/realtek/rtw89/phy.h create mode 100644 drivers/net/wireless/realtek/rtw89/ps.c create mode 100644 drivers/net/wireless/realtek/rtw89/ps.h create mode 100644 drivers/net/wireless/realtek/rtw89/reg.h create mode 100644 drivers/net/wireless/realtek/rtw89/regd.c create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a.c create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a.h create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_rfk.c create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_rfk.h create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_rfk_table.c create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_rfk_table.h create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_table.c create mode 100644 drivers/net/wireless/realtek/rtw89/rtw8852a_table.h create mode 100644 drivers/net/wireless/realtek/rtw89/sar.c create mode 100644 drivers/net/wireless/realtek/rtw89/sar.h create mode 100644 drivers/net/wireless/realtek/rtw89/ser.c create mode 100644 drivers/net/wireless/realtek/rtw89/ser.h create mode 100644 drivers/net/wireless/realtek/rtw89/txrx.h create mode 100644 drivers/net/wireless/realtek/rtw89/util.c create mode 100644 drivers/net/wireless/realtek/rtw89/util.h
Signature · 1 line
2.25.1
Ping-Ke Shih
maintainerPATCH 1/24 rtw89: add CAM files
Three kinds of CAM, security, address and bssid, are implemented in the chip, and then we control them via H2C commands.
Every vif contains one address and one bssid CAM entries, and both are allocated while vif is adding. Once any state is changed, driver notices firmware. For example, add/remove vif, sta assoc/disassoc, and changed security key.
When connecting to an AP with security, a security CAM entry is allocated from security CAM pool and filled key values, and then attached to the address CAM that contains seven keys entries for unicast, group and BIP keys. Since the functions of these seven keys are predefined by firmware, we should attach key to proper position depends on security entry mode and key type.
--- drivers/net/wireless/realtek/rtw89/cam.c | 700 +++++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/cam.h | 165 ++++++ 2 files changed, 865 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/cam.c create mode 100644 drivers/net/wireless/realtek/rtw89/cam.h
drivers/net/wireless/realtek/rtw89/cam.c new file +700 -0
@@ -0,0 +1,700 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "cam.h" +#include "debug.h" +#include "fw.h" +#include "mac.h" + +static struct sk_buff * +rtw89_cam_get_sec_key_cmd (struct rtw89_dev *rtwdev, +struct rtw89_sec_cam_entry *sec_cam, +bool ext_key) +{ +struct sk_buff *skb; +u32 cmd_len =H2C_SEC_CAM_LEN ; +u32 key32[4 ]; +u8 *cmd; +int i, j; + + skb =rtw89_fw_h2c_alloc_skb_with_hdr (cmd_len); +if (!skb) +return NULL ; + +skb_put_zero (skb, cmd_len); + +for (i =0 ; i <4 ; i++) { + j = i *4 ; + j += ext_key ?16 :0 ; + key32[i] =FIELD_PREP (GENMASK (7 ,0 ), sec_cam->key[j +0 ]) | +FIELD_PREP (GENMASK (15 ,8 ), sec_cam->key[j +1 ]) | +FIELD_PREP (GENMASK (23 ,16 ), sec_cam->key[j +2 ]) | +FIELD_PREP (GENMASK (31 ,24 ), sec_cam->key[j +3 ]); + } + + cmd = skb->data; +RTW89_SET_FWCMD_SEC_IDX (cmd, sec_cam->sec_cam_idx + (ext_key ?1 :0 )); +RTW89_SET_FWCMD_SEC_OFFSET (cmd, sec_cam->offset); +RTW89_SET_FWCMD_SEC_LEN (cmd, sec_cam->len); +RTW89_SET_FWCMD_SEC_TYPE (cmd, sec_cam->type); +RTW89_SET_FWCMD_SEC_EXT_KEY (cmd, ext_key); +RTW89_SET_FWCMD_SEC_SPP_MODE (cmd, sec_cam->spp_mode); +RTW89_SET_FWCMD_SEC_KEY0 (cmd, key32[0 ]); +RTW89_SET_FWCMD_SEC_KEY1 (cmd, key32[1 ]); +RTW89_SET_FWCMD_SEC_KEY2 (cmd, key32[2 ]); +RTW89_SET_FWCMD_SEC_KEY3 (cmd, key32[3 ]); + +return skb; +} + +static int rtw89_cam_send_sec_key_cmd (struct rtw89_dev *rtwdev, +struct rtw89_sec_cam_entry *sec_cam) +{ +struct sk_buff *skb, *ext_skb; +int ret; + + skb =rtw89_cam_get_sec_key_cmd (rtwdev, sec_cam, false); +if (!skb) { +rtw89_err (rtwdev,"failed to get sec key command\n" ); +return -ENOMEM ; + } + +rtw89_h2c_pkt_set_hdr (rtwdev, skb, +FWCMD_TYPE_H2C , +H2C_CAT_MAC , +H2C_CL_MAC_SEC_CAM , +H2C_FUNC_MAC_SEC_UPD ,1 ,0 , +H2C_SEC_CAM_LEN ); + ret =rtw89_h2c_tx (rtwdev, skb, false); +if (ret) { +rtw89_err (rtwdev,"failed to send sec key h2c: %d\n" , ret); +dev_kfree_skb (skb); +return ret; + } + +if (!sec_cam->ext_key) +return 0 ; + + ext_skb =rtw89_cam_get_sec_key_cmd (rtwdev, sec_cam, true); +if (!skb) { +rtw89_err (rtwdev,"failed to get ext sec key command\n" ); +return -ENOMEM ; + } + +rtw89_h2c_pkt_set_hdr (rtwdev, ext_skb, +FWCMD_TYPE_H2C , +H2C_CAT_MAC , +H2C_CL_MAC_SEC_CAM , +H2C_FUNC_MAC_SEC_UPD , +1 ,0 ,H2C_SEC_CAM_LEN ); + ret =rtw89_h2c_tx (rtwdev, ext_skb, false); +if (ret) { +rtw89_err (rtwdev,"failed to send ext sec key h2c: %d\n" , ret); +dev_kfree_skb (ext_skb); +return ret; + } + +return 0 ; +} + +static int rtw89_cam_get_avail_sec_cam (struct rtw89_dev *rtwdev, +u8 *sec_cam_idx,bool ext_key) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +u8 sec_cam_num = chip->scam_num; +u8 idx =0 ; + +if (!ext_key) { + idx =find_first_zero_bit (cam_info->sec_cam_map, sec_cam_num); +if (idx >= sec_cam_num) +return -EBUSY ; + +set_bit (idx, cam_info->sec_cam_map); + *sec_cam_idx = idx; + +return 0 ; + } + +again: + idx =find_next_zero_bit (cam_info->sec_cam_map, sec_cam_num, idx); +if (idx >= sec_cam_num -1 ) +return -EBUSY ; +/* ext keys need two cam entries for 256-bit key */ +if (test_bit (idx +1 , cam_info->sec_cam_map)) { + idx++; + goto again; + } + +set_bit (idx, cam_info->sec_cam_map); +set_bit (idx +1 , cam_info->sec_cam_map); + *sec_cam_idx = idx; + +return 0 ; +} + +static int rtw89_cam_get_addr_cam_key_idx (struct rtw89_addr_cam_entry *addr_cam, +struct rtw89_sec_cam_entry *sec_cam, +struct ieee80211_key_conf *key, +u8 *key_idx) +{ +u8 idx; + +/* RTW89_ADDR_CAM_SEC_NONE : not enabled +* RTW89_ADDR_CAM_SEC_ALL_UNI : 0 - 6 unicast +* RTW89_ADDR_CAM_SEC_NORMAL : 0 - 1 unicast, 2 - 4 group, 5 - 6 BIP +* RTW89_ADDR_CAM_SEC_4GROUP : 0 - 1 unicast, 2 - 5 group, 6 BIP +*/ +switch (addr_cam->sec_ent_mode) { +case RTW89_ADDR_CAM_SEC_NONE : +return -EINVAL ; +case RTW89_ADDR_CAM_SEC_ALL_UNI : +if (!(key->flags &IEEE80211_KEY_FLAG_PAIRWISE )) +return -EINVAL ; + idx =find_first_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ); +if (idx >=RTW89_SEC_CAM_IN_ADDR_CAM ) +return -EBUSY ; + *key_idx = idx; +break ; +case RTW89_ADDR_CAM_SEC_NORMAL : +if (sec_cam->type ==RTW89_SEC_KEY_TYPE_BIP_CCMP128 ) { + idx =find_next_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ,5 ); +if (idx >6 ) +return -EBUSY ; + *key_idx = idx; +break ; + } + +if (key->flags &IEEE80211_KEY_FLAG_PAIRWISE ) { + idx =find_next_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ,0 ); +if (idx >1 ) +return -EBUSY ; + *key_idx = idx; +break ; + } + +/* Group keys */ + idx =find_next_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ,2 ); +if (idx >4 ) +return -EBUSY ; + *key_idx = idx; +break ; +case RTW89_ADDR_CAM_SEC_4GROUP : +if (sec_cam->type ==RTW89_SEC_KEY_TYPE_BIP_CCMP128 ) { +if (test_bit (6 , addr_cam->sec_cam_map)) +return -EINVAL ; + *key_idx =6 ; +break ; + } + +if (key->flags &IEEE80211_KEY_FLAG_PAIRWISE ) { + idx =find_next_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ,0 ); +if (idx >1 ) +return -EBUSY ; + *key_idx = idx; +break ; + } + +/* Group keys */ + idx =find_next_zero_bit (addr_cam->sec_cam_map, +RTW89_SEC_CAM_IN_ADDR_CAM ,2 ); +if (idx >5 ) +return -EBUSY ; + *key_idx = idx; +break ; + } + +return 0 ; +} + +static int rtw89_cam_attach_sec_cam (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta, +struct ieee80211_key_conf *key, +struct rtw89_sec_cam_entry *sec_cam) +{ +struct rtw89_vif *rtwvif; +struct rtw89_addr_cam_entry *addr_cam; +u8 key_idx =0 ; +int ret; + +if (!vif) { +rtw89_err (rtwdev,"No iface for adding sec cam\n" ); +return -EINVAL ; + } + + rtwvif = (struct rtw89_vif *)vif->drv_priv; + addr_cam = &rtwvif->addr_cam; + ret =rtw89_cam_get_addr_cam_key_idx (addr_cam, sec_cam, key, &key_idx); +if (ret) { +rtw89_err (rtwdev,"failed to get addr cam key idx %d, %d\n" , + addr_cam->sec_ent_mode, sec_cam->type); +return ret; + } + + key->hw_key_idx = key_idx; + addr_cam->sec_ent_keyid[key_idx] = key->keyidx; + addr_cam->sec_ent[key_idx] = sec_cam->sec_cam_idx; + addr_cam->sec_entries[key_idx] = sec_cam; +set_bit (key_idx, addr_cam->sec_cam_map); + ret =rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) { +rtw89_err (rtwdev,"failed to update addr cam sec entry: %d\n" , + ret); +clear_bit (key_idx, addr_cam->sec_cam_map); + addr_cam->sec_entries[key_idx] =NULL ; +return ret; + } + +return 0 ; +} + +static int rtw89_cam_sec_key_install (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta, +struct ieee80211_key_conf *key, +u8 hw_key_type,bool ext_key) +{ +struct rtw89_sec_cam_entry *sec_cam =NULL ; +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +u8 sec_cam_idx; +int ret; + +/* maximum key length 256-bit */ +if (key->keylen >32 ) { +rtw89_err (rtwdev,"invalid sec key length %d\n" , key->keylen); +return -EINVAL ; + } + + ret =rtw89_cam_get_avail_sec_cam (rtwdev, &sec_cam_idx, ext_key); +if (ret) { +rtw89_warn (rtwdev,"no available sec cam: %d ext: %d\n" , + ret, ext_key); +return ret; + } + + sec_cam =kzalloc (sizeof (*sec_cam),GFP_KERNEL ); +if (!sec_cam) { + ret = -ENOMEM ; + goto err_release_cam; + } + + sec_cam->sec_cam_idx = sec_cam_idx; + sec_cam->type = hw_key_type; + sec_cam->len =RTW89_SEC_CAM_LEN ; + sec_cam->ext_key = ext_key; +memcpy (sec_cam->key, key->key, key->keylen); + ret =rtw89_cam_send_sec_key_cmd (rtwdev, sec_cam); +if (ret) { +rtw89_err (rtwdev,"failed to send sec key cmd: %d\n" , ret); + goto err_release_cam; + } + +/* associate with addr cam */ + ret =rtw89_cam_attach_sec_cam (rtwdev, vif, sta, key, sec_cam); +if (ret) { +rtw89_err (rtwdev,"failed to attach sec cam: %d\n" , ret); + goto err_release_cam; + } + +return 0 ; + +err_release_cam: +kfree (sec_cam); +clear_bit (sec_cam_idx, cam_info->sec_cam_map); +if (ext_key) +clear_bit (sec_cam_idx +1 , cam_info->sec_cam_map); + +return ret; +} + +int rtw89_cam_sec_key_add (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta, +struct ieee80211_key_conf *key) +{ +u8 hw_key_type; +bool ext_key = false; +int ret; + +switch (key->cipher) { +case WLAN_CIPHER_SUITE_WEP40 : + hw_key_type =RTW89_SEC_KEY_TYPE_WEP40 ; +break ; +case WLAN_CIPHER_SUITE_WEP104 : + hw_key_type =RTW89_SEC_KEY_TYPE_WEP104 ; +break ; +case WLAN_CIPHER_SUITE_CCMP : + hw_key_type =RTW89_SEC_KEY_TYPE_CCMP128 ; + key->flags |=IEEE80211_KEY_FLAG_SW_MGMT_TX ; +break ; +case WLAN_CIPHER_SUITE_CCMP_256 : + hw_key_type =RTW89_SEC_KEY_TYPE_CCMP256 ; + key->flags |=IEEE80211_KEY_FLAG_SW_MGMT_TX ; + ext_key = true; +break ; +case WLAN_CIPHER_SUITE_GCMP : + hw_key_type =RTW89_SEC_KEY_TYPE_GCMP128 ; + key->flags |=IEEE80211_KEY_FLAG_SW_MGMT_TX ; +break ; +case WLAN_CIPHER_SUITE_GCMP_256 : + hw_key_type =RTW89_SEC_KEY_TYPE_GCMP256 ; + key->flags |=IEEE80211_KEY_FLAG_SW_MGMT_TX ; + ext_key = true; +break ; +case WLAN_CIPHER_SUITE_TKIP : +case WLAN_CIPHER_SUITE_AES_CMAC : +case WLAN_CIPHER_SUITE_BIP_CMAC_256 : +case WLAN_CIPHER_SUITE_BIP_GMAC_128 : +case WLAN_CIPHER_SUITE_BIP_GMAC_256 : +/* suppress error messages */ +return -EOPNOTSUPP ; +default : +return -ENOTSUPP ; + } + + key->flags |=IEEE80211_KEY_FLAG_GENERATE_IV ; + + ret =rtw89_cam_sec_key_install (rtwdev, vif, sta, key, hw_key_type, + ext_key); +if (ret) { +rtw89_err (rtwdev,"failed to install key type %d ext %d: %d\n" , + hw_key_type, ext_key, ret); +return ret; + } + +return 0 ; +} + +int rtw89_cam_sec_key_del (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta, +struct ieee80211_key_conf *key, +bool inform_fw) +{ +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +struct rtw89_vif *rtwvif; +struct rtw89_addr_cam_entry *addr_cam; +struct rtw89_sec_cam_entry *sec_cam; +u8 key_idx = key->hw_key_idx; +u8 sec_cam_idx; +int ret =0 ; + +if (!vif) { +rtw89_err (rtwdev,"No iface for deleting sec cam\n" ); +return -EINVAL ; + } + + rtwvif = (struct rtw89_vif *)vif->drv_priv; + addr_cam = &rtwvif->addr_cam; + sec_cam = addr_cam->sec_entries[key_idx]; + +/* detach sec cam from addr cam */ +clear_bit (key_idx, addr_cam->sec_cam_map); + addr_cam->sec_entries[key_idx] =NULL ; +if (inform_fw) { + ret =rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) +rtw89_err (rtwdev,"failed to update cam del key: %d\n" , ret); + } + +/* clear valid bit in addr cam will disable sec cam, +* so we don't need to send H2C command again +*/ + sec_cam_idx = sec_cam->sec_cam_idx; +clear_bit (sec_cam_idx, cam_info->sec_cam_map); +if (sec_cam->ext_key) +clear_bit (sec_cam_idx +1 , cam_info->sec_cam_map); + +kfree (sec_cam); + +return ret; +} + +static void rtw89_cam_reset_key_iter (struct ieee80211_hw *hw, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta, +struct ieee80211_key_conf *key, +void *data) +{ +struct rtw89_dev *rtwdev = (struct rtw89_dev *)data; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +rtw89_cam_sec_key_del (rtwdev, vif, sta, key, false); +rtw89_cam_deinit (rtwdev, rtwvif); +} + +void rtw89_cam_deinit (struct rtw89_dev *rtwdev,struct rtw89_vif *rtwvif) +{ +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; +struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; + + addr_cam->valid = false; + bssid_cam->valid = false; +clear_bit (addr_cam->addr_cam_idx, cam_info->addr_cam_map); +clear_bit (bssid_cam->bssid_cam_idx, cam_info->bssid_cam_map); +} + +void rtw89_cam_reset_keys (struct rtw89_dev *rtwdev) +{ +rcu_read_lock (); +ieee80211_iter_keys_rcu (rtwdev->hw,NULL , rtw89_cam_reset_key_iter, rtwdev); +rcu_read_unlock (); +} + +static int rtw89_cam_get_avail_addr_cam (struct rtw89_dev *rtwdev, +u8 *addr_cam_idx) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +u8 addr_cam_num = chip->acam_num; +u8 idx; + + idx =find_first_zero_bit (cam_info->addr_cam_map, addr_cam_num); +if (idx >= addr_cam_num) +return -EBUSY ; + +set_bit (idx, cam_info->addr_cam_map); + *addr_cam_idx = idx; + +return 0 ; +} + +static int rtw89_cam_init_addr_cam (struct rtw89_dev *rtwdev, +struct rtw89_vif *rtwvif) +{ +struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; +u8 addr_cam_idx; +int i; +int ret; + + ret =rtw89_cam_get_avail_addr_cam (rtwdev, &addr_cam_idx); +if (ret) { +rtw89_err (rtwdev,"failed to get available addr cam\n" ); +return ret; + } + + addr_cam->addr_cam_idx = addr_cam_idx; + addr_cam->len =ADDR_CAM_ENT_SIZE ; + addr_cam->offset =0 ; + addr_cam->valid = true; + addr_cam->addr_mask =0 ; + addr_cam->mask_sel =RTW89_NO_MSK ; +bitmap_zero (addr_cam->sec_cam_map,RTW89_SEC_CAM_IN_ADDR_CAM ); +ether_addr_copy (addr_cam->sma, rtwvif->mac_addr); + +for (i =0 ; i <RTW89_SEC_CAM_IN_ADDR_CAM ; i++) { + addr_cam->sec_ent_keyid[i] =0 ; + addr_cam->sec_ent[i] =0 ; + } + +return 0 ; +} + +static int rtw89_cam_get_avail_bssid_cam (struct rtw89_dev *rtwdev, +u8 *bssid_cam_idx) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_cam_info *cam_info = &rtwdev->cam_info; +u8 bssid_cam_num = chip->bcam_num; +u8 idx; + + idx =find_first_zero_bit (cam_info->bssid_cam_map, bssid_cam_num); +if (idx >= bssid_cam_num) +return -EBUSY ; + +set_bit (idx, cam_info->bssid_cam_map); + *bssid_cam_idx = idx; + +return 0 ; +} + +static int rtw89_cam_init_bssid_cam (struct rtw89_dev *rtwdev, +struct rtw89_vif *rtwvif) +{ +struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; +u8 bssid_cam_idx; +int ret; + + ret =rtw89_cam_get_avail_bssid_cam (rtwdev, &bssid_cam_idx); +if (ret) { +rtw89_err (rtwdev,"failed to get available bssid cam\n" ); +return ret; + } + + bssid_cam->bssid_cam_idx = bssid_cam_idx; + bssid_cam->phy_idx = rtwvif->phy_idx; + bssid_cam->len =BSSID_CAM_ENT_SIZE ; + bssid_cam->offset =0 ; + bssid_cam->valid = true; +ether_addr_copy (bssid_cam->bssid, rtwvif->bssid); + +return 0 ; +} + +void rtw89_cam_bssid_changed (struct rtw89_dev *rtwdev,struct rtw89_vif *rtwvif) +{ +struct ieee80211_vif *vif =rtwvif_to_vif (rtwvif); +struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; +struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; + +if (vif->type ==NL80211_IFTYPE_STATION ) +ether_addr_copy (addr_cam->tma, rtwvif->bssid); +ether_addr_copy (bssid_cam->bssid, rtwvif->bssid); +} + +int rtw89_cam_init (struct rtw89_dev *rtwdev,struct rtw89_vif *rtwvif) +{ +struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; +struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; +int ret; + + ret =rtw89_cam_init_addr_cam (rtwdev, rtwvif); +if (ret) { +rtw89_err (rtwdev,"failed to init addr cam\n" ); +return ret; + } + + ret =rtw89_cam_init_bssid_cam (rtwdev, rtwvif); +if (ret) { +rtw89_err (rtwdev,"failed to init bssid cam\n" ); +return ret; + } + +/* associate addr cam with bssid cam */ + addr_cam->bssid_cam_idx = bssid_cam->bssid_cam_idx; + +return 0 ; +} + +int rtw89_cam_fill_bssid_cam_info (struct rtw89_dev *rtwdev, +struct rtw89_vif *rtwvif,u8 *cmd) +{ +struct ieee80211_vif *vif =rtwvif_to_vif (rtwvif); +struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; +u8 bss_color = vif->bss_conf.he_bss_color.color; + +FWCMD_SET_ADDR_BSSID_IDX (cmd, bssid_cam->bssid_cam_idx); +FWCMD_SET_ADDR_BSSID_OFFSET (cmd, bssid_cam->offset); +FWCMD_SET_ADDR_BSSID_LEN (cmd, bssid_cam->len); +FWCMD_SET_ADDR_BSSID_VALID (cmd, bssid_cam->valid); +FWCMD_SET_ADDR_BSSID_BB_SEL (cmd, bssid_cam->phy_idx); +FWCMD_SET_ADDR_BSSID_BSS_COLOR (cmd, bss_color); + +FWCMD_SET_ADDR_BSSID_BSSID0 (cmd, bssid_cam->bssid[0 ]); +FWCMD_SET_ADDR_BSSID_BSSID1 (cmd, bssid_cam->bssid[1 ]); +FWCMD_SET_ADDR_BSSID_BSSID2 (cmd, bssid_cam->bssid[2 ]); +FWCMD_SET_ADDR_BSSID_BSSID3 (cmd, bssid_cam->bssid[3 ]); +FWCMD_SET_ADDR_BSSID_BSSID4 (cmd, bssid_cam->bssid[4 ]); +FWCMD_SET_ADDR_BSSID_BSSID5 (cmd, bssid_cam->bssid[5 ]); + +return 0 ; +} + +static u8 rtw89_cam_addr_hash (u8 start,u8 *addr) +{ +u8 hash =0 ; +u8 i; + +for (i = start; i <ETH_ALEN ; i++) + hash ^= addr[i]; + +return hash; +} + +void rtw89_cam_fill_addr_cam_info (struct rtw89_dev *rtwdev, +struct rtw89_vif *rtwvif, +u8 *cmd) +{ +struct ieee80211_vif *vif =rtwvif_to_vif (rtwvif); +struct ieee80211_sta *sta; +struct rtw89_sta *rtwsta; +struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; +u8 sma_hash, tma_hash, addr_msk_start; +u8 sma_start =0 ; +u8 tma_start =0 ; + +if (addr_cam->addr_mask !=0 ) { + addr_msk_start =__ffs (addr_cam->addr_mask); +if (addr_cam->mask_sel ==RTW89_SMA ) + sma_start = addr_msk_start; +else if (addr_cam->mask_sel ==RTW89_TMA ) + tma_start = addr_msk_start; + } + sma_hash =rtw89_cam_addr_hash (sma_start, rtwvif->mac_addr); + tma_hash =rtw89_cam_addr_hash (tma_start, addr_cam->tma); + +FWCMD_SET_ADDR_IDX (cmd, addr_cam->addr_cam_idx); +FWCMD_SET_ADDR_OFFSET (cmd, addr_cam->offset); +FWCMD_SET_ADDR_LEN (cmd, addr_cam->len); + +FWCMD_SET_ADDR_VALID (cmd, addr_cam->valid); +FWCMD_SET_ADDR_NET_TYPE (cmd, rtwvif->net_type); +FWCMD_SET_ADDR_BCN_HIT_COND (cmd, rtwvif->bcn_hit_cond); +FWCMD_SET_ADDR_HIT_RULE (cmd, rtwvif->hit_rule); +FWCMD_SET_ADDR_BB_SEL (cmd, rtwvif->phy_idx); +FWCMD_SET_ADDR_ADDR_MASK (cmd, addr_cam->addr_mask); +FWCMD_SET_ADDR_MASK_SEL (cmd, addr_cam->mask_sel); +FWCMD_SET_ADDR_SMA_HASH (cmd, sma_hash); +FWCMD_SET_ADDR_TMA_HASH (cmd, tma_hash); + +FWCMD_SET_ADDR_BSSID_CAM_IDX (cmd, addr_cam->bssid_cam_idx); + +FWCMD_SET_ADDR_SMA0 (cmd, rtwvif->mac_addr[0 ]); +FWCMD_SET_ADDR_SMA1 (cmd, rtwvif->mac_addr[1 ]); +FWCMD_SET_ADDR_SMA2 (cmd, rtwvif->mac_addr[2 ]); +FWCMD_SET_ADDR_SMA3 (cmd, rtwvif->mac_addr[3 ]); +FWCMD_SET_ADDR_SMA4 (cmd, rtwvif->mac_addr[4 ]); +FWCMD_SET_ADDR_SMA5 (cmd, rtwvif->mac_addr[5 ]); + +FWCMD_SET_ADDR_TMA0 (cmd, addr_cam->tma[0 ]); +FWCMD_SET_ADDR_TMA1 (cmd, addr_cam->tma[1 ]); +FWCMD_SET_ADDR_TMA2 (cmd, addr_cam->tma[2 ]); +FWCMD_SET_ADDR_TMA3 (cmd, addr_cam->tma[3 ]); +FWCMD_SET_ADDR_TMA4 (cmd, addr_cam->tma[4 ]); +FWCMD_SET_ADDR_TMA5 (cmd, addr_cam->tma[5 ]); + +FWCMD_SET_ADDR_PORT_INT (cmd, rtwvif->port); +FWCMD_SET_ADDR_TSF_SYNC (cmd, rtwvif->port); +FWCMD_SET_ADDR_TF_TRS (cmd, rtwvif->trigger); +FWCMD_SET_ADDR_LSIG_TXOP (cmd, rtwvif->lsig_txop); +FWCMD_SET_ADDR_TGT_IND (cmd, rtwvif->tgt_ind); +FWCMD_SET_ADDR_FRM_TGT_IND (cmd, rtwvif->frm_tgt_ind); + +if (vif->type ==NL80211_IFTYPE_STATION ) { + sta = rtwvif->mgd.ap; +if (sta) { + rtwsta = (struct rtw89_sta *)sta->drv_priv; +FWCMD_SET_ADDR_MACID (cmd, rtwsta->mac_id); +FWCMD_SET_ADDR_AID12 (cmd, vif->bss_conf.aid &0xfff ); + } + } +FWCMD_SET_ADDR_WOL_PATTERN (cmd, rtwvif->wowlan_pattern); +FWCMD_SET_ADDR_WOL_UC (cmd, rtwvif->wowlan_uc); +FWCMD_SET_ADDR_WOL_MAGIC (cmd, rtwvif->wowlan_magic); +FWCMD_SET_ADDR_WAPI (cmd, addr_cam->wapi); +FWCMD_SET_ADDR_SEC_ENT_MODE (cmd, addr_cam->sec_ent_mode); +FWCMD_SET_ADDR_SEC_ENT0_KEYID (cmd, addr_cam->sec_ent_keyid[0 ]); +FWCMD_SET_ADDR_SEC_ENT1_KEYID (cmd, addr_cam->sec_ent_keyid[1 ]); +FWCMD_SET_ADDR_SEC_ENT2_KEYID (cmd, addr_cam->sec_ent_keyid[2 ]); +FWCMD_SET_ADDR_SEC_ENT3_KEYID (cmd, addr_cam->sec_ent_keyid[3 ]); +FWCMD_SET_ADDR_SEC_ENT4_KEYID (cmd, addr_cam->sec_ent_keyid[4 ]); +FWCMD_SET_ADDR_SEC_ENT5_KEYID (cmd, addr_cam->sec_ent_keyid[5 ]); +FWCMD_SET_ADDR_SEC_ENT6_KEYID (cmd, addr_cam->sec_ent_keyid[6 ]); + +FWCMD_SET_ADDR_SEC_ENT_VALID (cmd, addr_cam->sec_cam_map[0 ] &0xff ); +FWCMD_SET_ADDR_SEC_ENT0 (cmd, addr_cam->sec_ent[0 ]); +FWCMD_SET_ADDR_SEC_ENT1 (cmd, addr_cam->sec_ent[1 ]); +FWCMD_SET_ADDR_SEC_ENT2 (cmd, addr_cam->sec_ent[2 ]); +FWCMD_SET_ADDR_SEC_ENT3 (cmd, addr_cam->sec_ent[3 ]); +FWCMD_SET_ADDR_SEC_ENT4 (cmd, addr_cam->sec_ent[4 ]); +FWCMD_SET_ADDR_SEC_ENT5 (cmd, addr_cam->sec_ent[5 ]); +FWCMD_SET_ADDR_SEC_ENT6 (cmd, addr_cam->sec_ent[6 ]); +}
drivers/net/wireless/realtek/rtw89/cam.h new file +165 -0
165 lines not on this page · raw message
Signature · 1 line
2.25.1
Ping-Ke Shih
maintainerPATCH 2/24 rtw89: add BT coexistence files
In reply to Ping-Ke ShihBT coexistence uses TDMA-based mechanism to coordinate with WiFi and BT. Now, we implement basic coexistence features for wide use cases, such as HID and A2DP. More will be supported later.
--- drivers/net/wireless/realtek/rtw89/coex.c | 5620 +++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/coex.h | 152 + 2 files changed, 5772 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/coex.c create mode 100644 drivers/net/wireless/realtek/rtw89/coex.h
drivers/net/wireless/realtek/rtw89/coex.c new file +5620 -0
@@ -0,0 +1,5620 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "coex.h" +#include "debug.h" +#include "fw.h" +#include "mac.h" +#include "ps.h" +#include "reg.h" + +#define FCXDEF_STEP 50/* MUST <= FCXMAX_STEP and match with wl fw*/ + +enum btc_fbtc_tdma_template { +CXTD_OFF =0x0 , +CXTD_OFF_B2 , +CXTD_OFF_EXT , +CXTD_FIX , +CXTD_PFIX , +CXTD_AUTO , +CXTD_PAUTO , +CXTD_AUTO2 , +CXTD_PAUTO2 , +CXTD_MAX , +}; + +enum btc_fbtc_tdma_type { +CXTDMA_OFF =0x0 , +CXTDMA_FIX =0x1 , +CXTDMA_AUTO =0x2 , +CXTDMA_AUTO2 =0x3 , +CXTDMA_MAX +}; + +enum btc_fbtc_tdma_rx_flow_ctrl { +CXFLC_OFF =0x0 , +CXFLC_NULLP =0x1 , +CXFLC_QOSNULL =0x2 , +CXFLC_CTS =0x3 , +CXFLC_MAX +}; + +enum btc_fbtc_tdma_wlan_tx_pause { +CXTPS_OFF =0x0 ,/* no wl tx pause*/ +CXTPS_ON =0x1 , +CXTPS_MAX +}; + +enum btc_mlme_state { +MLME_NO_LINK , +MLME_LINKING , +MLME_LINKED , +}; + +#define FCXONESLOT_VER 1 +struct btc_fbtc_1slot { +u8 fver; +u8 sid;/* slot id */ +struct rtw89_btc_fbtc_slot slot; +} __packed; + +static const struct rtw89_btc_fbtc_tdma t_def[] = { + [CXTD_OFF ] = {CXTDMA_OFF ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,0 ,0 ,0 }, + [CXTD_OFF_B2 ] = {CXTDMA_OFF ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,1 ,0 ,0 }, + [CXTD_OFF_EXT ] = {CXTDMA_OFF ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,3 ,0 ,0 }, + [CXTD_FIX ] = {CXTDMA_FIX ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,0 ,0 ,0 }, + [CXTD_PFIX ] = {CXTDMA_FIX ,CXFLC_NULLP ,CXTPS_ON ,0 ,5 ,0 ,0 ,0 }, + [CXTD_AUTO ] = {CXTDMA_AUTO ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,0 ,0 ,0 }, + [CXTD_PAUTO ] = {CXTDMA_AUTO ,CXFLC_NULLP ,CXTPS_ON ,0 ,5 ,0 ,0 ,0 }, + [CXTD_AUTO2 ] = {CXTDMA_AUTO2 ,CXFLC_OFF ,CXTPS_OFF ,0 ,0 ,0 ,0 ,0 }, + [CXTD_PAUTO2 ] = {CXTDMA_AUTO2 ,CXFLC_NULLP ,CXTPS_ON ,0 ,5 ,0 ,0 ,0 } +}; + +#define __DEF_FBTC_SLOT (__dur, __cxtbl, __cxtype) \ + { .dur = cpu_to_le16(__dur), .cxtbl = cpu_to_le32(__cxtbl), \ + .cxtype = cpu_to_le16(__cxtype),} + +static const struct rtw89_btc_fbtc_slot s_def[] = { + [CXST_OFF ] =__DEF_FBTC_SLOT (100 ,0x55555555 ,SLOT_MIX ), + [CXST_B2W ] =__DEF_FBTC_SLOT (5 ,0x5a5a5a5a ,SLOT_ISO ), + [CXST_W1 ] =__DEF_FBTC_SLOT (70 ,0x5a5a5a5a ,SLOT_ISO ), + [CXST_W2 ] =__DEF_FBTC_SLOT (70 ,0x5a5a5aaa ,SLOT_ISO ), + [CXST_W2B ] =__DEF_FBTC_SLOT (15 ,0x5a5a5a5a ,SLOT_ISO ), + [CXST_B1 ] =__DEF_FBTC_SLOT (100 ,0x55555555 ,SLOT_MIX ), + [CXST_B2 ] =__DEF_FBTC_SLOT (7 ,0x6a5a5a5a ,SLOT_MIX ), + [CXST_B3 ] =__DEF_FBTC_SLOT (5 ,0x55555555 ,SLOT_MIX ), + [CXST_B4 ] =__DEF_FBTC_SLOT (50 ,0x55555555 ,SLOT_MIX ), + [CXST_LK ] =__DEF_FBTC_SLOT (20 ,0x5a5a5a5a ,SLOT_ISO ), + [CXST_BLK ] =__DEF_FBTC_SLOT (250 ,0x55555555 ,SLOT_MIX ), + [CXST_E2G ] =__DEF_FBTC_SLOT (20 ,0x6a5a5a5a ,SLOT_MIX ), + [CXST_E5G ] =__DEF_FBTC_SLOT (20 ,0xffffffff ,SLOT_MIX ), + [CXST_EBT ] =__DEF_FBTC_SLOT (20 ,0x55555555 ,SLOT_MIX ), + [CXST_ENULL ] =__DEF_FBTC_SLOT (7 ,0xaaaaaaaa ,SLOT_ISO ), + [CXST_WLK ] =__DEF_FBTC_SLOT (250 ,0x6a5a6a5a ,SLOT_MIX ), + [CXST_W1FDD ] =__DEF_FBTC_SLOT (35 ,0xfafafafa ,SLOT_ISO ), + [CXST_B1FDD ] =__DEF_FBTC_SLOT (100 ,0xffffffff ,SLOT_MIX ), +}; + +static const u32 cxtbl[] = { +0xffffffff ,/* 0 */ +0xaaaaaaaa ,/* 1 */ +0x55555555 ,/* 2 */ +0x66555555 ,/* 3 */ +0x66556655 ,/* 4 */ +0x5a5a5a5a ,/* 5 */ +0x5a5a5aaa ,/* 6 */ +0xaa5a5a5a ,/* 7 */ +0x6a5a5a5a ,/* 8 */ +0x6a5a5aaa ,/* 9 */ +0x6a5a6a5a ,/* 10 */ +0x6a5a6aaa ,/* 11 */ +0x6afa5afa ,/* 12 */ +0xaaaa5aaa ,/* 13 */ +0xaaffffaa ,/* 14 */ +0xaa5555aa ,/* 15 */ +0xfafafafa ,/* 16 */ +0xffffddff ,/* 17 */ +0xdaffdaff ,/* 18 */ +0xfafadafa /* 19 */ +}; + +struct rtw89_btc_btf_tlv { +u8 type; +u8 len; +u8 val[1 ]; +} __packed; + +enum btc_btf_set_report_en { +RPT_EN_TDMA =BIT (0 ), +RPT_EN_CYCLE =BIT (1 ), +RPT_EN_MREG =BIT (2 ), +RPT_EN_BT_VER_INFO =BIT (3 ), +RPT_EN_BT_SCAN_INFO =BIT (4 ), +RPT_EN_BT_AFH_MAP =BIT (5 ), +RPT_EN_BT_DEVICE_INFO =BIT (6 ), +RPT_EN_WL_ALL =GENMASK (2 ,0 ), +RPT_EN_BT_ALL =GENMASK (6 ,3 ), +RPT_EN_ALL =GENMASK (6 ,0 ), +}; + +#define BTF_SET_REPORT_VER 1 +struct rtw89_btc_btf_set_report { +u8 fver; +__le32 enable; +__le32 para; +} __packed; + +#define BTF_SET_SLOT_TABLE_VER 1 +struct rtw89_btc_btf_set_slot_table { +u8 fver; +u8 tbl_num; +u8 buf[]; +} __packed; + +#define BTF_SET_MON_REG_VER 1 +struct rtw89_btc_btf_set_mon_reg { +u8 fver; +u8 reg_num; +u8 buf[]; +} __packed; + +enum btc_btf_set_cx_policy { +CXPOLICY_TDMA =0x0 , +CXPOLICY_SLOT =0x1 , +CXPOLICY_TYPE =0x2 , +CXPOLICY_MAX , +}; + +enum btc_b2w_scoreboard { +BTC_BSCB_ACT =BIT (0 ), +BTC_BSCB_ON =BIT (1 ), +BTC_BSCB_WHQL =BIT (2 ), +BTC_BSCB_BT_S1 =BIT (3 ), +BTC_BSCB_A2DP_ACT =BIT (4 ), +BTC_BSCB_RFK_RUN =BIT (5 ), +BTC_BSCB_RFK_REQ =BIT (6 ), +BTC_BSCB_LPS =BIT (7 ), +BTC_BSCB_WLRFK =BIT (11 ), +BTC_BSCB_BT_HILNA =BIT (13 ), +BTC_BSCB_BT_CONNECT =BIT (16 ), +BTC_BSCB_PATCH_CODE =BIT (30 ), +BTC_BSCB_ALL =GENMASK (30 ,0 ), +}; + +enum btc_phymap { +BTC_PHY_0 =BIT (0 ), +BTC_PHY_1 =BIT (1 ), +BTC_PHY_ALL =BIT (0 ) |BIT (1 ), +}; + +enum btc_cx_state_map { +BTC_WIDLE =0 , +BTC_WBUSY_BNOSCAN , +BTC_WBUSY_BSCAN , +BTC_WSCAN_BNOSCAN , +BTC_WSCAN_BSCAN , +BTC_WLINKING +}; + +enum btc_ant_phase { +BTC_ANT_WPOWERON =0 , +BTC_ANT_WINIT , +BTC_ANT_WONLY , +BTC_ANT_WOFF , +BTC_ANT_W2G , +BTC_ANT_W5G , +BTC_ANT_W25G , +BTC_ANT_FREERUN , +BTC_ANT_WRFK , +BTC_ANT_BRFK , +BTC_ANT_MAX +}; + +enum btc_plt { +BTC_PLT_NONE =0 , +BTC_PLT_LTE_RX =BIT (0 ), +BTC_PLT_GNT_BT_TX =BIT (1 ), +BTC_PLT_GNT_BT_RX =BIT (2 ), +BTC_PLT_GNT_WL =BIT (3 ), +BTC_PLT_BT =BIT (1 ) |BIT (2 ), +BTC_PLT_ALL =0xf +}; + +enum btc_cx_poicy_main_type { +BTC_CXP_OFF =0 , +BTC_CXP_OFFB , +BTC_CXP_OFFE , +BTC_CXP_FIX , +BTC_CXP_PFIX , +BTC_CXP_AUTO , +BTC_CXP_PAUTO , +BTC_CXP_AUTO2 , +BTC_CXP_PAUTO2 , +BTC_CXP_MANUAL , +BTC_CXP_USERDEF0 , +BTC_CXP_MAIN_MAX +}; + +enum btc_cx_poicy_type { +/* TDMA off + pri: BT > WL */ +BTC_CXP_OFF_BT = (BTC_CXP_OFF <<8 ) |0 , + +/* TDMA off + pri: WL > BT */ +BTC_CXP_OFF_WL = (BTC_CXP_OFF <<8 ) |1 , + +/* TDMA off + pri: BT = WL */ +BTC_CXP_OFF_EQ0 = (BTC_CXP_OFF <<8 ) |2 , + +/* TDMA off + pri: BT = WL > BT_Lo */ +BTC_CXP_OFF_EQ1 = (BTC_CXP_OFF <<8 ) |3 , + +/* TDMA off + pri: WL = BT, BT_Rx > WL_Lo_Tx */ +BTC_CXP_OFF_EQ2 = (BTC_CXP_OFF <<8 ) |4 , + +/* TDMA off + pri: WL_Rx = BT, BT_HI > WL_Tx > BT_Lo */ +BTC_CXP_OFF_EQ3 = (BTC_CXP_OFF <<8 ) |5 , + +/* TDMA off + pri: BT_Hi > WL > BT_Lo */ +BTC_CXP_OFF_BWB0 = (BTC_CXP_OFF <<8 ) |6 , + +/* TDMA off + pri: WL_Hi-Tx > BT_Hi_Rx, BT_Hi > WL > BT_Lo */ +BTC_CXP_OFF_BWB1 = (BTC_CXP_OFF <<8 ) |7 , + +/* TDMA off+Bcn-Protect + pri: WL_Hi-Tx > BT_Hi_Rx, BT_Hi > WL > BT_Lo*/ +BTC_CXP_OFFB_BWB0 = (BTC_CXP_OFFB <<8 ) |0 , + +/* TDMA off + Ext-Ctrl + pri: default */ +BTC_CXP_OFFE_DEF = (BTC_CXP_OFFE <<8 ) |0 , + +/* TDMA off + Ext-Ctrl + pri: E2G-slot block all BT */ +BTC_CXP_OFFE_DEF2 = (BTC_CXP_OFFE <<8 ) |1 , + +/* TDMA Fix slot-0: W1:B1 = 30:30 */ +BTC_CXP_FIX_TD3030 = (BTC_CXP_FIX <<8 ) |0 , + +/* TDMA Fix slot-1: W1:B1 = 50:50 */ +BTC_CXP_FIX_TD5050 = (BTC_CXP_FIX <<8 ) |1 , + +/* TDMA Fix slot-2: W1:B1 = 20:30 */ +BTC_CXP_FIX_TD2030 = (BTC_CXP_FIX <<8 ) |2 , + +/* TDMA Fix slot-3: W1:B1 = 40:10 */ +BTC_CXP_FIX_TD4010 = (BTC_CXP_FIX <<8 ) |3 , + +/* TDMA Fix slot-4: W1:B1 = 70:10 */ +BTC_CXP_FIX_TD7010 = (BTC_CXP_FIX <<8 ) |4 , + +/* TDMA Fix slot-5: W1:B1 = 20:60 */ +BTC_CXP_FIX_TD2060 = (BTC_CXP_FIX <<8 ) |5 , + +/* TDMA Fix slot-6: W1:B1 = 30:60 */ +BTC_CXP_FIX_TD3060 = (BTC_CXP_FIX <<8 ) |6 , + +/* TDMA Fix slot-7: W1:B1 = 20:80 */ +BTC_CXP_FIX_TD2080 = (BTC_CXP_FIX <<8 ) |7 , + +/* TDMA Fix slot-8: W1:B1 = user-define */ +BTC_CXP_FIX_TDW1B1 = (BTC_CXP_FIX <<8 ) |8 , + +/* TDMA Fix slot-9: W1:B1 = 40:20 */ +BTC_CXP_FIX_TD4020 = (BTC_CXP_FIX <<8 ) |9 , + +/* PS-TDMA Fix slot-0: W1:B1 = 30:30 */ +BTC_CXP_PFIX_TD3030 = (BTC_CXP_PFIX <<8 ) |0 , + +/* PS-TDMA Fix slot-1: W1:B1 = 50:50 */ +BTC_CXP_PFIX_TD5050 = (BTC_CXP_PFIX <<8 ) |1 , + +/* PS-TDMA Fix slot-2: W1:B1 = 20:30 */ +BTC_CXP_PFIX_TD2030 = (BTC_CXP_PFIX <<8 ) |2 , + +/* PS-TDMA Fix slot-3: W1:B1 = 20:60 */ +BTC_CXP_PFIX_TD2060 = (BTC_CXP_PFIX <<8 ) |3 , + +/* PS-TDMA Fix slot-4: W1:B1 = 30:70 */ +BTC_CXP_PFIX_TD3070 = (BTC_CXP_PFIX <<8 ) |4 , + +/* PS-TDMA Fix slot-5: W1:B1 = 20:80 */ +BTC_CXP_PFIX_TD2080 = (BTC_CXP_PFIX <<8 ) |5 , + +/* PS-TDMA Fix slot-6: W1:B1 = user-define */ +BTC_CXP_PFIX_TDW1B1 = (BTC_CXP_PFIX <<8 ) |6 , + +/* TDMA Auto slot-0: W1:B1 = 50:200 */ +BTC_CXP_AUTO_TD50200 = (BTC_CXP_AUTO <<8 ) |0 , + +/* TDMA Auto slot-1: W1:B1 = 60:200 */ +BTC_CXP_AUTO_TD60200 = (BTC_CXP_AUTO <<8 ) |1 , + +/* TDMA Auto slot-2: W1:B1 = 20:200 */ +BTC_CXP_AUTO_TD20200 = (BTC_CXP_AUTO <<8 ) |2 , + +/* TDMA Auto slot-3: W1:B1 = user-define */ +BTC_CXP_AUTO_TDW1B1 = (BTC_CXP_AUTO <<8 ) |3 , + +/* PS-TDMA Auto slot-0: W1:B1 = 50:200 */ +BTC_CXP_PAUTO_TD50200 = (BTC_CXP_PAUTO <<8 ) |0 , + +/* PS-TDMA Auto slot-1: W1:B1 = 60:200 */ +BTC_CXP_PAUTO_TD60200 = (BTC_CXP_PAUTO <<8 ) |1 , + +/* PS-TDMA Auto slot-2: W1:B1 = 20:200 */ +BTC_CXP_PAUTO_TD20200 = (BTC_CXP_PAUTO <<8 ) |2 , + +/* PS-TDMA Auto slot-3: W1:B1 = user-define */ +BTC_CXP_PAUTO_TDW1B1 = (BTC_CXP_PAUTO <<8 ) |3 , + +/* TDMA Auto slot2-0: W1:B4 = 30:50 */ +BTC_CXP_AUTO2_TD3050 = (BTC_CXP_AUTO2 <<8 ) |0 , + +/* TDMA Auto slot2-1: W1:B4 = 30:70 */ +BTC_CXP_AUTO2_TD3070 = (BTC_CXP_AUTO2 <<8 ) |1 , + +/* TDMA Auto slot2-2: W1:B4 = 50:50 */ +BTC_CXP_AUTO2_TD5050 = (BTC_CXP_AUTO2 <<8 ) |2 , + +/* TDMA Auto slot2-3: W1:B4 = 60:60 */ +BTC_CXP_AUTO2_TD6060 = (BTC_CXP_AUTO2 <<8 ) |3 , + +/* TDMA Auto slot2-4: W1:B4 = 20:80 */ +BTC_CXP_AUTO2_TD2080 = (BTC_CXP_AUTO2 <<8 ) |4 , + +/* TDMA Auto slot2-5: W1:B4 = user-define */ +BTC_CXP_AUTO2_TDW1B4 = (BTC_CXP_AUTO2 <<8 ) |5 , + +/* PS-TDMA Auto slot2-0: W1:B4 = 30:50 */ +BTC_CXP_PAUTO2_TD3050 = (BTC_CXP_PAUTO2 <<8 ) |0 , + +/* PS-TDMA Auto slot2-1: W1:B4 = 30:70 */ +BTC_CXP_PAUTO2_TD3070 = (BTC_CXP_PAUTO2 <<8 ) |1 , + +/* PS-TDMA Auto slot2-2: W1:B4 = 50:50 */ +BTC_CXP_PAUTO2_TD5050 = (BTC_CXP_PAUTO2 <<8 ) |2 , + +/* PS-TDMA Auto slot2-3: W1:B4 = 60:60 */ +BTC_CXP_PAUTO2_TD6060 = (BTC_CXP_PAUTO2 <<8 ) |3 , + +/* PS-TDMA Auto slot2-4: W1:B4 = 20:80 */ +BTC_CXP_PAUTO2_TD2080 = (BTC_CXP_PAUTO2 <<8 ) |4 , + +/* PS-TDMA Auto slot2-5: W1:B4 = user-define */ +BTC_CXP_PAUTO2_TDW1B4 = (BTC_CXP_PAUTO2 <<8 ) |5 , + +BTC_CXP_MAX =0xffff +}; + +enum btc_wl_rfk_result { +BTC_WRFK_REJECT =0 , +BTC_WRFK_ALLOW =1 , +}; + +enum btc_coex_info_map_en { +BTC_COEX_INFO_CX =BIT (0 ), +BTC_COEX_INFO_WL =BIT (1 ), +BTC_COEX_INFO_BT =BIT (2 ), +BTC_COEX_INFO_DM =BIT (3 ), +BTC_COEX_INFO_MREG =BIT (4 ), +BTC_COEX_INFO_SUMMARY =BIT (5 ), +BTC_COEX_INFO_ALL =GENMASK (7 ,0 ), +}; + +#define BTC_CXP_MASK GENMASK(15, 8) + +enum btc_w2b_scoreboard { +BTC_WSCB_ACTIVE =BIT (0 ), +BTC_WSCB_ON =BIT (1 ), +BTC_WSCB_SCAN =BIT (2 ), +BTC_WSCB_UNDERTEST =BIT (3 ), +BTC_WSCB_RXGAIN =BIT (4 ), +BTC_WSCB_WLBUSY =BIT (7 ), +BTC_WSCB_EXTFEM =BIT (8 ), +BTC_WSCB_TDMA =BIT (9 ), +BTC_WSCB_FIX2M =BIT (10 ), +BTC_WSCB_WLRFK =BIT (11 ), +BTC_WSCB_BTRFK_GNT =BIT (12 ),/* not used, use mailbox to inform BT */ +BTC_WSCB_BT_HILNA =BIT (13 ), +BTC_WSCB_BTLOG =BIT (14 ), +BTC_WSCB_ALL =GENMASK (23 ,0 ), +}; + +enum btc_wl_link_mode { +BTC_WLINK_NOLINK =0x0 , +BTC_WLINK_2G_STA , +BTC_WLINK_2G_AP , +BTC_WLINK_2G_GO , +BTC_WLINK_2G_GC , +BTC_WLINK_2G_SCC , +BTC_WLINK_2G_MCC , +BTC_WLINK_25G_MCC , +BTC_WLINK_25G_DBCC , +BTC_WLINK_5G , +BTC_WLINK_2G_NAN , +BTC_WLINK_OTHER , +BTC_WLINK_MAX +}; + +enum btc_bt_hid_type { +BTC_HID_218 =BIT (0 ), +BTC_HID_418 =BIT (1 ), +BTC_HID_BLE =BIT (2 ), +BTC_HID_RCU =BIT (3 ), +BTC_HID_RCU_VOICE =BIT (4 ), +BTC_HID_OTHER_LEGACY =BIT (5 ) +}; + +enum btc_reset_module { +BTC_RESET_CX =BIT (0 ), +BTC_RESET_DM =BIT (1 ), +BTC_RESET_CTRL =BIT (2 ), +BTC_RESET_CXDM =BIT (0 ) |BIT (1 ), +BTC_RESET_BTINFO =BIT (3 ), +BTC_RESET_MDINFO =BIT (4 ), +BTC_RESET_ALL =GENMASK (7 ,0 ), +}; + +enum btc_gnt_state { +BTC_GNT_HW =0 , +BTC_GNT_SW_LO , +BTC_GNT_SW_HI , +BTC_GNT_MAX +}; + +enum btc_wl_max_tx_time { +BTC_MAX_TX_TIME_L1 =500 , +BTC_MAX_TX_TIME_L2 =1000 , +BTC_MAX_TX_TIME_L3 =2000 , +BTC_MAX_TX_TIME_DEF =5280 +}; + +enum btc_wl_max_tx_retry { +BTC_MAX_TX_RETRY_L1 =7 , +BTC_MAX_TX_RETRY_L2 =15 , +BTC_MAX_TX_RETRY_DEF =31 , +}; + +enum btc_reason_and_action { +BTC_RSN_NONE , +BTC_RSN_NTFY_INIT , +BTC_RSN_NTFY_SWBAND , +BTC_RSN_NTFY_WL_STA , +BTC_RSN_NTFY_RADIO_STATE , +BTC_RSN_UPDATE_BT_SCBD , +BTC_RSN_NTFY_WL_RFK , +BTC_RSN_UPDATE_BT_INFO , +BTC_RSN_NTFY_SCAN_START , +BTC_RSN_NTFY_SCAN_FINISH , +BTC_RSN_NTFY_SPECIFIC_PACKET , +BTC_RSN_NTFY_POWEROFF , +BTC_RSN_NTFY_ROLE_INFO , +BTC_RSN_CMD_SET_COEX , +BTC_RSN_NUM , +BTC_ACT_NONE =100 , +BTC_ACT_WL_ONLY , +BTC_ACT_WL_5G , +BTC_ACT_WL_OTHER , +BTC_ACT_WL_IDLE , +BTC_ACT_WL_NC , +BTC_ACT_WL_RFK , +BTC_ACT_WL_INIT , +BTC_ACT_WL_OFF , +BTC_ACT_FREERUN , +BTC_ACT_BT_WHQL , +BTC_ACT_BT_RFK , +BTC_ACT_BT_OFF , +BTC_ACT_BT_IDLE , +BTC_ACT_BT_HFP , +BTC_ACT_BT_HID , +BTC_ACT_BT_A2DP , +BTC_ACT_BT_A2DPSINK , +BTC_ACT_BT_PAN , +BTC_ACT_BT_A2DP_HID , +BTC_ACT_BT_A2DP_PAN , +BTC_ACT_BT_PAN_HID , +BTC_ACT_BT_A2DP_PAN_HID , +BTC_ACT_WL_25G_MCC , +BTC_ACT_WL_2G_MCC , +BTC_ACT_WL_2G_SCC , +BTC_ACT_WL_2G_AP , +BTC_ACT_WL_2G_GO , +BTC_ACT_WL_2G_GC , +BTC_ACT_WL_2G_NAN , +BTC_ACT_LAST , +BTC_ACT_NUM =BTC_ACT_LAST -BTC_ACT_NONE , +BTC_ACT_EXT_BIT =BIT (14 ), +BTC_POLICY_EXT_BIT =BIT (15 ), +}; + +#define BTC_FREERUN_ANTISO_MIN 30 +#define BTC_TDMA_BTHID_MAX 2 +#define BTC_BLINK_NOCONNECT 0 + +static void _run_coex (struct rtw89_dev *rtwdev, +enum btc_reason_and_action reason); +static void _write_scbd (struct rtw89_dev *rtwdev,u32 val,bool state); +static void _update_bt_scbd (struct rtw89_dev *rtwdev,bool only_update); + +static void _send_fw_cmd (struct rtw89_dev *rtwdev,u8 h2c_class,u8 h2c_func, +void *param,u16 len) +{ +rtw89_fw_h2c_raw_with_hdr (rtwdev, h2c_class, h2c_func, param, len, + false, true); +} + +static void _reset_btc_var (struct rtw89_dev *rtwdev,u8 type) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +struct rtw89_btc_bt_link_info *bt_linfo = &bt->link_info; +struct rtw89_btc_wl_link_info *wl_linfo = wl->link_info; +u8 i; + +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC] %s\n" , __func__); + +if (type &BTC_RESET_CX ) +memset (cx,0 ,sizeof (*cx)); +else if (type &BTC_RESET_BTINFO )/* only for BT enable */ +memset (bt,0 ,sizeof (*bt)); + +if (type &BTC_RESET_CTRL ) { +memset (&btc->ctrl,0 ,sizeof (btc->ctrl)); + btc->ctrl.trace_step =FCXDEF_STEP ; + } + +/* Init Coex variables that are not zero */ +if (type &BTC_RESET_DM ) { +memset (&btc->dm,0 ,sizeof (btc->dm)); +memset (bt_linfo->rssi_state,0 ,sizeof (bt_linfo->rssi_state)); + +for (i =0 ; i <RTW89_MAX_HW_PORT_NUM ; i++) +memset (wl_linfo[i].rssi_state,0 , +sizeof (wl_linfo[i].rssi_state)); + +/* set the slot_now table to original */ + btc->dm.tdma_now = t_def[CXTD_OFF ]; + btc->dm.tdma = t_def[CXTD_OFF ]; +memcpy (&btc->dm.slot_now, s_def,sizeof (btc->dm.slot_now)); +memcpy (&btc->dm.slot, s_def,sizeof (btc->dm.slot)); + + btc->policy_len =0 ; + btc->bt_req_len =0 ; + + btc->dm.coex_info_map =BTC_COEX_INFO_ALL ; + btc->dm.wl_tx_limit.tx_time =BTC_MAX_TX_TIME_DEF ; + btc->dm.wl_tx_limit.tx_retry =BTC_MAX_TX_RETRY_DEF ; + } + +if (type &BTC_RESET_MDINFO ) +memset (&btc->mdinfo,0 ,sizeof (btc->mdinfo)); +} + +#define BTC_FWINFO_BUF 1024 + +#define BTC_RPT_HDR_SIZE 3 +#define BTC_CHK_WLSLOT_DRIFT_MAX 15 +#define BTC_CHK_HANG_MAX 3 + +static void _chk_btc_err (struct rtw89_dev *rtwdev,u8 type,u32 cnt) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_bt_info *bt = &cx->bt; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s type:%d cnt:%d\n" , + __func__, type, cnt); + +switch (type) { +case BTC_DCNT_RPT_FREEZE : +if (dm->cnt_dm[BTC_DCNT_RPT ] == cnt && btc->fwinfo.rpt_en_map) + dm->cnt_dm[BTC_DCNT_RPT_FREEZE ]++; +else + dm->cnt_dm[BTC_DCNT_RPT_FREEZE ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_RPT_FREEZE ] >=BTC_CHK_HANG_MAX ) + dm->error.map.wl_fw_hang = true; +else + dm->error.map.wl_fw_hang = false; + + dm->cnt_dm[BTC_DCNT_RPT ] = cnt; +break ; +case BTC_DCNT_CYCLE_FREEZE : +if (dm->cnt_dm[BTC_DCNT_CYCLE ] == cnt && + (dm->tdma_now.type !=CXTDMA_OFF || + dm->tdma_now.ext_ctrl ==CXECTL_EXT )) + dm->cnt_dm[BTC_DCNT_CYCLE_FREEZE ]++; +else + dm->cnt_dm[BTC_DCNT_CYCLE_FREEZE ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_CYCLE_FREEZE ] >=BTC_CHK_HANG_MAX ) + dm->error.map.cycle_hang = true; +else + dm->error.map.cycle_hang = false; + + dm->cnt_dm[BTC_DCNT_CYCLE ] = cnt; +break ; +case BTC_DCNT_W1_FREEZE : +if (dm->cnt_dm[BTC_DCNT_W1 ] == cnt && + dm->tdma_now.type !=CXTDMA_OFF ) + dm->cnt_dm[BTC_DCNT_W1_FREEZE ]++; +else + dm->cnt_dm[BTC_DCNT_W1_FREEZE ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_W1_FREEZE ] >=BTC_CHK_HANG_MAX ) + dm->error.map.w1_hang = true; +else + dm->error.map.w1_hang = false; + + dm->cnt_dm[BTC_DCNT_W1 ] = cnt; +break ; +case BTC_DCNT_B1_FREEZE : +if (dm->cnt_dm[BTC_DCNT_B1 ] == cnt && + dm->tdma_now.type !=CXTDMA_OFF ) + dm->cnt_dm[BTC_DCNT_B1_FREEZE ]++; +else + dm->cnt_dm[BTC_DCNT_B1_FREEZE ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_B1_FREEZE ] >=BTC_CHK_HANG_MAX ) + dm->error.map.b1_hang = true; +else + dm->error.map.b1_hang = false; + + dm->cnt_dm[BTC_DCNT_B1 ] = cnt; +break ; +case BTC_DCNT_TDMA_NONSYNC : +if (cnt !=0 )/* if tdma not sync between drv/fw */ + dm->cnt_dm[BTC_DCNT_TDMA_NONSYNC ]++; +else + dm->cnt_dm[BTC_DCNT_TDMA_NONSYNC ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_TDMA_NONSYNC ] >=BTC_CHK_HANG_MAX ) + dm->error.map.tdma_no_sync = true; +else + dm->error.map.tdma_no_sync = false; +break ; +case BTC_DCNT_SLOT_NONSYNC : +if (cnt !=0 )/* if slot not sync between drv/fw */ + dm->cnt_dm[BTC_DCNT_SLOT_NONSYNC ]++; +else + dm->cnt_dm[BTC_DCNT_SLOT_NONSYNC ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_SLOT_NONSYNC ] >=BTC_CHK_HANG_MAX ) + dm->error.map.tdma_no_sync = true; +else + dm->error.map.tdma_no_sync = false; +break ; +case BTC_DCNT_BTCNT_FREEZE : + cnt = cx->cnt_bt[BTC_BCNT_HIPRI_RX ] + + cx->cnt_bt[BTC_BCNT_HIPRI_TX ] + + cx->cnt_bt[BTC_BCNT_LOPRI_RX ] + + cx->cnt_bt[BTC_BCNT_LOPRI_TX ]; + +if (cnt ==0 ) + dm->cnt_dm[BTC_DCNT_BTCNT_FREEZE ]++; +else + dm->cnt_dm[BTC_DCNT_BTCNT_FREEZE ] =0 ; + +if ((dm->cnt_dm[BTC_DCNT_BTCNT_FREEZE ] >=BTC_CHK_HANG_MAX && + bt->enable.now) || (!dm->cnt_dm[BTC_DCNT_BTCNT_FREEZE ] && + !bt->enable.now)) +_update_bt_scbd (rtwdev, false); +break ; +case BTC_DCNT_WL_SLOT_DRIFT : +if (cnt >=BTC_CHK_WLSLOT_DRIFT_MAX ) + dm->cnt_dm[BTC_DCNT_WL_SLOT_DRIFT ]++; +else + dm->cnt_dm[BTC_DCNT_WL_SLOT_DRIFT ] =0 ; + +if (dm->cnt_dm[BTC_DCNT_WL_SLOT_DRIFT ] >=BTC_CHK_HANG_MAX ) + dm->error.map.wl_slot_drift = true; +else + dm->error.map.wl_slot_drift = false; +break ; + } +} + +static void _update_bt_report (struct rtw89_dev *rtwdev,u8 rpt_type,u8 *pfinfo) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +struct rtw89_btc_bt_link_info *bt_linfo = &bt->link_info; +struct rtw89_btc_bt_a2dp_desc *a2dp = &bt_linfo->a2dp_desc; +struct rtw89_btc_fbtc_btver *pver =NULL ; +struct rtw89_btc_fbtc_btscan *pscan =NULL ; +struct rtw89_btc_fbtc_btafh *pafh =NULL ; +struct rtw89_btc_fbtc_btdevinfo *pdev =NULL ; + + pver = (struct rtw89_btc_fbtc_btver *)pfinfo; + pscan = (struct rtw89_btc_fbtc_btscan *)pfinfo; + pafh = (struct rtw89_btc_fbtc_btafh *)pfinfo; + pdev = (struct rtw89_btc_fbtc_btdevinfo *)pfinfo; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s rpt_type:%d\n" , + __func__, rpt_type); + +switch (rpt_type) { +case BTC_RPT_TYPE_BT_VER : + bt->ver_info.fw =le32_to_cpu (pver->fw_ver); + bt->ver_info.fw_coex =le32_get_bits (pver->coex_ver,GENMASK (7 ,0 )); + bt->feature =le32_to_cpu (pver->feature); +break ; +case BTC_RPT_TYPE_BT_SCAN : +memcpy (bt->scan_info, pscan->scan,BTC_SCAN_MAX1 ); +break ; +case BTC_RPT_TYPE_BT_AFH : +memcpy (&bt_linfo->afh_map[0 ], pafh->afh_l,4 ); +memcpy (&bt_linfo->afh_map[4 ], pafh->afh_m,4 ); +memcpy (&bt_linfo->afh_map[8 ], pafh->afh_h,2 ); +break ; +case BTC_RPT_TYPE_BT_DEVICE : + a2dp->device_name =le32_to_cpu (pdev->dev_name); + a2dp->vendor_id =le16_to_cpu (pdev->vendor_id); + a2dp->flush_time =le32_to_cpu (pdev->flush_time); +break ; +default : +break ; + } +} + +struct rtw89_btc_fbtc_cysta_cpu { +u8 fver; +u8 rsvd; +u16 cycles; +u16 cycles_a2dp[CXT_FLCTRL_MAX ]; +u16 a2dpept; +u16 a2dpeptto; +u16 tavg_cycle[CXT_MAX ]; +u16 tmax_cycle[CXT_MAX ]; +u16 tmaxdiff_cycle[CXT_MAX ]; +u16 tavg_a2dp[CXT_FLCTRL_MAX ]; +u16 tmax_a2dp[CXT_FLCTRL_MAX ]; +u16 tavg_a2dpept; +u16 tmax_a2dpept; +u16 tavg_lk; +u16 tmax_lk; +u32 slot_cnt[CXST_MAX ]; +u32 bcn_cnt[CXBCN_MAX ]; +u32 leakrx_cnt; +u32 collision_cnt; +u32 skip_cnt; +u32 exception; +u32 except_cnt; +#if (FCXCYSTA_VER >1 ) +u16 tslot_cycle[BTC_CYCLE_SLOT_MAX ]; +#endif +}; + +static void rtw89_btc_fbtc_cysta_to_cpu (const struct rtw89_btc_fbtc_cysta *src, +struct rtw89_btc_fbtc_cysta_cpu *dst) +{ +static_assert (sizeof (*src) ==sizeof (*dst)); + +#define __CPY_U8 (_x) ({dst->_x = src->_x; }) +#define __CPY_LE16 (_x) ({dst->_x = le16_to_cpu(src->_x); }) +#define __CPY_LE16S (_x) ({int _i; for (_i = 0; _i < ARRAY_SIZE(dst->_x); _i++) \ + dst->_x[_i] = le16_to_cpu(src->_x[_i]); }) +#define __CPY_LE32 (_x) ({dst->_x = le32_to_cpu(src->_x); }) +#define __CPY_LE32S (_x) ({int _i; for (_i = 0; _i < ARRAY_SIZE(dst->_x); _i++) \ + dst->_x[_i] = le32_to_cpu(src->_x[_i]); }) + +__CPY_U8 (fver); +__CPY_U8 (rsvd); +__CPY_LE16 (cycles); +__CPY_LE16S (cycles_a2dp); +__CPY_LE16 (a2dpept); +__CPY_LE16 (a2dpeptto); +__CPY_LE16S (tavg_cycle); +__CPY_LE16S (tmax_cycle); +__CPY_LE16S (tmaxdiff_cycle); +__CPY_LE16S (tavg_a2dp); +__CPY_LE16S (tmax_a2dp); +__CPY_LE16 (tavg_a2dpept); +__CPY_LE16 (tmax_a2dpept); +__CPY_LE16 (tavg_lk); +__CPY_LE16 (tmax_lk); +__CPY_LE32S (slot_cnt); +__CPY_LE32S (bcn_cnt); +__CPY_LE32 (leakrx_cnt); +__CPY_LE32 (collision_cnt); +__CPY_LE32 (skip_cnt); +__CPY_LE32 (exception); +__CPY_LE32 (except_cnt); +#if (FCXCYSTA_VER >1 ) +__CPY_LE16S (tslot_cycle); +#endif + +#undef __CPY_U8 +#undef __CPY_LE16 +#undef __CPY_LE16S +#undef __CPY_LE32 +#undef __CPY_LE32S +} + +#define BTC_LEAK_AP_TH 10 +#define BTC_CYSTA_CHK_PERIOD 100 + +struct rtw89_btc_prpt { +u8 type; +__le16 len; +u8 content[]; +} __packed; + +static u32 _chk_btc_report (struct rtw89_dev *rtwdev, +struct rtw89_btc_btf_fwinfo *pfwinfo, +u8 *prptbuf,u32 index) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_rpt_cmn_info *pcinfo =NULL ; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_fbtc_rpt_ctrl *prpt =NULL ; +struct rtw89_btc_fbtc_cysta *pcysta_le32 =NULL ; +struct rtw89_btc_fbtc_cysta_cpu pcysta[1 ]; +struct rtw89_btc_prpt *btc_prpt =NULL ; +struct rtw89_btc_fbtc_slot *rtp_slot =NULL ; +u8 rpt_type =0 , *rpt_content =NULL , *pfinfo =NULL ; +u16 wl_slot_set =0 ; +u32 trace_step = btc->ctrl.trace_step, rpt_len =0 , diff_t; +u8 i; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s index:%d\n" , + __func__, index); + +if (!prptbuf) { + pfwinfo->err[BTFRE_INVALID_INPUT ]++; +return 0 ; + } + + btc_prpt = (struct rtw89_btc_prpt *)&prptbuf[index]; + rpt_type = btc_prpt->type; + rpt_len =le16_to_cpu (btc_prpt->len); + rpt_content = btc_prpt->content; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s rpt_type:%d\n" , + __func__, rpt_type); + +switch (rpt_type) { +case BTC_RPT_TYPE_CTRL : + pcinfo = &pfwinfo->rpt_ctrl.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_ctrl.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_ctrl.finfo); + pcinfo->req_fver =BTCRPT_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_TDMA : + pcinfo = &pfwinfo->rpt_fbtc_tdma.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_tdma.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_tdma.finfo); + pcinfo->req_fver =FCXTDMA_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_SLOT : + pcinfo = &pfwinfo->rpt_fbtc_slots.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_slots.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_slots.finfo); + pcinfo->req_fver =FCXSLOTS_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_CYSTA : + pcinfo = &pfwinfo->rpt_fbtc_cysta.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_cysta.finfo); + pcysta_le32 = &pfwinfo->rpt_fbtc_cysta.finfo; +rtw89_btc_fbtc_cysta_to_cpu (pcysta_le32, pcysta); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_cysta.finfo); + pcinfo->req_fver =FCXCYSTA_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_STEP : + pcinfo = &pfwinfo->rpt_fbtc_step.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_step.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_step.finfo.step[0 ]) * + trace_step +8 ; + pcinfo->req_fver =FCXSTEP_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_NULLSTA : + pcinfo = &pfwinfo->rpt_fbtc_nullsta.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_nullsta.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_nullsta.finfo); + pcinfo->req_fver =FCXNULLSTA_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_MREG : + pcinfo = &pfwinfo->rpt_fbtc_mregval.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_mregval.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_mregval.finfo); + pcinfo->req_fver =FCXMREG_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_GPIO_DBG : + pcinfo = &pfwinfo->rpt_fbtc_gpio_dbg.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_gpio_dbg.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_gpio_dbg.finfo); + pcinfo->req_fver =FCXGPIODBG_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_BT_VER : + pcinfo = &pfwinfo->rpt_fbtc_btver.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_btver.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_btver.finfo); + pcinfo->req_fver =FCX_BTVER_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_BT_SCAN : + pcinfo = &pfwinfo->rpt_fbtc_btscan.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_btscan.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_btscan.finfo); + pcinfo->req_fver =FCX_BTSCAN_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_BT_AFH : + pcinfo = &pfwinfo->rpt_fbtc_btafh.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_btafh.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_btafh.finfo); + pcinfo->req_fver =FCX_BTAFH_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +case BTC_RPT_TYPE_BT_DEVICE : + pcinfo = &pfwinfo->rpt_fbtc_btdev.cinfo; + pfinfo = (u8 *)(&pfwinfo->rpt_fbtc_btdev.finfo); + pcinfo->req_len =sizeof (pfwinfo->rpt_fbtc_btdev.finfo); + pcinfo->req_fver =FCX_BTDEVINFO_VER ; + pcinfo->rx_len = rpt_len; + pcinfo->rx_cnt++; +break ; +default : + pfwinfo->err[BTFRE_UNDEF_TYPE ]++; +return 0 ; + } + +if (rpt_len != pcinfo->req_len) { +if (rpt_type <BTC_RPT_TYPE_MAX ) + pfwinfo->len_mismch |= (0x1 << rpt_type); +else + pfwinfo->len_mismch |=BIT (31 ); +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s %d rpt_len:%d!=req_len:%d\n" , __func__, + rpt_type, rpt_len, pcinfo->req_len); + + pcinfo->valid =0 ; +return 0 ; + }else if (!pfinfo || !rpt_content || !pcinfo->req_len) { + pfwinfo->err[BTFRE_EXCEPTION ]++; + pcinfo->valid =0 ; +return 0 ; + } + +memcpy ((void *)pfinfo, (void *)rpt_content, pcinfo->req_len); + pcinfo->valid =1 ; + +if (rpt_type ==BTC_RPT_TYPE_TDMA ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s check %d %ld\n" , __func__, +BTC_DCNT_TDMA_NONSYNC ,sizeof (dm->tdma_now)); + +if (memcmp (&dm->tdma_now, &pfwinfo->rpt_fbtc_tdma.finfo, +sizeof (dm->tdma_now)) !=0 ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s %d tdma_now %x %x %x %x %x %x %x %x\n" , + __func__,BTC_DCNT_TDMA_NONSYNC , + dm->tdma_now.type, dm->tdma_now.rxflctrl, + dm->tdma_now.txpause, dm->tdma_now.wtgle_n, + dm->tdma_now.leak_n, dm->tdma_now.ext_ctrl, + dm->tdma_now.rsvd0, dm->tdma_now.rsvd1); + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s %d rpt_fbtc_tdma %x %x %x %x %x %x %x %x\n" , + __func__,BTC_DCNT_TDMA_NONSYNC , + pfwinfo->rpt_fbtc_tdma.finfo.type, + pfwinfo->rpt_fbtc_tdma.finfo.rxflctrl, + pfwinfo->rpt_fbtc_tdma.finfo.txpause, + pfwinfo->rpt_fbtc_tdma.finfo.wtgle_n, + pfwinfo->rpt_fbtc_tdma.finfo.leak_n, + pfwinfo->rpt_fbtc_tdma.finfo.ext_ctrl, + pfwinfo->rpt_fbtc_tdma.finfo.rsvd0, + pfwinfo->rpt_fbtc_tdma.finfo.rsvd1); + } + +_chk_btc_err (rtwdev,BTC_DCNT_TDMA_NONSYNC , +memcmp (&dm->tdma_now, + &pfwinfo->rpt_fbtc_tdma.finfo, +sizeof (dm->tdma_now))); + } + +if (rpt_type ==BTC_RPT_TYPE_SLOT ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s check %d %ld\n" , + __func__,BTC_DCNT_SLOT_NONSYNC , +sizeof (dm->slot_now)); + +if (memcmp (dm->slot_now, pfwinfo->rpt_fbtc_slots.finfo.slot, +sizeof (dm->slot_now)) !=0 ) { +for (i =0 ; i <CXST_MAX ; i++) { + rtp_slot = + &pfwinfo->rpt_fbtc_slots.finfo.slot[i]; +if (memcmp (&dm->slot_now[i], rtp_slot, +sizeof (dm->slot_now[i])) !=0 ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s %d slot_now[%d] dur=0x%04x tbl=%08x type=0x%04x\n" , + __func__, +BTC_DCNT_SLOT_NONSYNC , i, + dm->slot_now[i].dur, + dm->slot_now[i].cxtbl, + dm->slot_now[i].cxtype); + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s %d rpt_fbtc_slots[%d] dur=0x%04x tbl=%08x type=0x%04x\n" , + __func__, +BTC_DCNT_SLOT_NONSYNC , i, + rtp_slot->dur, + rtp_slot->cxtbl, + rtp_slot->cxtype); + } + } + } +_chk_btc_err (rtwdev,BTC_DCNT_SLOT_NONSYNC , +memcmp (dm->slot_now, + pfwinfo->rpt_fbtc_slots.finfo.slot, +sizeof (dm->slot_now))); + } + +if (rpt_type ==BTC_RPT_TYPE_CYSTA && + pcysta->cycles >=BTC_CYSTA_CHK_PERIOD ) { +/* Check Leak-AP */ +if (pcysta->slot_cnt[CXST_LK ] !=0 && + pcysta->leakrx_cnt !=0 && dm->tdma_now.rxflctrl) { +if (pcysta->slot_cnt[CXST_LK ] < +BTC_LEAK_AP_TH * pcysta->leakrx_cnt) + dm->leak_ap =1 ; + } + +/* Check diff time between WL slot and W1/E2G slot */ +if (dm->tdma_now.type ==CXTDMA_OFF && + dm->tdma_now.ext_ctrl ==CXECTL_EXT ) + wl_slot_set =le16_to_cpu (dm->slot_now[CXST_E2G ].dur); +else + wl_slot_set =le16_to_cpu (dm->slot_now[CXST_W1 ].dur); + +if (pcysta->tavg_cycle[CXT_WL ] > wl_slot_set) { + diff_t = pcysta->tavg_cycle[CXT_WL ] - wl_slot_set; +_chk_btc_err (rtwdev,BTC_DCNT_WL_SLOT_DRIFT , diff_t); + } + } + +if (rpt_type ==BTC_RPT_TYPE_CTRL ) { + prpt = &pfwinfo->rpt_ctrl.finfo; + btc->fwinfo.rpt_en_map = prpt->rpt_enable; + wl->ver_info.fw_coex = prpt->wl_fw_coex_ver; + wl->ver_info.fw = prpt->wl_fw_ver; + dm->wl_fw_cx_offload = !!(prpt->wl_fw_cx_offload); + } + +if (rpt_type >=BTC_RPT_TYPE_BT_VER && + rpt_type <=BTC_RPT_TYPE_BT_DEVICE ) +_update_bt_report (rtwdev, rpt_type, pfinfo); + +return (rpt_len +BTC_RPT_HDR_SIZE ); +} + +static void _parse_btc_report (struct rtw89_dev *rtwdev, +struct rtw89_btc_btf_fwinfo *pfwinfo, +u8 *pbuf,u32 buf_len) +{ +struct rtw89_btc_prpt *btc_prpt =NULL ; +u32 index =0 , rpt_len =0 ; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s buf_len:%d\n" , + __func__, buf_len); + +while (pbuf) { + btc_prpt = (struct rtw89_btc_prpt *)&pbuf[index]; +if (index +2 >=BTC_FWINFO_BUF ) +break ; +/* At least 3 bytes: type(1) & len(2) */ + rpt_len =le16_to_cpu (btc_prpt->len); +if ((index + rpt_len +BTC_RPT_HDR_SIZE ) > buf_len) +break ; + + rpt_len =_chk_btc_report (rtwdev, pfwinfo, pbuf, index); +if (!rpt_len) +break ; + index += rpt_len; + } +} + +#define BTC_TLV_HDR_LEN 2 + +static void _append_tdma (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_btf_tlv *tlv =NULL ; +struct rtw89_btc_fbtc_tdma *v =NULL ; +u16 len = btc->policy_len; + +if (!btc->update_policy_force && + !memcmp (&dm->tdma, &dm->tdma_now,sizeof (dm->tdma))) { +rtw89_debug (rtwdev, +RTW89_DBG_BTC ,"[BTC], %s(): tdma no change!\n" , + __func__); +return ; + } + + tlv = (struct rtw89_btc_btf_tlv *)&btc->policy[len]; + v = (struct rtw89_btc_fbtc_tdma *)&tlv->val[0 ]; + tlv->type =CXPOLICY_TDMA ; + tlv->len =sizeof (*v); + +memcpy (v, &dm->tdma,sizeof (*v)); + btc->policy_len +=BTC_TLV_HDR_LEN +sizeof (*v); + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: type:%d, rxflctrl=%d, txpause=%d, wtgle_n=%d, leak_n=%d, ext_ctrl=%d\n" , + __func__, dm->tdma.type, dm->tdma.rxflctrl, + dm->tdma.txpause, dm->tdma.wtgle_n, dm->tdma.leak_n, + dm->tdma.ext_ctrl); +} + +static void _append_slot (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_btf_tlv *tlv =NULL ; +struct btc_fbtc_1slot *v =NULL ; +u16 len =0 ; +u8 i, cnt =0 ; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: A:btc->policy_len = %d\n" , + __func__, btc->policy_len); + +for (i =0 ; i <CXST_MAX ; i++) { +if (!btc->update_policy_force && + !memcmp (&dm->slot[i], &dm->slot_now[i], +sizeof (dm->slot[i]))) +continue ; + + len = btc->policy_len; + + tlv = (struct rtw89_btc_btf_tlv *)&btc->policy[len]; + v = (struct btc_fbtc_1slot *)&tlv->val[0 ]; + tlv->type =CXPOLICY_SLOT ; + tlv->len =sizeof (*v); + + v->fver =FCXONESLOT_VER ; + v->sid = i; + v->slot = dm->slot[i]; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: slot-%d: dur=%d, table=0x%08x, type=%d\n" , + __func__, i, dm->slot[i].dur, dm->slot[i].cxtbl, + dm->slot[i].cxtype); + cnt++; + + btc->policy_len +=BTC_TLV_HDR_LEN +sizeof (*v); + } + +if (cnt >0 ) +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: slot update (cnt=%d)!!\n" , + __func__, cnt); +} + +static void rtw89_btc_fw_en_rpt (struct rtw89_dev *rtwdev, +u32 rpt_map,bool rpt_state) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_btf_fwinfo *fwinfo = &btc->fwinfo; +struct rtw89_btc_btf_set_report r = {0 }; +u32 val =0 ; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: rpt_map=%x, rpt_state=%x\n" , + __func__, rpt_map, rpt_state); + +if (rpt_state) + val = fwinfo->rpt_en_map | rpt_map; +else + val = fwinfo->rpt_en_map & ~rpt_map; + +if (val == fwinfo->rpt_en_map) +return ; + + fwinfo->rpt_en_map = val; + + r.fver =BTF_SET_REPORT_VER ; + r.enable =cpu_to_le32 (val); + r.para =cpu_to_le32 (rpt_state); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_REPORT_EN , &r,sizeof (r)); +} + +static void rtw89_btc_fw_set_slots (struct rtw89_dev *rtwdev,u8 num, +struct rtw89_btc_fbtc_slot *s) +{ +struct rtw89_btc_btf_set_slot_table *tbl =NULL ; +u8 *ptr =NULL ; +u16 n =0 ; + + n =sizeof (*s) * num +sizeof (*tbl); + tbl =kmalloc (n,GFP_KERNEL ); +if (!tbl) +return ; + + tbl->fver =BTF_SET_SLOT_TABLE_VER ; + tbl->tbl_num = num; + ptr = &tbl->buf[0 ]; +memcpy (ptr, s, num *sizeof (*s)); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_SLOT_TABLE , tbl, n); + +kfree (tbl); +} + +static void btc_fw_set_monreg (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_btc_btf_set_mon_reg *monreg =NULL ; +u8 n, *ptr =NULL , ulen; +u16 sz =0 ; + + n = chip->mon_reg_num; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): mon_reg_num=%d\n" , __func__, n); +if (n >CXMREG_MAX ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s: mon reg count %d > %d\n" , + __func__, n,CXMREG_MAX ); +return ; + } + + ulen =sizeof (struct rtw89_btc_fbtc_mreg ); + sz = (ulen * n) +sizeof (*monreg); + monreg =kmalloc (sz,GFP_KERNEL ); +if (!monreg) +return ; + + monreg->fver =BTF_SET_MON_REG_VER ; + monreg->reg_num = n; + ptr = &monreg->buf[0 ]; +memcpy ((void *)ptr, chip->mon_reg, n * ulen); +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): sz=%d ulen=%d n=%d\n" , + __func__, sz, ulen, n); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_MREG_TABLE , (u8 *)monreg, sz); +kfree (monreg); +rtw89_btc_fw_en_rpt (rtwdev,RPT_EN_MREG ,1 ); +} + +static void _update_dm_step (struct rtw89_dev *rtwdev, +enum btc_reason_and_action reason_or_action) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; + +/* use ring-structure to store dm step */ + dm->dm_step.step[dm->dm_step.step_pos] = reason_or_action; + dm->dm_step.step_pos++; + +if (dm->dm_step.step_pos >=ARRAY_SIZE (dm->dm_step.step)) { + dm->dm_step.step_pos =0 ; + dm->dm_step.step_ov = true; + } +} + +static void _fw_set_policy (struct rtw89_dev *rtwdev,u16 policy_type, +enum btc_reason_and_action action) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; + + dm->run_action = action; + +_update_dm_step (rtwdev, action |BTC_ACT_EXT_BIT ); +_update_dm_step (rtwdev, policy_type |BTC_POLICY_EXT_BIT ); + + btc->policy_len =0 ; + btc->policy_type = policy_type; + +_append_tdma (rtwdev); +_append_slot (rtwdev); + +if (btc->policy_len ==0 || btc->policy_len >RTW89_BTC_POLICY_MAXLEN ) +return ; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): action = %d -> policy type/len: 0x%04x/%d\n" , + __func__, action, policy_type, btc->policy_len); + +if (dm->tdma.rxflctrl ==CXFLC_NULLP || + dm->tdma.rxflctrl ==CXFLC_QOSNULL ) + btc->lps =1 ; +else + btc->lps =0 ; + +if (btc->lps ==1 ) +rtw89_set_coex_ctrl_lps (rtwdev, btc->lps); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_CX_POLICY , + btc->policy, btc->policy_len); + +memcpy (&dm->tdma_now, &dm->tdma,sizeof (dm->tdma_now)); +memcpy (&dm->slot_now, &dm->slot,sizeof (dm->slot_now)); + +if (btc->update_policy_force) + btc->update_policy_force = false; + +if (btc->lps ==0 ) +rtw89_set_coex_ctrl_lps (rtwdev, btc->lps); +} + +static void _fw_set_drv_info (struct rtw89_dev *rtwdev,u8 type) +{ +switch (type) { +case CXDRVINFO_INIT : +rtw89_fw_h2c_cxdrv_init (rtwdev); +break ; +case CXDRVINFO_ROLE : +rtw89_fw_h2c_cxdrv_role (rtwdev); +break ; +case CXDRVINFO_CTRL : +rtw89_fw_h2c_cxdrv_ctrl (rtwdev); +break ; +case CXDRVINFO_RFK : +rtw89_fw_h2c_cxdrv_rfk (rtwdev); +break ; +default : +break ; + } +} + +static +void btc_fw_event (struct rtw89_dev *rtwdev,u8 evt_id,void *data,u32 len) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_btf_fwinfo *pfwinfo = &btc->fwinfo; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s evt_id:%d len:%d\n" , + __func__, evt_id, len); + +if (!len || !data) +return ; + +switch (evt_id) { +case BTF_EVNT_RPT : +_parse_btc_report (rtwdev, pfwinfo, data, len); +break ; +default : +break ; + } +} + +static void _set_gnt_wl (struct rtw89_dev *rtwdev,u8 phy_map,u8 state) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_mac_ax_gnt *g = dm->gnt.band; +u8 i; + +if (phy_map >BTC_PHY_ALL ) +return ; + +for (i =0 ; i <RTW89_PHY_MAX ; i++) { +if (!(phy_map &BIT (i))) +continue ; + +switch (state) { +case BTC_GNT_HW : + g[i].gnt_wl_sw_en =0 ; + g[i].gnt_wl =0 ; +break ; +case BTC_GNT_SW_LO : + g[i].gnt_wl_sw_en =1 ; + g[i].gnt_wl =0 ; +break ; +case BTC_GNT_SW_HI : + g[i].gnt_wl_sw_en =1 ; + g[i].gnt_wl =1 ; +break ; + } + } + +rtw89_mac_cfg_gnt (rtwdev, &dm->gnt); +} + +#define BTC_TDMA_WLROLE_MAX 2 + +static void _set_bt_ignore_wlan_act (struct rtw89_dev *rtwdev,u8 enable) +{ +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): set bt %s wlan_act\n" , __func__, + enable ?"ignore" :"do not ignore" ); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_BT_IGNORE_WLAN_ACT , &enable,1 ); +} + +#define WL_TX_POWER_NO_BTC_CTRL GENMASK(31, 0) +#define WL_TX_POWER_ALL_TIME GENMASK(15, 0) +#define WL_TX_POWER_WITH_BT GENMASK(31, 16) +#define WL_TX_POWER_INT_PART GENMASK(8, 2) +#define WL_TX_POWER_FRA_PART GENMASK(1, 0) +#define B_BTC_WL_TX_POWER_SIGN BIT(7) +#define B_TSSI_WL_TX_POWER_SIGN BIT(8) + +static void _set_wl_tx_power (struct rtw89_dev *rtwdev,u32 level) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +u32 pwr_val; + +if (wl->rf_para.tx_pwr_freerun == level) +return ; + + wl->rf_para.tx_pwr_freerun = level; + btc->dm.rf_trx_para.wl_tx_power = level; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): level = %d\n" , + __func__, level); + +if (level ==RTW89_BTC_WL_DEF_TX_PWR ) { + pwr_val =WL_TX_POWER_NO_BTC_CTRL ; + }else {/* only apply "force tx power" */ + pwr_val =FIELD_PREP (WL_TX_POWER_INT_PART , level); +if (pwr_val >RTW89_BTC_WL_DEF_TX_PWR ) + pwr_val =RTW89_BTC_WL_DEF_TX_PWR ; + +if (level &B_BTC_WL_TX_POWER_SIGN ) + pwr_val |=B_TSSI_WL_TX_POWER_SIGN ; + pwr_val |=WL_TX_POWER_WITH_BT ; + } + + chip->ops->btc_set_wl_txpwr_ctrl (rtwdev, pwr_val); +} + +#define rtw89_btc_wl_rx_gain (rtwdev, level) do {} while (0) + +static void _set_wl_rx_gain (struct rtw89_dev *rtwdev,u32 level) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; + +if (wl->rf_para.rx_gain_freerun == level) +return ; + + wl->rf_para.rx_gain_freerun = level; + btc->dm.rf_trx_para.wl_rx_gain = level; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): level = %d\n" , + __func__, level); + +rtw89_btc_wl_rx_gain (rtwdev, level); +} + +static void _set_bt_tx_power (struct rtw89_dev *rtwdev,u8 level) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +u8 buf =0 ; + +if (bt->rf_para.tx_pwr_freerun == level) +return ; + + bt->rf_para.tx_pwr_freerun = level; + btc->dm.rf_trx_para.bt_tx_power = level; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): level = %d\n" , + __func__, level); + + buf = (s8)(-level); +_send_fw_cmd (rtwdev,BTFC_SET ,SET_BT_TX_PWR , &buf,1 ); +} + +#define BTC_BT_RX_NORMAL_LVL 7 + +static void _set_bt_rx_gain (struct rtw89_dev *rtwdev,u8 level) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; + +if (bt->rf_para.rx_gain_freerun == level || + level >BTC_BT_RX_NORMAL_LVL ) +return ; + + bt->rf_para.rx_gain_freerun = level; + btc->dm.rf_trx_para.bt_rx_gain = level; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): level = %d\n" , + __func__, level); + +if (level ==BTC_BT_RX_NORMAL_LVL ) +_write_scbd (rtwdev,BTC_WSCB_RXGAIN , false); +else +_write_scbd (rtwdev,BTC_WSCB_RXGAIN , true); + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_BT_LNA_CONSTRAIN , &level,1 ); +} + +static void _set_rf_trx_para (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_rf_trx_para para; +u8 level_id =0 ; + +if (!dm->freerun) { + dm->trx_para_level =0 ; + chip->ops->btc_bt_aci_imp (rtwdev); + } + + level_id = (u8 )dm->trx_para_level; + +if (level_id >= chip->rf_para_dlink_num || + level_id >= chip->rf_para_ulink_num) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): invalid level_id: %d\n" , + __func__, level_id); +return ; + } + +if (wl->status.map.traffic_dir &BIT (RTW89_TFC_UL )) + para = chip->rf_para_ulink[level_id]; +else + para = chip->rf_para_dlink[level_id]; + +if (para.wl_tx_power !=0 ) +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): wl_tx_power%d\n" , + __func__, para.wl_tx_power); +_set_wl_tx_power (rtwdev, para.wl_tx_power); +_set_wl_rx_gain (rtwdev, para.wl_rx_gain); +_set_bt_tx_power (rtwdev, para.bt_tx_power); +_set_bt_rx_gain (rtwdev, para.bt_rx_gain); +} + +static void _update_btc_state_map (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_wl_info *wl = &cx->wl; +struct rtw89_btc_bt_info *bt = &cx->bt; +struct rtw89_btc_bt_link_info *bt_linfo = &bt->link_info; + +if (wl->status.map.connecting || wl->status.map._4way || + wl->status.map.roaming) { + cx->state_map =BTC_WLINKING ; + }else if (wl->status.map.scan) {/* wl scan */ +if (bt_linfo->status.map.inq_pag) + cx->state_map =BTC_WSCAN_BSCAN ; +else + cx->state_map =BTC_WSCAN_BNOSCAN ; + }else if (wl->status.map.busy) {/* only busy */ +if (bt_linfo->status.map.inq_pag) + cx->state_map =BTC_WBUSY_BSCAN ; +else + cx->state_map =BTC_WBUSY_BNOSCAN ; + }else {/* wl idle */ + cx->state_map =BTC_WIDLE ; + } +} + +static void _set_bt_afh_info (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +struct rtw89_btc_bt_link_info *b = &bt->link_info; +struct rtw89_btc_wl_role_info *wl_rinfo = &wl->role_info; +u8 en =0 , i, ch =0 , bw =0 ; + +if (btc->ctrl.manual || wl->status.map.scan) +return ; + +/* TODO if include module->ant.type == BTC_ANT_SHARED */ +if (wl->status.map.rf_off || bt->whql_test || + wl_rinfo->link_mode ==BTC_WLINK_NOLINK || + wl_rinfo->link_mode ==BTC_WLINK_5G || + wl_rinfo->connect_cnt >BTC_TDMA_WLROLE_MAX ) { + en = false; + }else if (wl_rinfo->link_mode ==BTC_WLINK_2G_MCC || + wl_rinfo->link_mode ==BTC_WLINK_2G_SCC ) { + en = true; +/* get p2p channel */ +for (i =0 ; i <RTW89_MAX_HW_PORT_NUM ; i++) { +if (wl_rinfo->active_role[i].role == +RTW89_WIFI_ROLE_P2P_GO || + wl_rinfo->active_role[i].role == +RTW89_WIFI_ROLE_P2P_CLIENT ) { + ch = wl_rinfo->active_role[i].ch; + bw = wl_rinfo->active_role[i].bw; +break ; + } + } + }else { + en = true; +/* get 2g channel */ +for (i =0 ; i <RTW89_MAX_HW_PORT_NUM ; i++) { +if (wl_rinfo->active_role[i].connected && + wl_rinfo->active_role[i].band ==RTW89_BAND_2G ) { + ch = wl_rinfo->active_role[i].ch; + bw = wl_rinfo->active_role[i].bw; +break ; + } + } + } + +switch (bw) { +case RTW89_CHANNEL_WIDTH_20 : +#ifdef BTC_NON_SHARED_ANT_FREERUN + bw =48 ; +#else + bw =20 + chip->afh_guard_ch *2 ; +#endif +break ; +case RTW89_CHANNEL_WIDTH_40 : + bw =40 + chip->afh_guard_ch *2 ; +break ; +case RTW89_CHANNEL_WIDTH_5 : + bw =5 + chip->afh_guard_ch *2 ; +break ; +case RTW89_CHANNEL_WIDTH_10 : + bw =10 + chip->afh_guard_ch *2 ; +break ; +default : + bw =0 ; + en = false;/* turn off AFH info if BW > 40 */ +break ; + } + +if (wl->afh_info.en == en && + wl->afh_info.ch == ch && + wl->afh_info.bw == bw && + b->profile_cnt.last == b->profile_cnt.now) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): return because no change!\n" , + __func__); +return ; + } + + wl->afh_info.en = en; + wl->afh_info.ch = ch; + wl->afh_info.bw = bw; + +_send_fw_cmd (rtwdev,BTFC_SET ,SET_BT_WL_CH_INFO , &wl->afh_info,3 ); + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): en=%d, ch=%d, bw=%d\n" , + __func__, en, ch, bw); + btc->cx.cnt_wl[BTC_WCNT_CH_UPDATE ]++; +} + +static bool _check_freerun (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +struct rtw89_btc_wl_role_info *wl_rinfo = &wl->role_info; +struct rtw89_btc_bt_link_info *bt_linfo = &bt->link_info; +struct rtw89_btc_bt_hid_desc *hid = &bt_linfo->hid_desc; + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED ) { + btc->dm.trx_para_level =0 ; +return false; + } + +/* The below is dedicated antenna case */ +if (wl_rinfo->connect_cnt >BTC_TDMA_WLROLE_MAX ) { + btc->dm.trx_para_level =5 ; +return true; + } + +if (bt_linfo->profile_cnt.now ==0 ) { + btc->dm.trx_para_level =5 ; +return true; + } + +if (hid->pair_cnt >BTC_TDMA_BTHID_MAX ) { + btc->dm.trx_para_level =5 ; +return true; + } + +/* TODO get isolation by BT psd */ +if (btc->mdinfo.ant.isolation >=BTC_FREERUN_ANTISO_MIN ) { + btc->dm.trx_para_level =5 ; +return true; + } + +if (!wl->status.map.busy) {/* wl idle -> freerun */ + btc->dm.trx_para_level =5 ; +return true; + }else if (wl->rssi_level >1 ) {/* WL rssi < 50% (-60dBm) */ + btc->dm.trx_para_level =0 ; +return false; + }else if (wl->status.map.traffic_dir &BIT (RTW89_TFC_UL )) { +if (wl->rssi_level ==0 && bt_linfo->rssi >31 ) { + btc->dm.trx_para_level =6 ; +return true; + }else if (wl->rssi_level ==1 && bt_linfo->rssi >36 ) { + btc->dm.trx_para_level =7 ; +return true; + } + btc->dm.trx_para_level =0 ; +return false; + }else if (wl->status.map.traffic_dir &BIT (RTW89_TFC_DL )) { +if (bt_linfo->rssi >28 ) { + btc->dm.trx_para_level =6 ; +return true; + } + } + + btc->dm.trx_para_level =0 ; +return false; +} + +#define _tdma_set_flctrl (btc, flc) ({(btc)->dm.tdma.rxflctrl = flc; }) +#define _tdma_set_tog (btc, wtg) ({(btc)->dm.tdma.wtgle_n = wtg; }) +#define _tdma_set_lek (btc, lek) ({(btc)->dm.tdma.leak_n = lek; }) + +#define _slot_set (btc, sid, dura, tbl, type) \ + do { \ + typeof(sid) _sid = (sid); \ + typeof(btc) _btc = (btc); \ + _btc->dm.slot[_sid].dur = cpu_to_le16(dura);\ + _btc->dm.slot[_sid].cxtbl = cpu_to_le32(tbl); \ + _btc->dm.slot[_sid].cxtype = cpu_to_le16(type); \ + } while (0) + +#define _slot_set_dur (btc, sid, dura) (btc)->dm.slot[sid].dur = cpu_to_le16(dura) +#define _slot_set_tbl (btc, sid, tbl) (btc)->dm.slot[sid].cxtbl = cpu_to_le32(tbl) +#define _slot_set_type (btc, sid, type) (btc)->dm.slot[sid].cxtype = cpu_to_le16(type) + +struct btc_btinfo_lb2 { +u8 connect:1 ; +u8 sco_busy:1 ; +u8 inq_pag:1 ; +u8 acl_busy:1 ; +u8 hfp:1 ; +u8 hid:1 ; +u8 a2dp:1 ; +u8 pan:1 ; +}; + +struct btc_btinfo_lb3 { +u8 retry:4 ; +u8 cqddr:1 ; +u8 inq:1 ; +u8 mesh_busy:1 ; +u8 pag:1 ; +}; + +struct btc_btinfo_hb0 { +s8 rssi; +}; + +struct btc_btinfo_hb1 { +u8 ble_connect:1 ; +u8 reinit:1 ; +u8 relink:1 ; +u8 igno_wl:1 ; +u8 voice:1 ; +u8 ble_scan:1 ; +u8 role_sw:1 ; +u8 multi_link:1 ; +}; + +struct btc_btinfo_hb2 { +u8 pan_active:1 ; +u8 afh_update:1 ; +u8 a2dp_active:1 ; +u8 slave:1 ; +u8 hid_slot:2 ; +u8 hid_cnt:2 ; +}; + +struct btc_btinfo_hb3 { +u8 a2dp_bitpool:6 ; +u8 tx_3m:1 ; +u8 a2dp_sink:1 ; +}; + +union btc_btinfo { +u8 val; +struct btc_btinfo_lb2 lb2; +struct btc_btinfo_lb3 lb3; +struct btc_btinfo_hb0 hb0; +struct btc_btinfo_hb1 hb1; +struct btc_btinfo_hb2 hb2; +struct btc_btinfo_hb3 hb3; +}; + +static void _set_policy (struct rtw89_dev *rtwdev,u16 policy_type, +enum btc_reason_and_action action) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_fbtc_tdma *t = &dm->tdma; +struct rtw89_btc_fbtc_slot *s = dm->slot; +u8 type; +u32 tbl_w1, tbl_b1, tbl_b4; + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED ) { +if (btc->cx.wl.status.map._4way) + tbl_w1 = cxtbl[1 ]; +else + tbl_w1 = cxtbl[8 ]; + tbl_b1 = cxtbl[3 ]; + tbl_b4 = cxtbl[3 ]; + }else { + tbl_w1 = cxtbl[16 ]; + tbl_b1 = cxtbl[17 ]; + tbl_b4 = cxtbl[17 ]; + } + + type = (u8)((policy_type &BTC_CXP_MASK ) >>8 ); + btc->bt_req_en = false; + +switch (type) { +case BTC_CXP_USERDEF0 : + *t = t_def[CXTD_OFF ]; + s[CXST_OFF ] = s_def[CXST_OFF ]; +_slot_set_tbl (btc,CXST_OFF , cxtbl[2 ]); + btc->update_policy_force = true; +break ; +case BTC_CXP_OFF :/* TDMA off */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , false); + *t = t_def[CXTD_OFF ]; + s[CXST_OFF ] = s_def[CXST_OFF ]; + +switch (policy_type) { +case BTC_CXP_OFF_BT : +_slot_set_tbl (btc,CXST_OFF , cxtbl[2 ]); +break ; +case BTC_CXP_OFF_WL : +_slot_set_tbl (btc,CXST_OFF , cxtbl[1 ]); +break ; +case BTC_CXP_OFF_EQ0 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[0 ]); +break ; +case BTC_CXP_OFF_EQ1 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[16 ]); +break ; +case BTC_CXP_OFF_EQ2 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[17 ]); +break ; +case BTC_CXP_OFF_EQ3 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[18 ]); +break ; +case BTC_CXP_OFF_BWB0 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[5 ]); +break ; +case BTC_CXP_OFF_BWB1 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[8 ]); +break ; + } +break ; +case BTC_CXP_OFFB :/* TDMA off + beacon protect */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , false); + *t = t_def[CXTD_OFF_B2 ]; + s[CXST_OFF ] = s_def[CXST_OFF ]; +switch (policy_type) { +case BTC_CXP_OFFB_BWB0 : +_slot_set_tbl (btc,CXST_OFF , cxtbl[8 ]); +break ; + } +break ; +case BTC_CXP_OFFE :/* TDMA off + beacon protect + Ext_control */ + btc->bt_req_en = true; +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_OFF_EXT ]; +switch (policy_type) { +case BTC_CXP_OFFE_DEF : + s[CXST_E2G ] = s_def[CXST_E2G ]; + s[CXST_E5G ] = s_def[CXST_E5G ]; + s[CXST_EBT ] = s_def[CXST_EBT ]; + s[CXST_ENULL ] = s_def[CXST_ENULL ]; +break ; +case BTC_CXP_OFFE_DEF2 : +_slot_set (btc,CXST_E2G ,20 , cxtbl[1 ],SLOT_ISO ); + s[CXST_E5G ] = s_def[CXST_E5G ]; + s[CXST_EBT ] = s_def[CXST_EBT ]; + s[CXST_ENULL ] = s_def[CXST_ENULL ]; +break ; + } +break ; +case BTC_CXP_FIX :/* TDMA Fix-Slot */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_FIX ]; +switch (policy_type) { +case BTC_CXP_FIX_TD3030 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,30 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD5050 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,50 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD2030 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,30 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD4010 : +_slot_set (btc,CXST_W1 ,40 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,10 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD4020 : +_slot_set (btc,CXST_W1 ,40 , cxtbl[1 ],SLOT_MIX ); +_slot_set (btc,CXST_B1 ,20 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD7010 : +_slot_set (btc,CXST_W1 ,70 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,10 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD2060 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,60 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD3060 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,60 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TD2080 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,80 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_FIX_TDW1B1 :/* W1:B1 = user-define */ +_slot_set (btc,CXST_W1 , dm->slot_dur[CXST_W1 ], + tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 , dm->slot_dur[CXST_B1 ], + tbl_b1,SLOT_MIX ); +break ; + } +break ; +case BTC_CXP_PFIX :/* PS-TDMA Fix-Slot */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_PFIX ]; +if (btc->cx.wl.role_info.role_map.role.ap) +_tdma_set_flctrl (btc,CXFLC_QOSNULL ); + +switch (policy_type) { +case BTC_CXP_PFIX_TD3030 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,30 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PFIX_TD5050 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,50 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PFIX_TD2030 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,30 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PFIX_TD2060 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,60 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PFIX_TD3070 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,60 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PFIX_TD2080 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,80 , tbl_b1,SLOT_MIX ); +break ; + } +break ; +case BTC_CXP_AUTO :/* TDMA Auto-Slot */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_AUTO ]; +switch (policy_type) { +case BTC_CXP_AUTO_TD50200 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_AUTO_TD60200 : +_slot_set (btc,CXST_W1 ,60 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_AUTO_TD20200 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_AUTO_TDW1B1 :/* W1:B1 = user-define */ +_slot_set (btc,CXST_W1 , dm->slot_dur[CXST_W1 ], + tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 , dm->slot_dur[CXST_B1 ], + tbl_b1,SLOT_MIX ); +break ; + } +break ; +case BTC_CXP_PAUTO :/* PS-TDMA Auto-Slot */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_PAUTO ]; +switch (policy_type) { +case BTC_CXP_PAUTO_TD50200 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO_TD60200 : +_slot_set (btc,CXST_W1 ,60 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO_TD20200 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO_TDW1B1 : +_slot_set (btc,CXST_W1 , dm->slot_dur[CXST_W1 ], + tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 , dm->slot_dur[CXST_B1 ], + tbl_b1,SLOT_MIX ); +break ; + } +break ; +case BTC_CXP_AUTO2 :/* TDMA Auto-Slot2 */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_AUTO2 ]; +switch (policy_type) { +case BTC_CXP_AUTO2_TD3050 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,50 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_AUTO2_TD3070 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,70 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_AUTO2_TD5050 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,50 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_AUTO2_TD6060 : +_slot_set (btc,CXST_W1 ,60 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,60 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_AUTO2_TD2080 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,80 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_AUTO2_TDW1B4 :/* W1:B1 = user-define */ +_slot_set (btc,CXST_W1 , dm->slot_dur[CXST_W1 ], + tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B4 , dm->slot_dur[CXST_B4 ], + tbl_b4,SLOT_MIX ); +break ; + } +break ; +case BTC_CXP_PAUTO2 :/* PS-TDMA Auto-Slot2 */ +_write_scbd (rtwdev,BTC_WSCB_TDMA , true); + *t = t_def[CXTD_PAUTO2 ]; +switch (policy_type) { +case BTC_CXP_PAUTO2_TD3050 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,50 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO2_TD3070 : +_slot_set (btc,CXST_W1 ,30 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,70 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO2_TD5050 : +_slot_set (btc,CXST_W1 ,50 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,50 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO2_TD6060 : +_slot_set (btc,CXST_W1 ,60 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,60 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO2_TD2080 : +_slot_set (btc,CXST_W1 ,20 , tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B1 ,200 , tbl_b1,SLOT_MIX ); +_slot_set (btc,CXST_B4 ,80 , tbl_b4,SLOT_MIX ); +break ; +case BTC_CXP_PAUTO2_TDW1B4 :/* W1:B1 = user-define */ +_slot_set (btc,CXST_W1 , dm->slot_dur[CXST_W1 ], + tbl_w1,SLOT_ISO ); +_slot_set (btc,CXST_B4 , dm->slot_dur[CXST_B4 ], + tbl_b4,SLOT_MIX ); +break ; + } +break ; + } + +_fw_set_policy (rtwdev, policy_type, action); +} + +static void _set_gnt_bt (struct rtw89_dev *rtwdev,u8 phy_map,u8 state) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_mac_ax_gnt *g = dm->gnt.band; +u8 i; + +if (phy_map >BTC_PHY_ALL ) +return ; + +for (i =0 ; i <RTW89_PHY_MAX ; i++) { +if (!(phy_map &BIT (i))) +continue ; + +switch (state) { +case BTC_GNT_HW : + g[i].gnt_bt_sw_en =0 ; + g[i].gnt_bt =0 ; +break ; +case BTC_GNT_SW_LO : + g[i].gnt_bt_sw_en =1 ; + g[i].gnt_bt =0 ; +break ; +case BTC_GNT_SW_HI : + g[i].gnt_bt_sw_en =1 ; + g[i].gnt_bt =1 ; +break ; + } + } + +rtw89_mac_cfg_gnt (rtwdev, &dm->gnt); +} + +static void _set_bt_plut (struct rtw89_dev *rtwdev,u8 phy_map, +u8 tx_val,u8 rx_val) +{ +struct rtw89_mac_ax_plt plt; + + plt.band =RTW89_MAC_0 ; + plt.tx = tx_val; + plt.rx = rx_val; + +if (phy_map &BTC_PHY_0 ) +rtw89_mac_cfg_plt (rtwdev, &plt); + +if (!rtwdev->dbcc_en) +return ; + + plt.band =RTW89_MAC_1 ; +if (phy_map &BTC_PHY_1 ) +rtw89_mac_cfg_plt (rtwdev, &plt); +} + +static void _set_ant (struct rtw89_dev *rtwdev,bool force_exec, +u8 phy_map,u8 type) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_bt_info *bt = &cx->bt; +struct rtw89_btc_wl_dbcc_info *wl_dinfo = &wl->dbcc_info; +u8 gnt_wl_ctrl, gnt_bt_ctrl, plt_ctrl, i, b2g =0 ; +u32 ant_path_type; + + ant_path_type = ((phy_map <<8 ) + type); + +if (btc->dm.run_reason ==BTC_RSN_NTFY_POWEROFF || + btc->dm.run_reason ==BTC_RSN_NTFY_RADIO_STATE || + btc->dm.run_reason ==BTC_RSN_CMD_SET_COEX ) + force_exec =FC_EXEC ; + +if (!force_exec && ant_path_type == dm->set_ant_path) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): return by no change!!\n" , + __func__); +return ; + }else if (bt->rfk_info.map.run) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): return by bt rfk!!\n" , __func__); +return ; + }else if (btc->dm.run_reason !=BTC_RSN_NTFY_WL_RFK && + wl->rfk_info.state !=BTC_WRFK_STOP ) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): return by wl rfk!!\n" , __func__); +return ; + } + + dm->set_ant_path = ant_path_type; + +rtw89_debug (rtwdev, +RTW89_DBG_BTC , +"[BTC], %s(): path=0x%x, set_type=0x%x\n" , + __func__, phy_map, dm->set_ant_path &0xff ); + +switch (type) { +case BTC_ANT_WPOWERON : +rtw89_mac_cfg_ctrl_path (rtwdev, false); +break ; +case BTC_ANT_WINIT : +if (bt->enable.now) { +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_LO ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_HI ); + }else { +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_LO ); + } +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_bt_plut (rtwdev,BTC_PHY_ALL ,BTC_PLT_BT ,BTC_PLT_BT ); +break ; +case BTC_ANT_WONLY : +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_LO ); +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_bt_plut (rtwdev,BTC_PHY_ALL ,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +case BTC_ANT_WOFF : +rtw89_mac_cfg_ctrl_path (rtwdev, false); +_set_bt_plut (rtwdev,BTC_PHY_ALL ,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +case BTC_ANT_W2G : +rtw89_mac_cfg_ctrl_path (rtwdev, true); +if (rtwdev->dbcc_en) { +for (i =0 ; i <RTW89_PHY_MAX ; i++) { + b2g = (wl_dinfo->real_band[i] ==RTW89_BAND_2G ); + + gnt_wl_ctrl = b2g ?BTC_GNT_HW :BTC_GNT_SW_HI ; +_set_gnt_wl (rtwdev,BIT (i), gnt_wl_ctrl); + + gnt_bt_ctrl = b2g ?BTC_GNT_HW :BTC_GNT_SW_HI ; +/* BT should control by GNT_BT if WL_2G at S0 */ +if (i ==1 && + wl_dinfo->real_band[0 ] ==RTW89_BAND_2G && + wl_dinfo->real_band[1 ] ==RTW89_BAND_5G ) + gnt_bt_ctrl =BTC_GNT_HW ; +_set_gnt_bt (rtwdev,BIT (i), gnt_bt_ctrl); + + plt_ctrl = b2g ?BTC_PLT_BT :BTC_PLT_NONE ; +_set_bt_plut (rtwdev,BIT (i), + plt_ctrl, plt_ctrl); + } + }else { +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_HW ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_HW ); +_set_bt_plut (rtwdev,BTC_PHY_ALL , +BTC_PLT_BT ,BTC_PLT_BT ); + } +break ; +case BTC_ANT_W5G : +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_HW ); +_set_bt_plut (rtwdev,BTC_PHY_ALL ,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +case BTC_ANT_W25G : +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_HW ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_HW ); +_set_bt_plut (rtwdev,BTC_PHY_ALL , +BTC_PLT_GNT_WL ,BTC_PLT_GNT_WL ); +break ; +case BTC_ANT_FREERUN : +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_bt_plut (rtwdev,BTC_PHY_ALL ,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +case BTC_ANT_WRFK : +rtw89_mac_cfg_ctrl_path (rtwdev, true); +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_LO ); +_set_bt_plut (rtwdev, phy_map,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +case BTC_ANT_BRFK : +rtw89_mac_cfg_ctrl_path (rtwdev, false); +_set_gnt_wl (rtwdev, phy_map,BTC_GNT_SW_LO ); +_set_gnt_bt (rtwdev, phy_map,BTC_GNT_SW_HI ); +_set_bt_plut (rtwdev, phy_map,BTC_PLT_NONE ,BTC_PLT_NONE ); +break ; +default : +break ; + } +} + +static void _action_wl_only (struct rtw89_dev *rtwdev) +{ +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_WONLY ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_WL_ONLY ); +} + +static void _action_wl_init (struct rtw89_dev *rtwdev) +{ +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s !!\n" , __func__); + +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_WINIT ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_WL_INIT ); +} + +static void _action_wl_off (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; + +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s !!\n" , __func__); + +if (wl->status.map.rf_off || btc->dm.bt_only) +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_WOFF ); + +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_WL_OFF ); +} + +static void _action_freerun (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s !!\n" , __func__); + +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_FREERUN ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_FREERUN ); + + btc->dm.freerun = true; +} + +static void _action_bt_whql (struct rtw89_dev *rtwdev) +{ +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s !!\n" , __func__); + +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_BT_WHQL ); +} + +static void _action_bt_off (struct rtw89_dev *rtwdev) +{ +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s !!\n" , __func__); + +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_WONLY ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_BT_OFF ); +} + +static void _action_bt_idle (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_link_info *b = &btc->cx.bt.link_info; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED ) {/* shared-antenna */ +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/*wl-busy + bt idle*/ +if (b->profile_cnt.now >0 ) +_set_policy (rtwdev,BTC_CXP_FIX_TD4010 , +BTC_ACT_BT_IDLE ); +else +_set_policy (rtwdev,BTC_CXP_FIX_TD4020 , +BTC_ACT_BT_IDLE ); +break ; +case BTC_WBUSY_BSCAN :/*wl-busy + bt-inq */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD5050 , +BTC_ACT_BT_IDLE ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-idle */ +if (b->profile_cnt.now >0 ) +_set_policy (rtwdev,BTC_CXP_FIX_TD4010 , +BTC_ACT_BT_IDLE ); +else +_set_policy (rtwdev,BTC_CXP_FIX_TD4020 , +BTC_ACT_BT_IDLE ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq */ +_set_policy (rtwdev,BTC_CXP_FIX_TD5050 , +BTC_ACT_BT_IDLE ); +break ; +case BTC_WLINKING :/* wl-connecting + bt-inq or bt-idle */ +_set_policy (rtwdev,BTC_CXP_FIX_TD7010 , +BTC_ACT_BT_IDLE ); +break ; +case BTC_WIDLE :/* wl-idle + bt-idle */ +_set_policy (rtwdev,BTC_CXP_OFF_BWB1 ,BTC_ACT_BT_IDLE ); +break ; + } + }else {/* dedicated-antenna */ +_set_policy (rtwdev,BTC_CXP_OFF_EQ0 ,BTC_ACT_BT_IDLE ); + } +} + +static void _action_bt_hfp (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED ) { +if (btc->cx.wl.status.map._4way) +_set_policy (rtwdev,BTC_CXP_OFF_WL ,BTC_ACT_BT_HFP ); +else +_set_policy (rtwdev,BTC_CXP_OFF_BWB0 ,BTC_ACT_BT_HFP ); + }else { +_set_policy (rtwdev,BTC_CXP_OFF_EQ2 ,BTC_ACT_BT_HFP ); + } +} + +static void _action_bt_hid (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED )/* shared-antenna */ +if (btc->cx.wl.status.map._4way) +_set_policy (rtwdev,BTC_CXP_OFF_WL ,BTC_ACT_BT_HID ); +else +_set_policy (rtwdev,BTC_CXP_OFF_BWB0 ,BTC_ACT_BT_HID ); +else /* dedicated-antenna */ +_set_policy (rtwdev,BTC_CXP_OFF_EQ3 ,BTC_ACT_BT_HID ); +} + +static void _action_bt_a2dp (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_link_info *bt_linfo = &btc->cx.bt.link_info; +struct rtw89_btc_bt_a2dp_desc a2dp = bt_linfo->a2dp_desc; +struct rtw89_btc_dm *dm = &btc->dm; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-A2DP */ +if (a2dp.vendor_id ==0x4c || dm->leak_ap) { + dm->slot_dur[CXST_W1 ] =40 ; + dm->slot_dur[CXST_B1 ] =200 ; +_set_policy (rtwdev, +BTC_CXP_PAUTO_TDW1B1 ,BTC_ACT_BT_A2DP ); + }else { +_set_policy (rtwdev, +BTC_CXP_PAUTO_TD50200 ,BTC_ACT_BT_A2DP ); + } +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-A2DP */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3050 ,BTC_ACT_BT_A2DP ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-A2DP */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3050 ,BTC_ACT_BT_A2DP ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-A2DP */ +case BTC_WLINKING :/* wl-connecting + bt-A2DP */ +if (a2dp.vendor_id ==0x4c || dm->leak_ap) { + dm->slot_dur[CXST_W1 ] =40 ; + dm->slot_dur[CXST_B1 ] =200 ; +_set_policy (rtwdev,BTC_CXP_AUTO_TDW1B1 , +BTC_ACT_BT_A2DP ); + }else { +_set_policy (rtwdev,BTC_CXP_AUTO_TD50200 , +BTC_ACT_BT_A2DP ); + } +break ; +case BTC_WIDLE :/* wl-idle + bt-A2DP */ +_set_policy (rtwdev,BTC_CXP_AUTO_TD20200 ,BTC_ACT_BT_A2DP ); +break ; + } +} + +static void _action_bt_a2dpsink (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD2030 ,BTC_ACT_BT_A2DPSINK ); +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD2060 ,BTC_ACT_BT_A2DPSINK ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_FIX_TD2030 ,BTC_ACT_BT_A2DPSINK ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_FIX_TD2060 ,BTC_ACT_BT_A2DPSINK ); +break ; +case BTC_WLINKING :/* wl-connecting + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_FIX_TD3030 ,BTC_ACT_BT_A2DPSINK ); +break ; +case BTC_WIDLE :/* wl-idle + bt-A2dp_Sink */ +_set_policy (rtwdev,BTC_CXP_FIX_TD2080 ,BTC_ACT_BT_A2DPSINK ); +break ; + } +} + +static void _action_bt_pan (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-PAN */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD5050 ,BTC_ACT_BT_PAN ); +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-PAN */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD3070 ,BTC_ACT_BT_PAN ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-PAN */ +_set_policy (rtwdev,BTC_CXP_FIX_TD3030 ,BTC_ACT_BT_PAN ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-PAN */ +_set_policy (rtwdev,BTC_CXP_FIX_TD3060 ,BTC_ACT_BT_PAN ); +break ; +case BTC_WLINKING :/* wl-connecting + bt-PAN */ +_set_policy (rtwdev,BTC_CXP_FIX_TD4020 ,BTC_ACT_BT_PAN ); +break ; +case BTC_WIDLE :/* wl-idle + bt-pan */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD2080 ,BTC_ACT_BT_PAN ); +break ; + } +} + +static void _action_bt_a2dp_hid (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_link_info *bt_linfo = &btc->cx.bt.link_info; +struct rtw89_btc_bt_a2dp_desc a2dp = bt_linfo->a2dp_desc; +struct rtw89_btc_dm *dm = &btc->dm; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-A2DP+HID */ +case BTC_WIDLE :/* wl-idle + bt-A2DP */ +if (a2dp.vendor_id ==0x4c || dm->leak_ap) { + dm->slot_dur[CXST_W1 ] =40 ; + dm->slot_dur[CXST_B1 ] =200 ; +_set_policy (rtwdev, +BTC_CXP_PAUTO_TDW1B1 ,BTC_ACT_BT_A2DP_HID ); + }else { +_set_policy (rtwdev, +BTC_CXP_PAUTO_TD50200 ,BTC_ACT_BT_A2DP_HID ); + } +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-A2DP+HID */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3050 ,BTC_ACT_BT_A2DP_HID ); +break ; + +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-A2DP+HID */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3050 ,BTC_ACT_BT_A2DP_HID ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-A2DP+HID */ +case BTC_WLINKING :/* wl-connecting + bt-A2DP+HID */ +if (a2dp.vendor_id ==0x4c || dm->leak_ap) { + dm->slot_dur[CXST_W1 ] =40 ; + dm->slot_dur[CXST_B1 ] =200 ; +_set_policy (rtwdev,BTC_CXP_AUTO_TDW1B1 , +BTC_ACT_BT_A2DP_HID ); + }else { +_set_policy (rtwdev,BTC_CXP_AUTO_TD50200 , +BTC_ACT_BT_A2DP_HID ); + } +break ; + } +} + +static void _action_bt_a2dp_pan (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3070 ,BTC_ACT_BT_A2DP_PAN ); +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3070 ,BTC_ACT_BT_A2DP_PAN ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD5050 ,BTC_ACT_BT_A2DP_PAN ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3070 ,BTC_ACT_BT_A2DP_PAN ); +break ; +case BTC_WLINKING :/* wl-connecting + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3050 ,BTC_ACT_BT_A2DP_PAN ); +break ; +case BTC_WIDLE :/* wl-idle + bt-A2DP+PAN */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD2080 ,BTC_ACT_BT_A2DP_PAN ); +break ; + } +} + +static void _action_bt_pan_hid (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD3030 ,BTC_ACT_BT_PAN_HID ); +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD3070 ,BTC_ACT_BT_PAN_HID ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_FIX_TD3030 ,BTC_ACT_BT_PAN_HID ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_FIX_TD3060 ,BTC_ACT_BT_PAN_HID ); +break ; +case BTC_WLINKING :/* wl-connecting + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_FIX_TD4010 ,BTC_ACT_BT_PAN_HID ); +break ; +case BTC_WIDLE :/* wl-idle + bt-PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PFIX_TD2080 ,BTC_ACT_BT_PAN_HID ); +break ; + } +} + +static void _action_bt_a2dp_pan_hid (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +switch (btc->cx.state_map) { +case BTC_WBUSY_BNOSCAN :/* wl-busy + bt-A2DP+PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3070 , +BTC_ACT_BT_A2DP_PAN_HID ); +break ; +case BTC_WBUSY_BSCAN :/* wl-busy + bt-inq + bt-A2DP+PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD3070 , +BTC_ACT_BT_A2DP_PAN_HID ); +break ; +case BTC_WSCAN_BSCAN :/* wl-scan + bt-inq + bt-A2DP+PAN+HID */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3070 , +BTC_ACT_BT_A2DP_PAN_HID ); +break ; +case BTC_WSCAN_BNOSCAN :/* wl-scan + bt-A2DP+PAN+HID */ +case BTC_WLINKING :/* wl-connecting + bt-A2DP+PAN+HID */ +_set_policy (rtwdev,BTC_CXP_AUTO2_TD3050 , +BTC_ACT_BT_A2DP_PAN_HID ); +break ; +case BTC_WIDLE :/* wl-idle + bt-A2DP+PAN+HID */ +_set_policy (rtwdev,BTC_CXP_PAUTO2_TD2080 , +BTC_ACT_BT_A2DP_PAN_HID ); +break ; + } +} + +static void _action_wl_5g (struct rtw89_dev *rtwdev) +{ +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W5G ); +_set_policy (rtwdev,BTC_CXP_OFF_EQ0 ,BTC_ACT_WL_5G ); +} + +static void _action_wl_other (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); + +if (btc->mdinfo.ant.type ==BTC_ANT_SHARED ) +_set_policy (rtwdev,BTC_CXP_OFFB_BWB0 ,BTC_ACT_WL_OTHER ); +else +_set_policy (rtwdev,BTC_CXP_OFF_EQ0 ,BTC_ACT_WL_OTHER ); +} + +static void _action_wl_nc (struct rtw89_dev *rtwdev) +{ +_set_ant (rtwdev,NM_EXEC ,BTC_PHY_ALL ,BTC_ANT_W2G ); +_set_policy (rtwdev,BTC_CXP_OFF_BT ,BTC_ACT_WL_NC ); +} + +static void _action_wl_rfk (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_rfk_info rfk = btc->cx.wl.rfk_info; + +if (rfk.state !=BTC_WRFK_START ) +return ; + +rtw89_debug (rtwdev,RTW89_DBG_BTC ,"[BTC], %s(): band = %d\n" , + __func__, rfk.band); + +_set_ant (rtwdev,FC_EXEC ,BTC_PHY_ALL ,BTC_ANT_WRFK ); +_set_policy (rtwdev,BTC_CXP_OFF_WL ,BTC_ACT_WL_RFK ); +} + +static void _set_btg_ctrl (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_wl_role_info *wl_rinfo = &wl->role_info; +struct rtw89_btc_wl_dbcc_info *wl_dinfo = &wl->dbcc_info; +bool is_btg = false; + +if (btc->ctrl.manual) +return ; + +/* notify halbb ignore GNT_BT or not for WL BB Rx-AGC control */ +if (btc->mdinfo.ant.type ==BTC_ANT_DEDICATED ) + is_btg = false; +else if (wl_rinfo->link_mode ==BTC_WLINK_5G )/* always 0 if 5G */ + is_btg = false; +else if (wl_rinfo->link_mode ==BTC_WLINK_25G_DBCC && + wl_dinfo->real_band[RTW89_PHY_1 ] !=RTW89_BAND_2G ) + is_btg = false; +else + is_btg = true; + +if (btc->dm.run_reason !=BTC_RSN_NTFY_INIT && + is_btg == btc->dm.wl_btg_rx) +return ; + + btc->dm.wl_btg_rx = is_btg; + +if (wl_rinfo->link_mode ==BTC_WLINK_25G_MCC ) +return ; + +rtw89_ctrl_btg (rtwdev, is_btg); +} + +struct rtw89_txtime_data { +struct rtw89_dev *rtwdev; +int type; +u32 tx_time; +u8 tx_retry; +u16 enable; +bool reenable; +}; + +static void rtw89_tx_time_iter (void *data,struct ieee80211_sta *sta) +{ +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rtw89_txtime_data *iter_data = + (struct rtw89_txtime_data *)data; +struct rtw89_dev *rtwdev = iter_data->rtwdev; +struct rtw89_vif *rtwvif = rtwsta->rtwvif; +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_wl_info *wl = &cx->wl; +struct rtw89_btc_wl_link_info *plink =NULL ; +u8 port = rtwvif->port; +u32 tx_time = iter_data->tx_time; +u8 tx_retry = iter_data->tx_retry; +u16 enable = iter_data->enable; +bool reenable = iter_data->reenable; + + plink = &wl->link_info[port]; + +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): port = %d\n" , __func__, port); + +if (!plink->connected) { +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): connected = %d\n" , + __func__, plink->connected); +return ; + } + +/* backup the original tx time before tx-limit on */ +if (reenable) { +rtw89_mac_get_tx_time (rtwdev, rtwsta, &plink->tx_time); +rtw89_mac_get_tx_retry_limit (rtwdev, rtwsta, &plink->tx_retry); +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): reenable, tx_time=%d tx_retry= %d\n" , + __func__, plink->tx_time, plink->tx_retry); + } + +/* restore the original tx time if no tx-limit */ +if (!enable) { +rtw89_mac_set_tx_time (rtwdev, rtwsta, true, plink->tx_time); +rtw89_mac_set_tx_retry_limit (rtwdev, rtwsta, true, + plink->tx_retry); +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): restore, tx_time=%d tx_retry= %d\n" , + __func__, plink->tx_time, plink->tx_retry); + + }else { +rtw89_mac_set_tx_time (rtwdev, rtwsta, false, tx_time); +rtw89_mac_set_tx_retry_limit (rtwdev, rtwsta, false, tx_retry); +rtw89_debug (rtwdev,RTW89_DBG_BTC , +"[BTC], %s(): set, tx_time=%d tx_retry= %d\n" , + __func__, tx_time, tx_retry); + } +} + +static void _set_wl_tx_limit (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_cx *cx = &btc->cx; +struct rtw89_btc_dm *dm = &btc->dm; +struct rtw89_btc_wl_info *wl = &cx->wl; +struct rtw89_btc_bt_info *bt = &cx->bt; +struct rtw89_btc_bt_link_info *b = &bt->link_info; +struct rtw89_btc_bt_hfp_desc *hfp = &b->hfp_desc; +struct rtw89_btc_bt_hid_desc *hid = &b->hid_desc; +struct rtw89_btc_wl_role_info *wl_rinfo = &wl->role_info; +struct rtw89_txtime_data data = {.rtwdev = rtwdev}; +u8 mode = wl_rinfo->link_mode; +u8 tx_retry =0 ; +u32 tx_time =0 ; +u16 enable =0 ; +bool reenable = false; + +if (btc->ctrl.manual) +return ; + +if (btc->dm.freerun || btc->ctrl.igno_bt || b->profile_cnt.now ==0 || + mode ==BTC_WLINK_5G || mode ==BTC_WLINK_NOLINK ) { + enable =0 ; + tx_time =BTC_MAX_TX_TIME_DEF ; + tx_retry =BTC_MAX_TX_RETRY_DEF ; + }else if ((hfp->exist && hid->exist) || hid->pair_cnt >1 ) { + enable =1 ; + tx_time =BTC_MAX_TX_TIME_L2 ; + tx_retry =BTC_MAX_TX_RETRY_L1 ; + }else if (hfp->exist || hid->exist) { + enable =1 ; + tx_time =BTC_MAX_TX_TIME_L3 ; + tx_retry =BTC_MAX_TX_RETRY_L1 ; + }else { + enable =0 ; + tx_time =BTC_MAX_TX_TIME_DEF ; + tx_retry =BTC_MAX_TX_RETRY_DEF ; + } + +if (dm->wl_tx_limit.enable == enable && + dm->wl_tx_limit.tx_time == tx_time && + dm->wl_tx_limit.tx_retry == tx_retry) +return ; + +if (!dm->wl_tx_limit.enable && enable) + reenable = true; + + dm->wl_tx_limit.enable = enable; + dm->wl_tx_limit.tx_time = tx_time; + dm->wl_tx_limit.tx_retry = tx_retry; + + data.enable = enable; + data.tx_time = tx_time; + data.tx_retry = tx_retry; + data.reenable = reenable; + +ieee80211_iterate_stations_atomic (rtwdev->hw, + rtw89_tx_time_iter, + &data); +} + +#define _set_bt_slot_req (rtwdev) do {} while (0) + +static void _set_bt_rx_agc (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_wl_info *wl = &btc->cx.wl; +struct rtw89_btc_wl_role_info *wl_rinfo = &wl->role_info; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +bool bt_hi_lna_rx = false; + +if (wl_rinfo->link_mode !=BTC_WLINK_NOLINK && btc->dm.wl_btg_rx) + bt_hi_lna_rx = true; + +if (bt_hi_lna_rx == bt->hi_lna_rx) +return ; + +_write_scbd (rtwdev,BTC_WSCB_BT_HILNA , bt_hi_lna_rx); +} + +/* TODO add these functions */ +static void _action_common (struct rtw89_dev *rtwdev) +{ +_set_btg_ctrl (rtwdev); +_set_wl_tx_limit (rtwdev); +_set_bt_afh_info (rtwdev); +_set_bt_rx_agc (rtwdev); +_set_bt_slot_req (rtwdev); +_set_rf_trx_para (rtwdev); +} + +static void _action_by_bt (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +struct rtw89_btc_bt_info *bt = &btc->cx.bt; +struct rtw89_btc_bt_link_info *bt_linfo = &bt->link_info; +struct rtw89_btc_bt_hid_desc hid = bt_linfo->hid_desc; +struct rtw89_btc_bt_a2dp_desc a2dp = bt_linfo->a2dp_desc; +struct rtw89_btc_bt_pan_desc pan = bt_linfo->pan_desc; +u8 profile_map =0 ; + +if (bt_linfo->hfp_desc.exist) + profile_map |=BTC_BT_HFP ; + +if (bt_linfo->hid_desc.exist) + profile_map |=BTC_BT_HID ; + +if (bt_linfo->a2dp_desc.exist) + profile_map |=BTC_BT_A2DP ; + +if (bt_linfo->pan_desc.exist) + profile_map |=BTC_BT_PAN ; + +switch (profile_map) { +case BTC_BT_NOPROFILE : +if (_check_freerun (rtwdev)) +_action_freerun (rtwdev); +else if (a2dp.active || pan.active) +_action_bt_pan (rtwdev); +else +_action_bt_idle (rtwdev); +break ; +case BTC_BT_HFP : +if (_check_freerun (rtwdev)) +_action_freerun (rtwdev); +else +_action_bt_hfp (rtwdev); +break ; +case BTC_BT_HFP |BTC_BT_HID : +case BTC_BT_HID : +if (_check_freerun (rtwdev)) +_action_freerun (rtwdev); +else +_action_bt_hid (rtwdev); +break ; +case BTC_BT_A2DP : +if (_check_freerun (rtwdev)) +_action_freerun (rtwdev); +else if (a2dp.sink) +_action_bt_a2dpsink (rtwdev); +else if (bt_linfo->multi_link.now && !hid.pair_cnt) +_action_bt_a2dp_pan (rtwdev); +else +_action_bt_a2dp (rtwdev); +break ; +case BTC_BT_PAN : +_action_bt_pan (rtwdev); +break ; +case BTC_BT_A2DP |BTC_BT_HFP : +case BTC_BT_A2DP |BTC_BT_HID : +case BTC_BT_A2DP |BTC_BT_HFP |BTC_BT_HID : +if (_check_freerun (rtwdev)) +_action_freerun (rtwdev); +else
Lines of this file are not shown. View the raw message.
drivers/net/wireless/realtek/rtw89/coex.h new file +152 -0
152 lines not on this page · raw message
The rest of this diff is not shown. View the raw message.
Signature · 1 line
2.25.1
Part of the diff is not shown here. View the raw message.
Ping-Ke Shih
maintainerPATCH 3/24 rtw89: add core and trx files
In reply to Ping-Ke ShihImplement main flows that contains register/unregister mac80211 hw with hardware capability, power on/off sequence, STA state actions, and TX/RX path.
The chip info is read from efuse while probing PCI, and then it can be used to induce supported channel, band, bitrate, ht/vht/he capability, and etc. Then, we register hardware with these capabilities.
When network interface is up, driver does power-on sequence to enable MAC, BB and RF function blocks. Oppositely, do power-off sequence when interface is going to down.
To maintain STA state, five callbacks are implemented -- add, assoc, disassoc, disconnect and remove. In which state, driver tells firmware STA info via H2C.
TX flow:
When a SKB is going to be transmitted, we must know its type first. If the type is mgmt or fwcmd made by driver, SKB is queued into corresponding DMA channel and PCI ring. The other type is data frame that is more complex, because it needs to establish BA session to have better throughput with AMPDU and AMSDU.
In order to have better PCI DMA efficiency, we don't kick off DMA every SKB. With wake TX queue, kick off DMA after a bunch of SKBs are written. To achieve this, we have two HCI ops -- tx_write and tx_kick_off.
BA establishment work:
For data frames, we start to establish BA session if the STA is associated with APMDU capability and the TID session isn't established, and then the BA work is used to ask mac80211 to start AMPDU actions. Driver implements AMPDU action callbacks to know the session is established, so that we can set AGG_EN bit in TX descriptor to enable AMPDU.
RX flow:
When a RX SKB is delivered from PCI, rtw89_core_rx() process it depneds on its type -- WIFI, C2H or PPDU. If type is C2H, it's queued into a C2H queue, and wake a work to handle the C2H packet. If type is WIFI, it's a normal RX packet. When mgmt or data frame is received, it is queued into pending RX SKB queue to wait for corresponding PPDU packet (another RX packet with PPDU type) to fill its rx_status, like RSSI. And, then indicate this packet to mac80211. When control frame is received, indicate it to mac80211 immediately.
Track work:
Use track work to monitor PHY status to know the changes of environment, and then update RA status or do RFK accordingly.
--- drivers/net/wireless/realtek/rtw89/core.c | 2359 +++++++++++++++ drivers/net/wireless/realtek/rtw89/core.h | 3336 +++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/txrx.h | 393 +++ drivers/net/wireless/realtek/rtw89/util.c | 37 + drivers/net/wireless/realtek/rtw89/util.h | 31 + 5 files changed, 6156 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/core.c create mode 100644 drivers/net/wireless/realtek/rtw89/core.h create mode 100644 drivers/net/wireless/realtek/rtw89/txrx.h create mode 100644 drivers/net/wireless/realtek/rtw89/util.c create mode 100644 drivers/net/wireless/realtek/rtw89/util.h
drivers/net/wireless/realtek/rtw89/core.c new file +2359 -0
@@ -0,0 +1,2359 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "coex.h" +#include "core.h" +#include "efuse.h" +#include "fw.h" +#include "mac.h" +#include "phy.h" +#include "ps.h" +#include "reg.h" +#include "sar.h" +#include "ser.h" +#include "txrx.h" +#include "util.h" + +static bool rtw89_disable_ps_mode; +module_param_named (disable_ps_mode, rtw89_disable_ps_mode, bool,0644 ); +MODULE_PARM_DESC (disable_ps_mode,"Set Y to disable low power mode" ); + +static struct ieee80211_channel rtw89_channels_2ghz[] = { + { .center_freq =2412 , .hw_value =1 , }, + { .center_freq =2417 , .hw_value =2 , }, + { .center_freq =2422 , .hw_value =3 , }, + { .center_freq =2427 , .hw_value =4 , }, + { .center_freq =2432 , .hw_value =5 , }, + { .center_freq =2437 , .hw_value =6 , }, + { .center_freq =2442 , .hw_value =7 , }, + { .center_freq =2447 , .hw_value =8 , }, + { .center_freq =2452 , .hw_value =9 , }, + { .center_freq =2457 , .hw_value =10 , }, + { .center_freq =2462 , .hw_value =11 , }, + { .center_freq =2467 , .hw_value =12 , }, + { .center_freq =2472 , .hw_value =13 , }, + { .center_freq =2484 , .hw_value =14 , }, +}; + +static struct ieee80211_channel rtw89_channels_5ghz[] = { + {.center_freq =5180 , .hw_value =36 ,}, + {.center_freq =5200 , .hw_value =40 ,}, + {.center_freq =5220 , .hw_value =44 ,}, + {.center_freq =5240 , .hw_value =48 ,}, + {.center_freq =5260 , .hw_value =52 ,}, + {.center_freq =5280 , .hw_value =56 ,}, + {.center_freq =5300 , .hw_value =60 ,}, + {.center_freq =5320 , .hw_value =64 ,}, + {.center_freq =5500 , .hw_value =100 ,}, + {.center_freq =5520 , .hw_value =104 ,}, + {.center_freq =5540 , .hw_value =108 ,}, + {.center_freq =5560 , .hw_value =112 ,}, + {.center_freq =5580 , .hw_value =116 ,}, + {.center_freq =5600 , .hw_value =120 ,}, + {.center_freq =5620 , .hw_value =124 ,}, + {.center_freq =5640 , .hw_value =128 ,}, + {.center_freq =5660 , .hw_value =132 ,}, + {.center_freq =5680 , .hw_value =136 ,}, + {.center_freq =5700 , .hw_value =140 ,}, + {.center_freq =5720 , .hw_value =144 ,}, + {.center_freq =5745 , .hw_value =149 ,}, + {.center_freq =5765 , .hw_value =153 ,}, + {.center_freq =5785 , .hw_value =157 ,}, + {.center_freq =5805 , .hw_value =161 ,}, + {.center_freq =5825 , .hw_value =165 , + .flags =IEEE80211_CHAN_NO_HT40MINUS }, +}; + +static struct ieee80211_rate rtw89_bitrates[] = { + { .bitrate =10 , .hw_value =0x00 , }, + { .bitrate =20 , .hw_value =0x01 , }, + { .bitrate =55 , .hw_value =0x02 , }, + { .bitrate =110 , .hw_value =0x03 , }, + { .bitrate =60 , .hw_value =0x04 , }, + { .bitrate =90 , .hw_value =0x05 , }, + { .bitrate =120 , .hw_value =0x06 , }, + { .bitrate =180 , .hw_value =0x07 , }, + { .bitrate =240 , .hw_value =0x08 , }, + { .bitrate =360 , .hw_value =0x09 , }, + { .bitrate =480 , .hw_value =0x0a , }, + { .bitrate =540 , .hw_value =0x0b , }, +}; + +u16 rtw89_ra_report_to_bitrate (struct rtw89_dev *rtwdev,u8 rpt_rate) +{ +struct ieee80211_rate rate; + +if (unlikely (rpt_rate >=ARRAY_SIZE (rtw89_bitrates))) { +rtw89_info (rtwdev,"invalid rpt rate %d\n" , rpt_rate); +return 0 ; + } + + rate = rtw89_bitrates[rpt_rate]; + +return rate.bitrate; +} + +static struct ieee80211_supported_band rtw89_sband_2ghz = { + .band =NL80211_BAND_2GHZ , + .channels = rtw89_channels_2ghz, + .n_channels =ARRAY_SIZE (rtw89_channels_2ghz), + .bitrates = rtw89_bitrates, + .n_bitrates =ARRAY_SIZE (rtw89_bitrates), + .ht_cap = {0 }, + .vht_cap = {0 }, +}; + +static struct ieee80211_supported_band rtw89_sband_5ghz = { + .band =NL80211_BAND_5GHZ , + .channels = rtw89_channels_5ghz, + .n_channels =ARRAY_SIZE (rtw89_channels_5ghz), + +/* 5G has no CCK rates, 1M/2M/5.5M/11M */ + .bitrates = rtw89_bitrates +4 , + .n_bitrates =ARRAY_SIZE (rtw89_bitrates) -4 , + .ht_cap = {0 }, + .vht_cap = {0 }, +}; + +static void rtw89_traffic_stats_accu (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats, +struct sk_buff *skb,bool tx) +{ +struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + +if (!ieee80211_is_data (hdr->frame_control)) +return ; + +if (is_broadcast_ether_addr (hdr->addr1) || +is_multicast_ether_addr (hdr->addr1)) +return ; + +if (tx) { + stats->tx_cnt++; + stats->tx_unicast += skb->len; + }else { + stats->rx_cnt++; + stats->rx_unicast += skb->len; + } +} + +static void rtw89_get_channel_params (struct cfg80211_chan_def *chandef, +struct rtw89_channel_params *chan_param) +{ +struct ieee80211_channel *channel = chandef->chan; +enum nl80211_chan_width width = chandef->width; +u8 *cch_by_bw = chan_param->cch_by_bw; +u32 primary_freq, center_freq; +u8 center_chan; +u8 bandwidth =RTW89_CHANNEL_WIDTH_20 ; +u8 primary_chan_idx =0 ; +u8 i; + + center_chan = channel->hw_value; + primary_freq = channel->center_freq; + center_freq = chandef->center_freq1; + +/* assign the center channel used while 20M bw is selected */ + cch_by_bw[RTW89_CHANNEL_WIDTH_20 ] = channel->hw_value; + +switch (width) { +case NL80211_CHAN_WIDTH_20_NOHT : +case NL80211_CHAN_WIDTH_20 : + bandwidth =RTW89_CHANNEL_WIDTH_20 ; + primary_chan_idx =RTW89_SC_DONT_CARE ; +break ; +case NL80211_CHAN_WIDTH_40 : + bandwidth =RTW89_CHANNEL_WIDTH_40 ; +if (primary_freq > center_freq) { + primary_chan_idx =RTW89_SC_20_UPPER ; + center_chan -=2 ; + }else { + primary_chan_idx =RTW89_SC_20_LOWER ; + center_chan +=2 ; + } +break ; +case NL80211_CHAN_WIDTH_80 : + bandwidth =RTW89_CHANNEL_WIDTH_80 ; +if (primary_freq > center_freq) { +if (primary_freq - center_freq ==10 ) { + primary_chan_idx =RTW89_SC_20_UPPER ; + center_chan -=2 ; + }else { + primary_chan_idx =RTW89_SC_20_UPMOST ; + center_chan -=6 ; + } +/* assign the center channel used +* while 40M bw is selected +*/ + cch_by_bw[RTW89_CHANNEL_WIDTH_40 ] = center_chan +4 ; + }else { +if (center_freq - primary_freq ==10 ) { + primary_chan_idx =RTW89_SC_20_LOWER ; + center_chan +=2 ; + }else { + primary_chan_idx =RTW89_SC_20_LOWEST ; + center_chan +=6 ; + } +/* assign the center channel used +* while 40M bw is selected +*/ + cch_by_bw[RTW89_CHANNEL_WIDTH_40 ] = center_chan -4 ; + } +break ; +default : + center_chan =0 ; +break ; + } + + chan_param->center_chan = center_chan; + chan_param->primary_chan = channel->hw_value; + chan_param->bandwidth = bandwidth; + chan_param->pri_ch_idx = primary_chan_idx; + +/* assign the center channel used while current bw is selected */ + cch_by_bw[bandwidth] = center_chan; + +for (i = bandwidth +1 ; i <=RTW89_MAX_CHANNEL_WIDTH ; i++) + cch_by_bw[i] =0 ; +} + +void rtw89_set_channel (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_hal *hal = &rtwdev->hal; +struct rtw89_channel_params ch_param; +struct rtw89_channel_help_params bak; +u8 center_chan, bandwidth; +u8 band_type; +bool band_changed; +u8 i; + +rtw89_get_channel_params (&hw->conf.chandef, &ch_param); +if (WARN (ch_param.center_chan ==0 ,"Invalid channel\n" )) +return ; + + center_chan = ch_param.center_chan; + bandwidth = ch_param.bandwidth; + band_type = center_chan >14 ?RTW89_BAND_5G :RTW89_BAND_2G ; + band_changed = hal->current_band_type != band_type || + hal->current_channel ==0 ; + + hal->current_band_width = bandwidth; + hal->current_channel = center_chan; + hal->current_primary_channel = ch_param.primary_chan; + hal->current_band_type = band_type; + +switch (center_chan) { + case 1 ... 14: + hal->current_subband =RTW89_CH_2G ; +break ; + case 36 ... 64: + hal->current_subband =RTW89_CH_5G_BAND_1 ; +break ; + case 100 ... 144: + hal->current_subband =RTW89_CH_5G_BAND_3 ; +break ; + case 149 ... 177: + hal->current_subband =RTW89_CH_5G_BAND_4 ; +break ; + } + +for (i =RTW89_CHANNEL_WIDTH_20 ; i <=RTW89_MAX_CHANNEL_WIDTH ; i++) + hal->cch_by_bw[i] = ch_param.cch_by_bw[i]; + +rtw89_chip_set_channel_prepare (rtwdev, &bak); + + chip->ops->set_channel (rtwdev, &ch_param); + +rtw89_chip_set_txpwr (rtwdev); + +rtw89_chip_set_channel_done (rtwdev, &bak); + +if (band_changed) { +rtw89_btc_ntfy_switch_band (rtwdev,RTW89_PHY_0 , hal->current_band_type); +rtw89_chip_rfk_band_changed (rtwdev); + } +} + +static enum rtw89_core_tx_type +rtw89_core_get_tx_type (struct rtw89_dev *rtwdev, +struct sk_buff *skb) +{ +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; + +if (ieee80211_is_mgmt (fc) ||ieee80211_is_nullfunc (fc)) +return RTW89_CORE_TX_TYPE_MGMT ; + +return RTW89_CORE_TX_TYPE_DATA ; +} + +static void +rtw89_core_tx_update_ampdu_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req,u8 tid) +{ +struct ieee80211_sta *sta = tx_req->sta; +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct rtw89_sta *rtwsta; +u8 ampdu_num; + +if (!sta) { +rtw89_warn (rtwdev,"cannot set ampdu info without sta\n" ); +return ; + } + + rtwsta = (struct rtw89_sta *)sta->drv_priv; + + ampdu_num = (u8)((rtwsta->ampdu_params[tid].agg_num ? + rtwsta->ampdu_params[tid].agg_num : +4 << sta->ht_cap.ampdu_factor) -1 ); + + desc_info->agg_en = true; + desc_info->ampdu_density = sta->ht_cap.ampdu_density; + desc_info->ampdu_num = ampdu_num; +} + +static void +rtw89_core_tx_update_sec_key (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct ieee80211_vif *vif = tx_req->vif; +struct ieee80211_tx_info *info; +struct ieee80211_key_conf *key; +struct rtw89_vif *rtwvif; +struct rtw89_addr_cam_entry *addr_cam; +struct rtw89_sec_cam_entry *sec_cam; +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +u8 sec_type =RTW89_SEC_KEY_TYPE_NONE ; + +if (!vif) { +rtw89_warn (rtwdev,"cannot set sec key without vif\n" ); +return ; + } + + rtwvif = (struct rtw89_vif *)vif->drv_priv; + addr_cam = &rtwvif->addr_cam; + + info =IEEE80211_SKB_CB (skb); + key = info->control.hw_key; + sec_cam = addr_cam->sec_entries[key->hw_key_idx]; +if (!sec_cam) { +rtw89_warn (rtwdev,"sec cam entry is empty\n" ); +return ; + } + +switch (key->cipher) { +case WLAN_CIPHER_SUITE_WEP40 : + sec_type =RTW89_SEC_KEY_TYPE_WEP40 ; +break ; +case WLAN_CIPHER_SUITE_WEP104 : + sec_type =RTW89_SEC_KEY_TYPE_WEP104 ; +break ; +case WLAN_CIPHER_SUITE_TKIP : + sec_type =RTW89_SEC_KEY_TYPE_TKIP ; +break ; +case WLAN_CIPHER_SUITE_CCMP : + sec_type =RTW89_SEC_KEY_TYPE_CCMP128 ; +break ; +case WLAN_CIPHER_SUITE_CCMP_256 : + sec_type =RTW89_SEC_KEY_TYPE_CCMP256 ; +break ; +case WLAN_CIPHER_SUITE_GCMP : + sec_type =RTW89_SEC_KEY_TYPE_GCMP128 ; +break ; +case WLAN_CIPHER_SUITE_GCMP_256 : + sec_type =RTW89_SEC_KEY_TYPE_GCMP256 ; +break ; +default : +rtw89_warn (rtwdev,"key cipher not supported %d\n" , key->cipher); +return ; + } + + desc_info->sec_en = true; + desc_info->sec_type = sec_type; + desc_info->sec_cam_idx = sec_cam->sec_cam_idx; +} + +static void +rtw89_core_tx_update_mgmt_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +u8 qsel, ch_dma; + + qsel =RTW89_TX_QSEL_B0_MGMT ; + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + + desc_info->qsel =RTW89_TX_QSEL_B0_MGMT ; + desc_info->ch_dma = ch_dma; + +/* fixed data rate for mgmt frames */ + desc_info->en_wd_info = true; + desc_info->use_rate = true; + desc_info->dis_data_fb = true; + desc_info->data_rate =0x00 ; +} + +static void +rtw89_core_tx_update_h2c_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; + + desc_info->is_bmc = false; + desc_info->wd_page = false; + desc_info->ch_dma =RTW89_DMA_H2C ; +} + +static bool +__rtw89_core_tx_check_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req, +enum btc_pkt_type pkt_type) +{ +struct ieee80211_sta *sta = tx_req->sta; +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; + +/* AP IOT issue with EAPoL, ARP and DHCP */ +if (pkt_type <PACKET_MAX ) +return false; + +if (!sta || !sta->he_cap.has_he) +return false; + +if (!ieee80211_is_data_qos (fc)) +return false; + +if (skb_headroom (skb) <IEEE80211_HT_CTL_LEN ) +return false; + +return true; +} + +static void +__rtw89_core_tx_adjust_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; +void *data; +__le32 *htc; +u8 *qc; +int hdr_len; + + hdr_len =ieee80211_has_a4 (fc) ?32 :26 ; + data =skb_push (skb,IEEE80211_HT_CTL_LEN ); +memmove (data, data +IEEE80211_HT_CTL_LEN , hdr_len); + + hdr = data; + htc = data + hdr_len; + hdr->frame_control |=cpu_to_le16 (IEEE80211_FCTL_ORDER ); +memset (htc,0 ,sizeof (*htc)); + *htc =le32_encode_bits (RTW89_HTC_VARIANT_HE ,RTW89_HTC_MASK_VARIANT ) | +le32_encode_bits (RTW89_HTC_VARIANT_HE_CID_CAS ,RTW89_HTC_MASK_CTL_ID ); + + qc = data + hdr_len -IEEE80211_QOS_CTL_LEN ; + qc[0 ] |=IEEE80211_QOS_CTL_EOSP ; +} + +static void +rtw89_core_tx_update_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req, +enum btc_pkt_type pkt_type) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct ieee80211_vif *vif = tx_req->vif; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +if (!__rtw89_core_tx_check_he_qos_htc (rtwdev, tx_req, pkt_type)) + goto desc_bk; + +__rtw89_core_tx_adjust_he_qos_htc (rtwdev, tx_req); + + desc_info->pkt_size +=IEEE80211_HT_CTL_LEN ; + desc_info->a_ctrl_bsr = true; + +desc_bk: +if (!rtwvif || rtwvif->last_a_ctrl == desc_info->a_ctrl_bsr) +return ; + + rtwvif->last_a_ctrl = desc_info->a_ctrl_bsr; + desc_info->bk = true; +} + +static void +rtw89_core_tx_update_data_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +u8 tid, tid_indicate; +u8 qsel, ch_dma; + + tid = skb->priority &IEEE80211_QOS_CTL_TAG1D_MASK ; + tid_indicate =rtw89_core_get_tid_indicate (rtwdev, tid); + qsel =rtw89_core_get_qsel (rtwdev, tid); + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + + desc_info->ch_dma = ch_dma; + desc_info->tid_indicate = tid_indicate; + desc_info->qsel = qsel; + +/* enable wd_info for AMPDU */ + desc_info->en_wd_info = true; + +if (IEEE80211_SKB_CB (skb)->flags &IEEE80211_TX_CTL_AMPDU ) +rtw89_core_tx_update_ampdu_info (rtwdev, tx_req, tid); +if (IEEE80211_SKB_CB (skb)->control.hw_key) +rtw89_core_tx_update_sec_key (rtwdev, tx_req); +} + +static enum btc_pkt_type +rtw89_core_tx_btc_spec_pkt_notify (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct sk_buff *skb = tx_req->skb; +struct udphdr *udphdr; + +if (IEEE80211_SKB_CB (skb)->control.flags &IEEE80211_TX_CTRL_PORT_CTRL_PROTO ) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.eapol_notify_work); +return PACKET_EAPOL ; + } + +if (skb->protocol ==htons (ETH_P_ARP )) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.arp_notify_work); +return PACKET_ARP ; + } + +if (skb->protocol ==htons (ETH_P_IP ) && +ip_hdr (skb)->protocol ==IPPROTO_UDP ) { + udphdr =udp_hdr (skb); +if (((udphdr->source ==htons (67 ) && udphdr->dest ==htons (68 )) || + (udphdr->source ==htons (68 ) && udphdr->dest ==htons (67 ))) && + skb->len >282 ) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.dhcp_notify_work); +return PACKET_DHCP ; + } + } + +return PACKET_MAX ; +} + +static void +rtw89_core_tx_update_desc_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +enum rtw89_core_tx_type tx_type; +enum btc_pkt_type pkt_type; +bool is_bmc; +u16 seq; + + seq = (le16_to_cpu (hdr->seq_ctrl) &IEEE80211_SCTL_SEQ ) >>4 ; +if (tx_req->tx_type !=RTW89_CORE_TX_TYPE_FWCMD ) { + tx_type =rtw89_core_get_tx_type (rtwdev, skb); + tx_req->tx_type = tx_type; + } + is_bmc = (is_broadcast_ether_addr (hdr->addr1) || +is_multicast_ether_addr (hdr->addr1)); + + desc_info->seq = seq; + desc_info->pkt_size = skb->len; + desc_info->is_bmc = is_bmc; + desc_info->wd_page = true; + +switch (tx_req->tx_type) { +case RTW89_CORE_TX_TYPE_MGMT : +rtw89_core_tx_update_mgmt_info (rtwdev, tx_req); +break ; +case RTW89_CORE_TX_TYPE_DATA : +rtw89_core_tx_update_data_info (rtwdev, tx_req); + pkt_type =rtw89_core_tx_btc_spec_pkt_notify (rtwdev, tx_req); +rtw89_core_tx_update_he_qos_htc (rtwdev, tx_req, pkt_type); +break ; +case RTW89_CORE_TX_TYPE_FWCMD : +rtw89_core_tx_update_h2c_info (rtwdev, tx_req); +break ; + } +} + +void rtw89_core_tx_kick_off (struct rtw89_dev *rtwdev,u8 qsel) +{ +u8 ch_dma; + + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + +rtw89_hci_tx_kick_off (rtwdev, ch_dma); +} + +int rtw89_h2c_tx (struct rtw89_dev *rtwdev, +struct sk_buff *skb,bool fwdl) +{ +struct rtw89_core_tx_request tx_req = {0 }; +int ret; + + tx_req.skb = skb; + tx_req.tx_type =RTW89_CORE_TX_TYPE_FWCMD ; +if (fwdl) + tx_req.desc_info.fw_dl = true; + +rtw89_core_tx_update_desc_info (rtwdev, &tx_req); + +if (!fwdl) +rtw89_hex_dump (rtwdev,RTW89_DBG_FW ,"H2C: " , skb->data, skb->len); + + ret =rtw89_hci_tx_write (rtwdev, &tx_req); +if (ret) { +rtw89_err (rtwdev,"failed to transmit skb to HCI\n" ); +return ret; + } +rtw89_hci_tx_kick_off (rtwdev,RTW89_TXCH_CH12 ); + +return 0 ; +} + +int rtw89_core_tx_write (struct rtw89_dev *rtwdev,struct ieee80211_vif *vif, +struct ieee80211_sta *sta,struct sk_buff *skb,int *qsel) +{ +struct rtw89_core_tx_request tx_req = {0 }; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +int ret; + + tx_req.skb = skb; + tx_req.sta = sta; + tx_req.vif = vif; + +rtw89_traffic_stats_accu (rtwdev, &rtwdev->stats, skb, true); +rtw89_traffic_stats_accu (rtwdev, &rtwvif->stats, skb, true); +rtw89_core_tx_update_desc_info (rtwdev, &tx_req); + ret =rtw89_hci_tx_write (rtwdev, &tx_req); +if (ret) { +rtw89_err (rtwdev,"failed to transmit skb to HCI\n" ); +return ret; + } + +if (qsel) + *qsel = tx_req.desc_info.qsel; + +return 0 ; +} + +void rtw89_core_fill_txdesc (struct rtw89_dev *rtwdev, +struct rtw89_tx_desc_info *desc_info, +void *txdesc) +{ +RTW89_SET_TXWD_BODY_WP_OFFSET (txdesc, desc_info->wp_offset); +RTW89_SET_TXWD_BODY_WD_INFO_EN (txdesc, desc_info->en_wd_info); +RTW89_SET_TXWD_BODY_CHANNEL_DMA (txdesc, desc_info->ch_dma); +RTW89_SET_TXWD_BODY_HDR_LLC_LEN (txdesc, desc_info->hdr_llc_len); +RTW89_SET_TXWD_BODY_WD_PAGE (txdesc, desc_info->wd_page); +RTW89_SET_TXWD_BODY_FW_DL (txdesc, desc_info->fw_dl); +RTW89_SET_TXWD_BODY_SW_SEQ (txdesc, desc_info->seq); + +RTW89_SET_TXWD_BODY_TID_INDICATE (txdesc, desc_info->tid_indicate); +RTW89_SET_TXWD_BODY_QSEL (txdesc, desc_info->qsel); +RTW89_SET_TXWD_BODY_TXPKT_SIZE (txdesc, desc_info->pkt_size); +RTW89_SET_TXWD_BODY_AGG_EN (txdesc, desc_info->agg_en); +RTW89_SET_TXWD_BODY_BK (txdesc, desc_info->bk); + +if (!desc_info->en_wd_info) +return ; + +RTW89_SET_TXWD_INFO_USE_RATE (txdesc, desc_info->use_rate); +RTW89_SET_TXWD_INFO_DATA_RATE (txdesc, desc_info->data_rate); +RTW89_SET_TXWD_INFO_DISDATAFB (txdesc, desc_info->dis_data_fb); +RTW89_SET_TXWD_INFO_MAX_AGGNUM (txdesc, desc_info->ampdu_num); +RTW89_SET_TXWD_INFO_AMPDU_DENSITY (txdesc, desc_info->ampdu_density); +RTW89_SET_TXWD_INFO_SEC_TYPE (txdesc, desc_info->sec_type); +RTW89_SET_TXWD_INFO_SEC_HW_ENC (txdesc, desc_info->sec_en); +RTW89_SET_TXWD_INFO_SEC_CAM_IDX (txdesc, desc_info->sec_cam_idx); +RTW89_SET_TXWD_INFO_RTS_EN (txdesc,1 ); +RTW89_SET_TXWD_INFO_HW_RTS_EN (txdesc,1 ); +RTW89_SET_TXWD_INFO_A_CTRL_BSR (txdesc, desc_info->a_ctrl_bsr); +} +EXPORT_SYMBOL (rtw89_core_fill_txdesc); + +static int rtw89_core_rx_process_mac_ppdu (struct rtw89_dev *rtwdev, +struct sk_buff *skb, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +bool rx_cnt_valid = false; +u8 plcp_size =0 ; +u8 usr_num =0 ; +u8 *phy_sts; + + rx_cnt_valid =RTW89_GET_RXINFO_RX_CNT_VLD (skb->data); + plcp_size =RTW89_GET_RXINFO_PLCP_LEN (skb->data) <<3 ; + usr_num =RTW89_GET_RXINFO_USR_NUM (skb->data); +if (usr_num >RTW89_PPDU_MAX_USR ) { +rtw89_warn (rtwdev,"Invalid user number in mac info\n" ); +return -EINVAL ; + } + + phy_sts = skb->data +RTW89_PPDU_MAC_INFO_SIZE ; + phy_sts += usr_num *RTW89_PPDU_MAC_INFO_USR_SIZE ; +/* 8-byte alignment */ +if (usr_num &BIT (0 )) + phy_sts +=RTW89_PPDU_MAC_INFO_USR_SIZE ; +if (rx_cnt_valid) + phy_sts +=RTW89_PPDU_MAC_RX_CNT_SIZE ; + phy_sts += plcp_size; + + phy_ppdu->buf = phy_sts; + phy_ppdu->len = skb->data + skb->len - phy_sts; + +return 0 ; +} + +static void rtw89_core_rx_process_phy_ppdu_iter (void *data, +struct ieee80211_sta *sta) +{ +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rtw89_rx_phy_ppdu *phy_ppdu = (struct rtw89_rx_phy_ppdu *)data; + +if (rtwsta->mac_id == phy_ppdu->mac_id && phy_ppdu->to_self) +ewma_rssi_add (&rtwsta->avg_rssi, phy_ppdu->rssi_avg); +} + +#define VAR_LEN 0xff +#define VAR_LEN_UNIT 8 +static u16 rtw89_core_get_phy_status_ie_len (struct rtw89_dev *rtwdev,u8 *addr) +{ +static const u8 physts_ie_len_tab[32 ] = { +16 ,32 ,24 ,24 ,8 ,8 ,8 ,8 ,VAR_LEN ,8 ,VAR_LEN ,176 ,VAR_LEN , +VAR_LEN ,VAR_LEN ,VAR_LEN ,VAR_LEN ,VAR_LEN ,16 ,24 ,VAR_LEN , +VAR_LEN ,VAR_LEN ,0 ,24 ,24 ,24 ,24 ,32 ,32 ,32 ,32 + }; +u16 ie_len; +u8 ie; + + ie =RTW89_GET_PHY_STS_IE_TYPE (addr); +if (physts_ie_len_tab[ie] !=VAR_LEN ) + ie_len = physts_ie_len_tab[ie]; +else + ie_len =RTW89_GET_PHY_STS_IE_LEN (addr) *VAR_LEN_UNIT ; + +return ie_len; +} + +static void rtw89_core_parse_phy_status_ie01 (struct rtw89_dev *rtwdev,u8 *addr, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +s16 cfo; + +/* sign conversion for S(12,2) */ + cfo =sign_extend32 (RTW89_GET_PHY_STS_IE0_CFO (addr),11 ); +rtw89_phy_cfo_parse (rtwdev, cfo, phy_ppdu); +} + +static int rtw89_core_process_phy_status_ie (struct rtw89_dev *rtwdev,u8 *addr, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +u8 ie; + + ie =RTW89_GET_PHY_STS_IE_TYPE (addr); +switch (ie) { +case RTW89_PHYSTS_IE01_CMN_OFDM : +rtw89_core_parse_phy_status_ie01 (rtwdev, addr, phy_ppdu); +break ; +default : +break ; + } + +return 0 ; +} + +static void rtw89_core_update_phy_ppdu (struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +s8 *rssi = phy_ppdu->rssi; +u8 *buf = phy_ppdu->buf; + + phy_ppdu->rssi_avg =RTW89_GET_PHY_STS_RSSI_AVG (buf); + rssi[RF_PATH_A ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_A (buf)); + rssi[RF_PATH_B ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_B (buf)); + rssi[RF_PATH_C ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_C (buf)); + rssi[RF_PATH_D ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_D (buf)); +} + +static int rtw89_core_rx_process_phy_ppdu (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +if (RTW89_GET_PHY_STS_LEN (phy_ppdu->buf) <<3 != phy_ppdu->len) { +rtw89_warn (rtwdev,"phy ppdu len mismatch\n" ); +return -EINVAL ; + } +rtw89_core_update_phy_ppdu (phy_ppdu); +ieee80211_iterate_stations_atomic (rtwdev->hw, + rtw89_core_rx_process_phy_ppdu_iter, + phy_ppdu); + +return 0 ; +} + +static int rtw89_core_rx_parse_phy_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +u16 ie_len; +u8 *pos, *end; + +if (!phy_ppdu->to_self) +return 0 ; + + pos = (u8 *)phy_ppdu->buf +PHY_STS_HDR_LEN ; + end = (u8 *)phy_ppdu->buf + phy_ppdu->len; +while (pos < end) { + ie_len =rtw89_core_get_phy_status_ie_len (rtwdev, pos); +rtw89_core_process_phy_status_ie (rtwdev, pos, phy_ppdu); + pos += ie_len; +if (pos > end || ie_len ==0 ) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"phy status parse failed\n" ); +return -EINVAL ; + } + } + +return 0 ; +} + +static void rtw89_core_rx_process_phy_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +int ret; + + ret =rtw89_core_rx_parse_phy_sts (rtwdev, phy_ppdu); +if (ret) +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"parse phy sts failed\n" ); +else + phy_ppdu->valid = true; +} + +static u8 rtw89_rxdesc_to_nl_he_gi (struct rtw89_dev *rtwdev, +const struct rtw89_rx_desc_info *desc_info, +bool rx_status) +{ +switch (desc_info->gi_ltf) { +case RTW89_GILTF_SGI_4XHE08 : +case RTW89_GILTF_2XHE08 : +case RTW89_GILTF_1XHE08 : +return NL80211_RATE_INFO_HE_GI_0_8 ; +case RTW89_GILTF_2XHE16 : +case RTW89_GILTF_1XHE16 : +return NL80211_RATE_INFO_HE_GI_1_6 ; +case RTW89_GILTF_LGI_4XHE32 : +return NL80211_RATE_INFO_HE_GI_3_2 ; +default : +rtw89_warn (rtwdev,"invalid gi_ltf=%d" , desc_info->gi_ltf); +return rx_status ?NL80211_RATE_INFO_HE_GI_3_2 :U8_MAX ; + } +} + +static bool rtw89_core_rx_ppdu_match (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *status) +{ +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +u8 data_rate_mode, bw, rate_idx =MASKBYTE0 , gi_ltf; +u16 data_rate; +bool ret; + + data_rate = desc_info->data_rate; + data_rate_mode =GET_DATA_RATE_MODE (data_rate); +if (data_rate_mode ==DATA_RATE_MODE_NON_HT ) { + rate_idx =GET_DATA_RATE_NOT_HT_IDX (data_rate); +/* No 4 CCK rates for 5G */ +if (status->band ==NL80211_BAND_5GHZ ) + rate_idx -=4 ; + }else if (data_rate_mode ==DATA_RATE_MODE_HT ) { + rate_idx =GET_DATA_RATE_HT_IDX (data_rate); + }else if (data_rate_mode ==DATA_RATE_MODE_VHT ) { + rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + }else if (data_rate_mode ==DATA_RATE_MODE_HE ) { + rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + }else { +rtw89_warn (rtwdev,"invalid RX rate mode %d\n" , data_rate_mode); + } + +if (desc_info->bw ==RTW89_CHANNEL_WIDTH_80 ) + bw =RATE_INFO_BW_80 ; +else if (desc_info->bw ==RTW89_CHANNEL_WIDTH_40 ) + bw =RATE_INFO_BW_40 ; +else + bw =RATE_INFO_BW_20 ; + + gi_ltf =rtw89_rxdesc_to_nl_he_gi (rtwdev, desc_info, false); + ret = rtwdev->ppdu_sts.curr_rx_ppdu_cnt[band] == desc_info->ppdu_cnt && + status->rate_idx == rate_idx && + status->he_gi == gi_ltf && + status->bw == bw; + +return ret; +} + +struct rtw89_vif_rx_stats_iter_data { +struct rtw89_dev *rtwdev; +struct rtw89_rx_phy_ppdu *phy_ppdu; +struct rtw89_rx_desc_info *desc_info; +struct sk_buff *skb; +const u8 *bssid; +}; + +static void rtw89_vif_rx_stats_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_vif_rx_stats_iter_data *iter_data = data; +struct rtw89_dev *rtwdev = iter_data->rtwdev; +struct rtw89_pkt_stat *pkt_stat = &rtwdev->phystat.cur_pkt_stat; +struct rtw89_rx_desc_info *desc_info = iter_data->desc_info; +struct sk_buff *skb = iter_data->skb; +struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; +const u8 *bssid = iter_data->bssid; + +if (!ether_addr_equal (vif->bss_conf.bssid, bssid)) +return ; + +if (ieee80211_is_beacon (hdr->frame_control)) + pkt_stat->beacon_nr++; + +if (!ether_addr_equal (vif->addr, hdr->addr1)) +return ; + +if (desc_info->data_rate <RTW89_HW_RATE_NR ) + pkt_stat->rx_rate_cnt[desc_info->data_rate]++; + +rtw89_traffic_stats_accu (rtwdev, &rtwvif->stats, skb, false); +} + +static void rtw89_core_rx_stats (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct rtw89_vif_rx_stats_iter_data iter_data; + +rtw89_traffic_stats_accu (rtwdev, &rtwdev->stats, skb, false); + + iter_data.rtwdev = rtwdev; + iter_data.phy_ppdu = phy_ppdu; + iter_data.desc_info = desc_info; + iter_data.skb = skb; + iter_data.bssid =get_hdr_bssid ((struct ieee80211_hdr *)skb->data); +rtw89_iterate_vifs_bh (rtwdev, rtw89_vif_rx_stats_iter, &iter_data); +} + +static void rtw89_core_rx_pending_skb (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +int curr = rtwdev->ppdu_sts.curr_rx_ppdu_cnt[band]; +struct sk_buff *skb_ppdu =NULL , *tmp; +struct ieee80211_rx_status *rx_status; + +if (curr >RTW89_MAX_PPDU_CNT ) +return ; + + skb_queue_walk_safe(&rtwdev->ppdu_sts.rx_queue[band], skb_ppdu, tmp) { +skb_unlink (skb_ppdu, &rtwdev->ppdu_sts.rx_queue[band]); + rx_status =IEEE80211_SKB_RXCB (skb_ppdu); +if (rtw89_core_rx_ppdu_match (rtwdev, desc_info, rx_status)) +rtw89_chip_query_ppdu (rtwdev, phy_ppdu, rx_status); +rtw89_core_rx_stats (rtwdev, phy_ppdu, desc_info, skb_ppdu); +ieee80211_rx_napi (rtwdev->hw,NULL , skb_ppdu, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} + +static void rtw89_core_rx_process_ppdu_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct rtw89_rx_phy_ppdu phy_ppdu = {.buf = skb->data, .valid = false, + .len = skb->len, + .to_self = desc_info->addr1_match, + .mac_id = desc_info->mac_id}; +int ret; + +if (desc_info->mac_info_valid) +rtw89_core_rx_process_mac_ppdu (rtwdev, skb, &phy_ppdu); + ret =rtw89_core_rx_process_phy_ppdu (rtwdev, &phy_ppdu); +if (ret) +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"process ppdu failed\n" ); + +rtw89_core_rx_process_phy_sts (rtwdev, &phy_ppdu); +rtw89_core_rx_pending_skb (rtwdev, &phy_ppdu, desc_info, skb); +dev_kfree_skb_any (skb); +} + +static void rtw89_core_rx_process_report (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +switch (desc_info->pkt_type) { +case RTW89_CORE_RX_TYPE_C2H : +rtw89_fw_c2h_irqsafe (rtwdev, skb); +break ; +case RTW89_CORE_RX_TYPE_PPDU_STAT : +rtw89_core_rx_process_ppdu_sts (rtwdev, desc_info, skb); +break ; +default : +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"unhandled pkt_type=%d\n" , + desc_info->pkt_type); +dev_kfree_skb_any (skb); +break ; + } +} + +void rtw89_core_query_rxdesc (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +u8 *data,u32 data_offset) +{ +struct rtw89_rxdesc_short *rxd_s; +struct rtw89_rxdesc_long *rxd_l; +u8 shift_len, drv_info_len; + + rxd_s = (struct rtw89_rxdesc_short *)(data + data_offset); + desc_info->pkt_size =RTW89_GET_RXWD_PKT_SIZE (rxd_s); + desc_info->drv_info_size =RTW89_GET_RXWD_DRV_INFO_SIZE (rxd_s); + desc_info->long_rxdesc =RTW89_GET_RXWD_LONG_RXD (rxd_s); + desc_info->pkt_type =RTW89_GET_RXWD_RPKT_TYPE (rxd_s); + desc_info->mac_info_valid =RTW89_GET_RXWD_MAC_INFO_VALID (rxd_s); + desc_info->bw =RTW89_GET_RXWD_BW (rxd_s); + desc_info->data_rate =RTW89_GET_RXWD_DATA_RATE (rxd_s); + desc_info->gi_ltf =RTW89_GET_RXWD_GI_LTF (rxd_s); + desc_info->user_id =RTW89_GET_RXWD_USER_ID (rxd_s); + desc_info->sr_en =RTW89_GET_RXWD_SR_EN (rxd_s); + desc_info->ppdu_cnt =RTW89_GET_RXWD_PPDU_CNT (rxd_s); + desc_info->ppdu_type =RTW89_GET_RXWD_PPDU_TYPE (rxd_s); + desc_info->free_run_cnt =RTW89_GET_RXWD_FREE_RUN_CNT (rxd_s); + desc_info->icv_err =RTW89_GET_RXWD_ICV_ERR (rxd_s); + desc_info->crc32_err =RTW89_GET_RXWD_CRC32_ERR (rxd_s); + desc_info->hw_dec =RTW89_GET_RXWD_HW_DEC (rxd_s); + desc_info->sw_dec =RTW89_GET_RXWD_SW_DEC (rxd_s); + desc_info->addr1_match =RTW89_GET_RXWD_A1_MATCH (rxd_s); + + shift_len = desc_info->shift <<1 ;/* 2-byte unit */ + drv_info_len = desc_info->drv_info_size <<3 ;/* 8-byte unit */ + desc_info->offset = data_offset + shift_len + drv_info_len; + desc_info->ready = true; + +if (!desc_info->long_rxdesc) +return ; + + rxd_l = (struct rtw89_rxdesc_long *)(data + data_offset); + desc_info->frame_type =RTW89_GET_RXWD_TYPE (rxd_l); + desc_info->addr_cam_valid =RTW89_GET_RXWD_ADDR_CAM_VLD (rxd_l); + desc_info->addr_cam_id =RTW89_GET_RXWD_ADDR_CAM_ID (rxd_l); + desc_info->sec_cam_id =RTW89_GET_RXWD_SEC_CAM_ID (rxd_l); + desc_info->mac_id =RTW89_GET_RXWD_MAC_ID (rxd_l); + desc_info->rx_pl_id =RTW89_GET_RXWD_RX_PL_ID (rxd_l); +} +EXPORT_SYMBOL (rtw89_core_query_rxdesc); + +struct rtw89_core_iter_rx_status { +struct rtw89_dev *rtwdev; +struct ieee80211_rx_status *rx_status; +struct rtw89_rx_desc_info *desc_info; +u8 mac_id; +}; + +static +void rtw89_core_stats_sta_rx_status_iter (void *data,struct ieee80211_sta *sta) +{ +struct rtw89_core_iter_rx_status *iter_data = + (struct rtw89_core_iter_rx_status *)data; +struct ieee80211_rx_status *rx_status = iter_data->rx_status; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rtw89_rx_desc_info *desc_info = iter_data->desc_info; +u8 mac_id = iter_data->mac_id; + +if (mac_id != rtwsta->mac_id) +return ; + + rtwsta->rx_status = *rx_status; + rtwsta->rx_hw_rate = desc_info->data_rate; +} + +static void rtw89_core_stats_sta_rx_status (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *rx_status) +{ +struct rtw89_core_iter_rx_status iter_data; + +if (!desc_info->addr1_match || !desc_info->long_rxdesc) +return ; + +if (desc_info->frame_type !=RTW89_RX_TYPE_DATA ) +return ; + + iter_data.rtwdev = rtwdev; + iter_data.rx_status = rx_status; + iter_data.desc_info = desc_info; + iter_data.mac_id = desc_info->mac_id; +ieee80211_iterate_stations_atomic (rtwdev->hw, + rtw89_core_stats_sta_rx_status_iter, + &iter_data); +} + +static void rtw89_core_update_rx_status (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *rx_status) +{ +struct ieee80211_hw *hw = rtwdev->hw; +u16 data_rate; +u8 data_rate_mode; + +/* currently using single PHY */ + rx_status->freq = hw->conf.chandef.chan->center_freq; + rx_status->band = hw->conf.chandef.chan->band; + +if (desc_info->icv_err || desc_info->crc32_err) + rx_status->flag |=RX_FLAG_FAILED_FCS_CRC ; + +if (desc_info->hw_dec && + !(desc_info->sw_dec || desc_info->icv_err)) + rx_status->flag |=RX_FLAG_DECRYPTED ; + +if (desc_info->bw ==RTW89_CHANNEL_WIDTH_80 ) + rx_status->bw =RATE_INFO_BW_80 ; +else if (desc_info->bw ==RTW89_CHANNEL_WIDTH_40 ) + rx_status->bw =RATE_INFO_BW_40 ; +else + rx_status->bw =RATE_INFO_BW_20 ; + + data_rate = desc_info->data_rate; + data_rate_mode =GET_DATA_RATE_MODE (data_rate); +if (data_rate_mode ==DATA_RATE_MODE_NON_HT ) { + rx_status->encoding =RX_ENC_LEGACY ; + rx_status->rate_idx =GET_DATA_RATE_NOT_HT_IDX (data_rate); +/* No 4 CCK rates for 5G */ +if (rx_status->band ==NL80211_BAND_5GHZ ) + rx_status->rate_idx -=4 ; +if (rtwdev->scanning) + rx_status->rate_idx =min_t (u8, rx_status->rate_idx, +ARRAY_SIZE (rtw89_bitrates) -5 ); + }else if (data_rate_mode ==DATA_RATE_MODE_HT ) { + rx_status->encoding =RX_ENC_HT ; + rx_status->rate_idx =GET_DATA_RATE_HT_IDX (data_rate); +if (desc_info->gi_ltf) + rx_status->enc_flags |=RX_ENC_FLAG_SHORT_GI ; + }else if (data_rate_mode ==DATA_RATE_MODE_VHT ) { + rx_status->encoding =RX_ENC_VHT ; + rx_status->rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + rx_status->nss =GET_DATA_RATE_NSS (data_rate) +1 ; +if (desc_info->gi_ltf) + rx_status->enc_flags |=RX_ENC_FLAG_SHORT_GI ; + }else if (data_rate_mode ==DATA_RATE_MODE_HE ) { + rx_status->encoding =RX_ENC_HE ; + rx_status->rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + rx_status->nss =GET_DATA_RATE_NSS (data_rate) +1 ; + }else { +rtw89_warn (rtwdev,"invalid RX rate mode %d\n" , data_rate_mode); + } + +/* he_gi is used to match ppdu, so we always fill it. */ + rx_status->he_gi =rtw89_rxdesc_to_nl_he_gi (rtwdev, desc_info, true); + rx_status->flag |=RX_FLAG_MACTIME_START ; + rx_status->mactime = desc_info->free_run_cnt; + +rtw89_core_stats_sta_rx_status (rtwdev, desc_info, rx_status); +} + +static enum rtw89_ps_mode rtw89_update_ps_mode (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; + +if (rtw89_disable_ps_mode || !chip->ps_mode_supported) +return RTW89_PS_MODE_NONE ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_PWR_GATED )) +return RTW89_PS_MODE_PWR_GATED ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_CLK_GATED )) +return RTW89_PS_MODE_CLK_GATED ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_RFOFF )) +return RTW89_PS_MODE_RFOFF ; + +return RTW89_PS_MODE_NONE ; +} + +static void rtw89_core_flush_ppdu_rx_queue (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info) +{ +struct rtw89_ppdu_sts_info *ppdu_sts = &rtwdev->ppdu_sts; +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +struct sk_buff *skb_ppdu, *tmp; + + skb_queue_walk_safe(&ppdu_sts->rx_queue[band], skb_ppdu, tmp) { +skb_unlink (skb_ppdu, &ppdu_sts->rx_queue[band]); +rtw89_core_rx_stats (rtwdev,NULL , desc_info, skb_ppdu); +ieee80211_rx_napi (rtwdev->hw,NULL , skb_ppdu, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} + +void rtw89_core_rx (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct ieee80211_rx_status *rx_status; +struct rtw89_ppdu_sts_info *ppdu_sts = &rtwdev->ppdu_sts; +u8 ppdu_cnt = desc_info->ppdu_cnt; +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; + +if (desc_info->pkt_type !=RTW89_CORE_RX_TYPE_WIFI ) { +rtw89_core_rx_process_report (rtwdev, desc_info, skb); +return ; + } + +if (ppdu_sts->curr_rx_ppdu_cnt[band] != ppdu_cnt) { +rtw89_core_flush_ppdu_rx_queue (rtwdev, desc_info); + ppdu_sts->curr_rx_ppdu_cnt[band] = ppdu_cnt; + } + + rx_status =IEEE80211_SKB_RXCB (skb); +memset (rx_status,0 ,sizeof (*rx_status)); +rtw89_core_update_rx_status (rtwdev, desc_info, rx_status); +if (desc_info->long_rxdesc && +BIT (desc_info->frame_type) &PPDU_FILTER_BITMAP ) { +skb_queue_tail (&ppdu_sts->rx_queue[band], skb); + }else { +rtw89_core_rx_stats (rtwdev,NULL , desc_info, skb); +ieee80211_rx_napi (rtwdev->hw,NULL , skb, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} +EXPORT_SYMBOL (rtw89_core_rx); + +void rtw89_core_napi_start (struct rtw89_dev *rtwdev) +{ +if (test_and_set_bit (RTW89_FLAG_NAPI_RUNNING , rtwdev->flags)) +return ; + +napi_enable (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_start); + +void rtw89_core_napi_stop (struct rtw89_dev *rtwdev) +{ +if (!test_and_clear_bit (RTW89_FLAG_NAPI_RUNNING , rtwdev->flags)) +return ; + +napi_synchronize (&rtwdev->napi); +napi_disable (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_stop); + +void rtw89_core_napi_init (struct rtw89_dev *rtwdev) +{ +init_dummy_netdev (&rtwdev->netdev); +netif_napi_add (&rtwdev->netdev, &rtwdev->napi, + rtwdev->hci.ops->napi_poll,NAPI_POLL_WEIGHT ); +} +EXPORT_SYMBOL (rtw89_core_napi_init); + +void rtw89_core_napi_deinit (struct rtw89_dev *rtwdev) +{ +rtw89_core_napi_stop (rtwdev); +netif_napi_del (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_deinit); + +static void rtw89_core_ba_work (struct work_struct *work) +{ +struct rtw89_dev *rtwdev = + container_of(work, struct rtw89_dev, ba_work); +struct rtw89_txq *rtwtxq, *tmp; +int ret; + +spin_lock_bh (&rtwdev->ba_lock); +list_for_each_entry_safe (rtwtxq, tmp, &rtwdev->ba_list, list) { +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +u8 tid = txq->tid; + +if (!sta) { +rtw89_warn (rtwdev,"cannot start BA without sta\n" ); + goto skip_ba_work; + } + +if (rtwsta->disassoc) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"cannot start BA with disassoc sta\n" ); + goto skip_ba_work; + } + + ret =ieee80211_start_tx_ba_session (sta, tid,0 ); +if (ret) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"failed to setup BA session for %pM:%2d: %d\n" , + sta->addr, tid, ret); +if (ret == -EINVAL ) +set_bit (RTW89_TXQ_F_BLOCK_BA , &rtwtxq->flags); + } +skip_ba_work: +list_del_init (&rtwtxq->list); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_free_sta_pending_ba (struct rtw89_dev *rtwdev, +struct ieee80211_sta *sta) +{ +struct rtw89_txq *rtwtxq, *tmp; + +spin_lock_bh (&rtwdev->ba_lock); +list_for_each_entry_safe (rtwtxq, tmp, &rtwdev->ba_list, list) { +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); + +if (sta == txq->sta) +list_del_init (&rtwtxq->list); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_txq_check_agg (struct rtw89_dev *rtwdev, +struct rtw89_txq *rtwtxq, +struct sk_buff *skb) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (unlikely (skb_get_queue_mapping (skb) ==IEEE80211_AC_VO )) +return ; + +if (unlikely (skb->protocol ==cpu_to_be16 (ETH_P_PAE ))) +return ; + +if (unlikely (!sta)) +return ; + +if (unlikely (test_bit (RTW89_TXQ_F_BLOCK_BA , &rtwtxq->flags))) +return ; + +if (test_bit (RTW89_TXQ_F_AMPDU , &rtwtxq->flags)) { +IEEE80211_SKB_CB (skb)->flags |=IEEE80211_TX_CTL_AMPDU ; +return ; + } + +spin_lock_bh (&rtwdev->ba_lock); +if (!rtwsta->disassoc &&list_empty (&rtwtxq->list)) { +list_add_tail (&rtwtxq->list, &rtwdev->ba_list); +ieee80211_queue_work (hw, &rtwdev->ba_work); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_txq_push (struct rtw89_dev *rtwdev, +struct rtw89_txq *rtwtxq, +unsigned long frame_cnt, +unsigned long byte_cnt) +{ +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_vif *vif = txq->vif; +struct ieee80211_sta *sta = txq->sta; +struct sk_buff *skb; +unsigned long i; +int ret; + +for (i =0 ; i < frame_cnt; i++) { + skb =ieee80211_tx_dequeue_ni (rtwdev->hw, txq); +if (!skb) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"dequeue a NULL skb\n" ); +return ; + } +rtw89_core_txq_check_agg (rtwdev, rtwtxq, skb); + ret =rtw89_core_tx_write (rtwdev, vif, sta, skb,NULL ); +if (ret) { +rtw89_err (rtwdev,"failed to push txq: %d\n" , ret); +ieee80211_free_txskb (rtwdev->hw, skb); +break ; + } + } +} + +static u32 rtw89_check_and_reclaim_tx_resource (struct rtw89_dev *rtwdev,u8 tid) +{ +u8 qsel, ch_dma; + + qsel =rtw89_core_get_qsel (rtwdev, tid); + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + +return rtw89_hci_check_and_reclaim_tx_resource (rtwdev, ch_dma); +} + +static bool rtw89_core_txq_agg_wait (struct rtw89_dev *rtwdev, +struct ieee80211_txq *txq, +unsigned long *frame_cnt, +bool *sched_txq,bool *reinvoke) +{ +struct rtw89_txq *rtwtxq = (struct rtw89_txq *)txq->drv_priv; +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (!sta || rtwsta->max_agg_wait <=0 ) +return false; + +if (rtwdev->stats.tx_tfc_lv <=RTW89_TFC_MID ) +return false; + +if (*frame_cnt >1 ) { + *frame_cnt -=1 ; + *sched_txq = true; + *reinvoke = true; + rtwtxq->wait_cnt =1 ; +return false; + } + +if (*frame_cnt ==1 && rtwtxq->wait_cnt < rtwsta->max_agg_wait) { + *reinvoke = true; + rtwtxq->wait_cnt++; +return true; + } + + rtwtxq->wait_cnt =0 ; +return false; +} + +static void rtw89_core_txq_schedule (struct rtw89_dev *rtwdev,u8 ac,bool *reinvoke) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_txq *txq; +struct rtw89_txq *rtwtxq; +unsigned long frame_cnt; +unsigned long byte_cnt; +u32 tx_resource; +bool sched_txq; + +ieee80211_txq_schedule_start (hw, ac); +while ((txq =ieee80211_next_txq (hw, ac))) { + rtwtxq = (struct rtw89_txq *)txq->drv_priv; + tx_resource =rtw89_check_and_reclaim_tx_resource (rtwdev, txq->tid); + sched_txq = false; + +ieee80211_txq_get_depth (txq, &frame_cnt, &byte_cnt); +if (rtw89_core_txq_agg_wait (rtwdev, txq, &frame_cnt, &sched_txq, reinvoke)) { +ieee80211_return_txq (hw, txq, true); +continue ; + } + frame_cnt = min_t(unsigned long, frame_cnt, tx_resource); +rtw89_core_txq_push (rtwdev, rtwtxq, frame_cnt, byte_cnt); +ieee80211_return_txq (hw, txq, sched_txq); +if (frame_cnt !=0 ) +rtw89_core_tx_kick_off (rtwdev,rtw89_core_get_qsel (rtwdev, txq->tid)); + } +ieee80211_txq_schedule_end (hw, ac); +} + +static void rtw89_core_txq_work (struct work_struct *w) +{ + struct rtw89_dev *rtwdev = container_of(w, struct rtw89_dev, txq_work); +bool reinvoke = false; +u8 ac; + +for (ac =0 ; ac <IEEE80211_NUM_ACS ; ac++) +rtw89_core_txq_schedule (rtwdev, ac, &reinvoke); + +if (reinvoke) { +/* reinvoke to process the last frame */ +mod_delayed_work (rtwdev->txq_wq, &rtwdev->txq_reinvoke_work,1 ); + } +} + +static void rtw89_core_txq_reinvoke_work (struct work_struct *w) +{ + struct rtw89_dev *rtwdev = container_of(w, struct rtw89_dev, + txq_reinvoke_work.work); + +queue_work (rtwdev->txq_wq, &rtwdev->txq_work); +} + +static enum rtw89_tfc_lv rtw89_get_traffic_level (struct rtw89_dev *rtwdev, +u32 throughput,u64 cnt) +{ +if (cnt <100 ) +return RTW89_TFC_IDLE ; +if (throughput >50 ) +return RTW89_TFC_HIGH ; +if (throughput >10 ) +return RTW89_TFC_MID ; +if (throughput >2 ) +return RTW89_TFC_LOW ; +return RTW89_TFC_ULTRA_LOW ; +} + +static void rtw89_traffic_stats_calc (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{ +enum rtw89_tfc_lv tx_tfc_lv = stats->tx_tfc_lv; +enum rtw89_tfc_lv rx_tfc_lv = stats->rx_tfc_lv; + + stats->tx_throughput_raw = (u32)(stats->tx_unicast >>RTW89_TP_SHIFT ); + stats->rx_throughput_raw = (u32)(stats->rx_unicast >>RTW89_TP_SHIFT ); + +ewma_tp_add (&stats->tx_ewma_tp, stats->tx_throughput_raw); +ewma_tp_add (&stats->rx_ewma_tp, stats->rx_throughput_raw); + + stats->tx_throughput =ewma_tp_read (&stats->tx_ewma_tp); + stats->rx_throughput =ewma_tp_read (&stats->rx_ewma_tp); + stats->tx_tfc_lv =rtw89_get_traffic_level (rtwdev, stats->tx_throughput, + stats->tx_cnt); + stats->rx_tfc_lv =rtw89_get_traffic_level (rtwdev, stats->rx_throughput, + stats->rx_cnt); + stats->tx_avg_len = (u32)(stats->tx_cnt ? stats->tx_unicast / stats->tx_cnt :0 ); + stats->rx_avg_len = (u32)(stats->rx_cnt ? stats->rx_unicast / stats->rx_cnt :0 ); + + stats->tx_unicast =0 ; + stats->rx_unicast =0 ; + stats->tx_cnt =0 ; + stats->rx_cnt =0 ; + +if (tx_tfc_lv != stats->tx_tfc_lv || rx_tfc_lv != stats->rx_tfc_lv) +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.wl_sta_notify_work); +} + +static void rtw89_vif_traffic_stats_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_dev *rtwdev = data; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +rtw89_traffic_stats_calc (rtwdev, &rtwvif->stats); +} + +static void rtw89_traffic_stats_track (struct rtw89_dev *rtwdev) +{ +rtw89_traffic_stats_calc (rtwdev, &rtwdev->stats); + +rtw89_iterate_vifs (rtwdev, rtw89_vif_traffic_stats_iter, rtwdev, false); +} + +static void rtw89_vif_enter_lps_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_dev *rtwdev = data; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +if (rtwvif->wifi_role !=RTW89_WIFI_ROLE_STATION ) +return ; + +if (rtwvif->stats.tx_tfc_lv ==RTW89_TFC_IDLE && + rtwvif->stats.rx_tfc_lv ==RTW89_TFC_IDLE ) +rtw89_enter_lps (rtwdev, rtwvif->mac_id); +} + +static void rtw89_enter_lps_track (struct rtw89_dev *rtwdev) +{ +rtw89_iterate_vifs (rtwdev, rtw89_vif_enter_lps_iter, rtwdev, false); +} + +void rtw89_traffic_stats_init (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{ + stats->tx_unicast =0 ; + stats->rx_unicast =0 ; + stats->tx_cnt =0 ; + stats->rx_cnt =0 ; +ewma_tp_init (&stats->tx_ewma_tp); +ewma_tp_init (&stats->rx_ewma_tp); +} + +static void rtw89_track_work (struct work_struct *work) +{ + struct rtw89_dev *rtwdev = container_of(work, struct rtw89_dev, + track_work.work); + +mutex_lock (&rtwdev->mutex); + +if (!test_bit (RTW89_FLAG_RUNNING , rtwdev->flags)) + goto out; + +ieee80211_queue_delayed_work (rtwdev->hw, &rtwdev->track_work, +RTW89_TRACK_WORK_PERIOD ); + +rtw89_leave_lps (rtwdev, false); + +rtw89_traffic_stats_track (rtwdev); +rtw89_mac_bf_monitor_track (rtwdev); +rtw89_phy_stat_track (rtwdev); +rtw89_phy_env_monitor_track (rtwdev); +rtw89_phy_dig (rtwdev); +rtw89_chip_rfk_track (rtwdev); +rtw89_phy_ra_update (rtwdev); +rtw89_phy_cfo_track (rtwdev); + +if (rtwdev->lps_enabled && !rtwdev->btc.lps && !rtwdev->scanning) +rtw89_enter_lps_track (rtwdev); + +out: +mutex_unlock (&rtwdev->mutex); +} + +int rtw89_core_power_on (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_mac_pwr_on (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to start power sequence\n" ); + goto err; + } + +return 0 ; + +err: +return ret; +} + +u8 rtw89_core_acquire_bit_map (unsigned long *addr,unsigned long size) +{ +unsigned long bit; + + bit =find_first_zero_bit (addr, size); +if (bit < size) +set_bit (bit, addr); + +return bit; +} + +void rtw89_core_release_bit_map (unsigned long *addr,u8 bit) +{ +clear_bit (bit, addr); +} + +void rtw89_core_release_all_bits_map (unsigned long *addr,unsigned int nbits) +{ +bitmap_zero (addr, nbits); +} + +#define RTW89_TYPE_MAPPING (_type) \ + case NL80211_IFTYPE_ ## _type: \ + rtwvif->wifi_role = RTW89_WIFI_ROLE_ ## _type; \ + break +void rtw89_vif_type_mapping (struct ieee80211_vif *vif,bool assoc) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +switch (vif->type) { +RTW89_TYPE_MAPPING (ADHOC ); +RTW89_TYPE_MAPPING (STATION ); +RTW89_TYPE_MAPPING (AP ); +RTW89_TYPE_MAPPING (AP_VLAN ); +RTW89_TYPE_MAPPING (MONITOR ); +RTW89_TYPE_MAPPING (MESH_POINT ); +RTW89_TYPE_MAPPING (P2P_CLIENT ); +RTW89_TYPE_MAPPING (P2P_GO ); +RTW89_TYPE_MAPPING (P2P_DEVICE ); +RTW89_TYPE_MAPPING (NAN ); +default : +WARN_ON (1 ); +break ; + } + +switch (vif->type) { +case NL80211_IFTYPE_AP : +case NL80211_IFTYPE_MESH_POINT : + rtwvif->net_type =RTW89_NET_TYPE_AP_MODE ; + rtwvif->self_role =RTW89_SELF_ROLE_AP ; +break ; +case NL80211_IFTYPE_ADHOC : + rtwvif->net_type =RTW89_NET_TYPE_AD_HOC ; +break ; +case NL80211_IFTYPE_STATION : +if (assoc) { + rtwvif->net_type =RTW89_NET_TYPE_INFRA ; + rtwvif->trigger = vif->bss_conf.he_support; + }else { + rtwvif->net_type =RTW89_NET_TYPE_NO_LINK ; + rtwvif->trigger = false; + } + rtwvif->self_role =RTW89_SELF_ROLE_CLIENT ; + rtwvif->addr_cam.sec_ent_mode =RTW89_ADDR_CAM_SEC_NORMAL ; +break ; +default : +WARN_ON (1 ); +break ; + } +} + +int rtw89_core_sta_add (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +int i; + + rtwsta->rtwvif = rtwvif; + rtwsta->prev_rssi =0 ; + +for (i =0 ; i <ARRAY_SIZE (sta->txq); i++) +rtw89_core_txq_init (rtwdev, sta->txq[i]); + +ewma_rssi_init (&rtwsta->avg_rssi); + +if (vif->type ==NL80211_IFTYPE_STATION ) { + rtwvif->mgd.ap = sta; +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_CONN_START ); +rtw89_chip_rfk_channel (rtwdev); + } + +return 0 ; +} + +int rtw89_core_sta_disassoc (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + + rtwdev->total_sta_assoc--; + rtwsta->disassoc = true; + +return 0 ; +} + +int rtw89_core_sta_disconnect (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +int ret; + +rtw89_mac_bf_monitor_calc (rtwdev, sta, true); +rtw89_mac_bf_disassoc (rtwdev, vif, sta); +rtw89_core_free_sta_pending_ba (rtwdev, sta); + +rtw89_vif_type_mapping (vif, false); + + ret =rtw89_fw_h2c_assoc_cmac_tbl (rtwdev, vif, sta); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cmac table\n" ); +return ret; + } + + ret =rtw89_fw_h2c_join_info (rtwdev, rtwvif,1 ); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c join info\n" ); +return ret; + } + +/* update cam aid mac_id net_type */ +rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cam\n" ); +return ret; + } + +return ret; +} + +int rtw89_core_sta_assoc (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +int ret; + +rtw89_vif_type_mapping (vif, true); + + ret =rtw89_fw_h2c_assoc_cmac_tbl (rtwdev, vif, sta); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cmac table\n" ); +return ret; + } + +/* for station mode, assign the mac_id from itself */ +if (vif->type ==NL80211_IFTYPE_STATION ) + rtwsta->mac_id = rtwvif->mac_id; + + ret =rtw89_fw_h2c_join_info (rtwdev, rtwvif,0 ); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c join info\n" ); +return ret; + } + +/* update cam aid mac_id net_type */ +rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cam\n" ); +return ret; + } + + ret =rtw89_fw_h2c_general_pkt (rtwdev, rtwsta->mac_id); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c general packet\n" ); +return ret; + } + + rtwdev->total_sta_assoc++; +rtw89_phy_ra_assoc (rtwdev, sta); +rtw89_mac_bf_assoc (rtwdev, vif, sta); +rtw89_mac_bf_monitor_calc (rtwdev, sta, false); + +if (vif->type ==NL80211_IFTYPE_STATION ) +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_CONN_END ); + +return ret; +} + +int rtw89_core_sta_remove (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (vif->type ==NL80211_IFTYPE_STATION ) +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_DIS_CONN ); + +return 0 ; +} + +static void rtw89_init_ht_cap (struct rtw89_dev *rtwdev, +struct ieee80211_sta_ht_cap *ht_cap) +{ + ht_cap->ht_supported = true; + ht_cap->cap =0 ; + ht_cap->cap |=IEEE80211_HT_CAP_SGI_20 | +IEEE80211_HT_CAP_MAX_AMSDU | +IEEE80211_HT_CAP_TX_STBC | + (1 <<IEEE80211_HT_CAP_RX_STBC_SHIFT ); + + ht_cap->cap |=IEEE80211_HT_CAP_LDPC_CODING ; + + ht_cap->cap |=IEEE80211_HT_CAP_SUP_WIDTH_20_40 | +IEEE80211_HT_CAP_DSSSCCK40 | +IEEE80211_HT_CAP_SGI_40 ; + ht_cap->ampdu_factor =IEEE80211_HT_MAX_AMPDU_64K ; + ht_cap->ampdu_density =IEEE80211_HT_MPDU_DENSITY_NONE ; + ht_cap->mcs.tx_params =IEEE80211_HT_MCS_TX_DEFINED ; + ht_cap->mcs.rx_mask[0 ] =0xFF ; + ht_cap->mcs.rx_mask[1 ] =0xFF ; + ht_cap->mcs.rx_mask[4 ] =0x01 ; + ht_cap->mcs.rx_highest =cpu_to_le16 (300 ); +} + +static void rtw89_init_vht_cap (struct rtw89_dev *rtwdev, +struct ieee80211_sta_vht_cap *vht_cap) +{ +u16 mcs_map; +__le16 highest; +u8 sts_cap =3 ; + + vht_cap->vht_supported = true; + vht_cap->cap =IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 | +IEEE80211_VHT_CAP_SHORT_GI_80 | +IEEE80211_VHT_CAP_RXSTBC_1 | +IEEE80211_VHT_CAP_HTC_VHT | +IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK | +0 ; + vht_cap->cap |=IEEE80211_VHT_CAP_TXSTBC ; + vht_cap->cap |=IEEE80211_VHT_CAP_RXLDPC ; + vht_cap->cap |=IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE | +IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE ; + vht_cap->cap |= sts_cap <<IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT ; + + mcs_map =IEEE80211_VHT_MCS_SUPPORT_0_9 <<0 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<4 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<6 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<8 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<10 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<12 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<14 ; + highest =cpu_to_le16 (867 ); + mcs_map |=IEEE80211_VHT_MCS_SUPPORT_0_9 <<2 ; + vht_cap->vht_mcs.rx_mcs_map =cpu_to_le16 (mcs_map); + vht_cap->vht_mcs.tx_mcs_map =cpu_to_le16 (mcs_map); + vht_cap->vht_mcs.rx_highest = highest; + vht_cap->vht_mcs.tx_highest = highest; +} + +#define RTW89_SBAND_IFTYPES_NR 2 + +static void rtw89_init_he_cap (struct rtw89_dev *rtwdev, +enum nl80211_band band, +struct ieee80211_supported_band *sband) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_hal *hal = &rtwdev->hal; +struct ieee80211_sband_iftype_data *iftype_data; +bool no_ng16 = (chip->chip_id ==RTL8852A && hal->cv ==CHIP_CBV ) || + (chip->chip_id ==RTL8852B && hal->cv ==CHIP_CAV ); +u16 mcs_map =0 ; +int i; +int nss = chip->rx_nss; +int idx =0 ; + + iftype_data =kcalloc (RTW89_SBAND_IFTYPES_NR ,sizeof (*iftype_data),GFP_KERNEL ); +if (!iftype_data) +return ; + +for (i =0 ; i <8 ; i++) { +if (i < nss) + mcs_map |=IEEE80211_HE_MCS_SUPPORT_0_11 << (i *2 ); +else + mcs_map |=IEEE80211_HE_MCS_NOT_SUPPORTED << (i *2 ); + } + +for (i =0 ; i <NUM_NL80211_IFTYPES ; i++) { +struct ieee80211_sta_he_cap *he_cap; +u8 *mac_cap_info; +u8 *phy_cap_info; + +switch (i) { +case NL80211_IFTYPE_STATION : +case NL80211_IFTYPE_AP : +break ; +default : +continue ; + } + +if (idx >=RTW89_SBAND_IFTYPES_NR ) { +rtw89_warn (rtwdev,"run out of iftype_data\n" ); +break ; + } + + iftype_data[idx].types_mask =BIT (i); + he_cap = &iftype_data[idx].he_cap; + mac_cap_info = he_cap->he_cap_elem.mac_cap_info; + phy_cap_info = he_cap->he_cap_elem.phy_cap_info; + + he_cap->has_he = true; +if (i ==NL80211_IFTYPE_AP ) + mac_cap_info[0 ] =IEEE80211_HE_MAC_CAP0_HTC_HE ; +if (i ==NL80211_IFTYPE_STATION ) + mac_cap_info[1 ] =IEEE80211_HE_MAC_CAP1_TF_MAC_PAD_DUR_16US ; + mac_cap_info[2 ] =IEEE80211_HE_MAC_CAP2_ALL_ACK | +IEEE80211_HE_MAC_CAP2_BSR ; + mac_cap_info[3 ] =IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_2 ; +if (i ==NL80211_IFTYPE_AP ) + mac_cap_info[3 ] |=IEEE80211_HE_MAC_CAP3_OMI_CONTROL ; + mac_cap_info[4 ] =IEEE80211_HE_MAC_CAP4_OPS | +IEEE80211_HE_MAC_CAP4_AMSDU_IN_AMPDU ; +if (i ==NL80211_IFTYPE_STATION ) + mac_cap_info[5 ] =IEEE80211_HE_MAC_CAP5_HT_VHT_TRIG_FRAME_RX ; + phy_cap_info[0 ] =IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_IN_2G | +IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G ; + phy_cap_info[1 ] =IEEE80211_HE_PHY_CAP1_DEVICE_CLASS_A | +IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD | +IEEE80211_HE_PHY_CAP1_HE_LTF_AND_GI_FOR_HE_PPDUS_0_8US ; + phy_cap_info[2 ] = IEEE80211_HE_PHY_CAP2_NDP_4x_LTF_AND_3_2US | +IEEE80211_HE_PHY_CAP2_STBC_TX_UNDER_80MHZ | +IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ | +IEEE80211_HE_PHY_CAP2_DOPPLER_TX ; + phy_cap_info[3 ] =IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_16_QAM ; +if (i ==NL80211_IFTYPE_STATION ) + phy_cap_info[3 ] |=IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_16_QAM | +IEEE80211_HE_PHY_CAP3_DCM_MAX_TX_NSS_2 ; +if (i ==NL80211_IFTYPE_AP ) + phy_cap_info[3 ] |=IEEE80211_HE_PHY_CAP3_RX_PARTIAL_BW_SU_IN_20MHZ_MU ; + phy_cap_info[4 ] =IEEE80211_HE_PHY_CAP4_SU_BEAMFORMEE | +IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_UNDER_80MHZ_4 ; + phy_cap_info[5 ] = no_ng16 ?0 : +IEEE80211_HE_PHY_CAP5_NG16_SU_FEEDBACK | +IEEE80211_HE_PHY_CAP5_NG16_MU_FEEDBACK ; + phy_cap_info[6 ] =IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_42_SU | +IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_75_MU | +IEEE80211_HE_PHY_CAP6_TRIG_SU_BEAMFORMING_FB | +IEEE80211_HE_PHY_CAP6_PARTIAL_BW_EXT_RANGE ; + phy_cap_info[7 ] =IEEE80211_HE_PHY_CAP7_POWER_BOOST_FACTOR_SUPP | +IEEE80211_HE_PHY_CAP7_HE_SU_MU_PPDU_4XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP7_MAX_NC_1 ; + phy_cap_info[8 ] =IEEE80211_HE_PHY_CAP8_HE_ER_SU_PPDU_4XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP8_HE_ER_SU_1XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_996 ; + phy_cap_info[9 ] =IEEE80211_HE_PHY_CAP9_LONGER_THAN_16_SIGB_OFDM_SYM | +IEEE80211_HE_PHY_CAP9_RX_1024_QAM_LESS_THAN_242_TONE_RU | +IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_COMP_SIGB | +IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_NON_COMP_SIGB | +IEEE80211_HE_PHY_CAP9_NOMIMAL_PKT_PADDING_16US ; +if (i ==NL80211_IFTYPE_STATION ) + phy_cap_info[9 ] |=IEEE80211_HE_PHY_CAP9_TX_1024_QAM_LESS_THAN_242_TONE_RU ; + he_cap->he_mcs_nss_supp.rx_mcs_80 =cpu_to_le16 (mcs_map); + he_cap->he_mcs_nss_supp.tx_mcs_80 =cpu_to_le16 (mcs_map); + + idx++; + } + + sband->iftype_data = iftype_data; + sband->n_iftype_data = idx; +} + +static int rtw89_core_set_supported_band (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_supported_band *sband_2ghz =NULL , *sband_5ghz =NULL ; +u32 size =sizeof (struct ieee80211_supported_band ); + + sband_2ghz =kmemdup (&rtw89_sband_2ghz, size,GFP_KERNEL ); +if (!sband_2ghz) + goto err; +rtw89_init_ht_cap (rtwdev, &sband_2ghz->ht_cap); +rtw89_init_he_cap (rtwdev,NL80211_BAND_2GHZ , sband_2ghz); + hw->wiphy->bands[NL80211_BAND_2GHZ ] = sband_2ghz; + + sband_5ghz =kmemdup (&rtw89_sband_5ghz, size,GFP_KERNEL ); +if (!sband_5ghz) + goto err; +rtw89_init_ht_cap (rtwdev, &sband_5ghz->ht_cap); +rtw89_init_vht_cap (rtwdev, &sband_5ghz->vht_cap); +rtw89_init_he_cap (rtwdev,NL80211_BAND_5GHZ , sband_5ghz); + hw->wiphy->bands[NL80211_BAND_5GHZ ] = sband_5ghz; + +return 0 ; + +err: + hw->wiphy->bands[NL80211_BAND_2GHZ ] =NULL ; + hw->wiphy->bands[NL80211_BAND_5GHZ ] =NULL ; +if (sband_2ghz) +kfree (sband_2ghz->iftype_data); +if (sband_5ghz) +kfree (sband_5ghz->iftype_data); +kfree (sband_2ghz); +kfree (sband_5ghz); +return -ENOMEM ; +} + +static void rtw89_core_clr_supported_band (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; + +kfree (hw->wiphy->bands[NL80211_BAND_2GHZ ]->iftype_data); +kfree (hw->wiphy->bands[NL80211_BAND_5GHZ ]->iftype_data); +kfree (hw->wiphy->bands[NL80211_BAND_2GHZ ]); +kfree (hw->wiphy->bands[NL80211_BAND_5GHZ ]); + hw->wiphy->bands[NL80211_BAND_2GHZ ] =NULL ; + hw->wiphy->bands[NL80211_BAND_5GHZ ] =NULL ; +} + +static void rtw89_core_ppdu_sts_init (struct rtw89_dev *rtwdev) +{ +int i; + +for (i =0 ; i <RTW89_PHY_MAX ; i++) +skb_queue_head_init (&rtwdev->ppdu_sts.rx_queue[i]); +for (i =0 ; i <RTW89_PHY_MAX ; i++) + rtwdev->ppdu_sts.curr_rx_ppdu_cnt[i] =U8_MAX ; +} + +int rtw89_core_start (struct rtw89_dev *rtwdev) +{ +int ret; + + rtwdev->mac.qta_mode =RTW89_QTA_SCC ; + ret =rtw89_mac_init (rtwdev); +if (ret) { +rtw89_err (rtwdev,"mac init fail, ret:%d\n" , ret); +return ret; + } + +rtw89_btc_ntfy_poweron (rtwdev); + +/* efuse process */ + +/* pre-config BB/RF, BB reset/RFC reset */ +rtw89_mac_disable_bb_rf (rtwdev); +rtw89_mac_enable_bb_rf (rtwdev); +rtw89_phy_init_bb_reg (rtwdev); +rtw89_phy_init_rf_reg (rtwdev); + +rtw89_btc_ntfy_init (rtwdev,BTC_MODE_NORMAL ); + +rtw89_phy_dm_init (rtwdev); + +rtw89_mac_cfg_ppdu_status (rtwdev,RTW89_MAC_0 , true); +rtw89_mac_update_rts_threshold (rtwdev,RTW89_MAC_0 ); + + ret =rtw89_hci_start (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to start hci\n" ); +return ret; + } + +ieee80211_queue_delayed_work (rtwdev->hw, &rtwdev->track_work, +RTW89_TRACK_WORK_PERIOD ); + +set_bit (RTW89_FLAG_RUNNING , rtwdev->flags); + +rtw89_btc_ntfy_radio_state (rtwdev,BTC_RFCTRL_WL_ON ); +rtw89_fw_h2c_fw_log (rtwdev, rtwdev->fw.fw_log_enable); + +return 0 ; +} + +void rtw89_core_stop (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +/* Prvent to stop twice; enter_ips and ops_stop */ +if (!test_bit (RTW89_FLAG_RUNNING , rtwdev->flags)) +return ; + +rtw89_btc_ntfy_radio_state (rtwdev,BTC_RFCTRL_WL_OFF ); + +clear_bit (RTW89_FLAG_RUNNING , rtwdev->flags); + +mutex_unlock (&rtwdev->mutex); + +cancel_work_sync (&rtwdev->c2h_work); +cancel_work_sync (&btc->eapol_notify_work); +cancel_work_sync (&btc->arp_notify_work); +cancel_work_sync (&btc->dhcp_notify_work); +cancel_work_sync (&btc->wl_sta_notify_work); +cancel_delayed_work_sync (&rtwdev->txq_reinvoke_work); +cancel_delayed_work_sync (&rtwdev->track_work); +cancel_delayed_work_sync (&rtwdev->coex_act1_work); +cancel_delayed_work_sync (&rtwdev->cfo_track_work); + +mutex_lock (&rtwdev->mutex); + +rtw89_btc_ntfy_poweroff (rtwdev); +rtw89_hci_flush_queues (rtwdev,BIT (rtwdev->hw->queues) -1 , true); +rtw89_mac_flush_txq (rtwdev,BIT (rtwdev->hw->queues) -1 , true); +rtw89_hci_stop (rtwdev); +rtw89_hci_deinit (rtwdev); +rtw89_mac_pwr_off (rtwdev); +rtw89_hci_reset (rtwdev); +} + +int rtw89_core_init (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +int ret; + +INIT_LIST_HEAD (&rtwdev->ba_list); +INIT_WORK (&rtwdev->ba_work, rtw89_core_ba_work); +INIT_WORK (&rtwdev->txq_work, rtw89_core_txq_work); +INIT_DELAYED_WORK (&rtwdev->txq_reinvoke_work, rtw89_core_txq_reinvoke_work); +INIT_DELAYED_WORK (&rtwdev->track_work, rtw89_track_work); +INIT_DELAYED_WORK (&rtwdev->coex_act1_work, rtw89_coex_act1_work); +INIT_DELAYED_WORK (&rtwdev->cfo_track_work, rtw89_phy_cfo_track_work); + rtwdev->txq_wq =alloc_workqueue ("rtw89_tx_wq" ,WQ_UNBOUND |WQ_HIGHPRI ,0 ); +spin_lock_init (&rtwdev->ba_lock); +mutex_init (&rtwdev->mutex); +mutex_init (&rtwdev->rf_mutex); + rtwdev->total_sta_assoc =0 ; + +INIT_WORK (&rtwdev->c2h_work, rtw89_fw_c2h_work); +skb_queue_head_init (&rtwdev->c2h_queue); +rtw89_core_ppdu_sts_init (rtwdev); +rtw89_traffic_stats_init (rtwdev, &rtwdev->stats); + + rtwdev->ps_mode =rtw89_update_ps_mode (rtwdev); + rtwdev->hal.rx_fltr =DEFAULT_AX_RX_FLTR ; + +INIT_WORK (&btc->eapol_notify_work, rtw89_btc_ntfy_eapol_packet_work); +INIT_WORK (&btc->arp_notify_work, rtw89_btc_ntfy_arp_packet_work); +INIT_WORK (&btc->dhcp_notify_work, rtw89_btc_ntfy_dhcp_packet_work); +INIT_WORK (&btc->wl_sta_notify_work, rtw89_btc_ntfy_wl_sta_work); + + ret =rtw89_load_firmware (rtwdev); +if (ret) { +rtw89_warn (rtwdev,"no firmware loaded\n" ); +return ret; + } +rtw89_ser_init (rtwdev); + +return 0 ; +} +EXPORT_SYMBOL (rtw89_core_init); + +void rtw89_core_deinit (struct rtw89_dev *rtwdev) +{ +rtw89_ser_deinit (rtwdev); +rtw89_unload_firmware (rtwdev); + +destroy_workqueue (rtwdev->txq_wq); +mutex_destroy (&rtwdev->rf_mutex); +mutex_destroy (&rtwdev->mutex); +} +EXPORT_SYMBOL (rtw89_core_deinit); + +static void rtw89_read_chip_ver (struct rtw89_dev *rtwdev) +{ +u8 cv; + + cv =rtw89_read32_mask (rtwdev,R_AX_SYS_CFG1 ,B_AX_CHIP_VER_MSK ); +if (cv <=CHIP_CBV ) { +if (rtw89_read32 (rtwdev,R_AX_GPIO0_7_FUNC_SEL ) ==RTW89_R32_DEAD ) + cv =CHIP_CAV ; +else + cv =CHIP_CBV ; + } + + rtwdev->hal.cv = cv; +} + +static int rtw89_chip_efuse_info_setup (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_mac_partial_init (rtwdev); +if (ret) +return ret; + + ret =rtw89_parse_efuse_map (rtwdev); +if (ret) +return ret; + + ret =rtw89_parse_phycap_map (rtwdev); +if (ret) +return ret; + +rtw89_mac_pwr_off (rtwdev); + +return 0 ; +} + +static int rtw89_chip_board_info_setup (struct rtw89_dev *rtwdev) +{ +rtw89_chip_fem_setup (rtwdev); + +return 0 ; +} + +int rtw89_chip_info_setup (struct rtw89_dev *rtwdev) +{ +int ret; + +rtw89_read_chip_ver (rtwdev); + + ret =rtw89_wait_firmware_completion (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to wait firmware completion\n" ); +return ret; + } + + ret =rtw89_fw_recognize (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to recognize firmware\n" ); +return ret; + } + + ret =rtw89_chip_efuse_info_setup (rtwdev); +if (ret) +return ret; + + ret =rtw89_chip_board_info_setup (rtwdev); +if (ret) +return ret; + +return 0 ; +} +EXPORT_SYMBOL (rtw89_chip_info_setup); + +static int rtw89_core_register_hw (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct rtw89_efuse *efuse = &rtwdev->efuse; +int ret; +int tx_headroom =IEEE80211_HT_CTL_LEN ; + + hw->vif_data_size =sizeof (struct rtw89_vif ); + hw->sta_data_size =sizeof (struct rtw89_sta ); + hw->txq_data_size =sizeof (struct rtw89_txq ); + +SET_IEEE80211_PERM_ADDR (hw, efuse->addr); + + hw->extra_tx_headroom = tx_headroom; + hw->queues =IEEE80211_NUM_ACS ; + hw->max_rx_aggregation_subframes =RTW89_MAX_RX_AGG_NUM ; + hw->max_tx_aggregation_subframes =RTW89_MAX_TX_AGG_NUM ; + +ieee80211_hw_set (hw,SIGNAL_DBM ); +ieee80211_hw_set (hw,HAS_RATE_CONTROL ); +ieee80211_hw_set (hw,MFP_CAPABLE ); +ieee80211_hw_set (hw,REPORTS_TX_ACK_STATUS ); +ieee80211_hw_set (hw,AMPDU_AGGREGATION ); +ieee80211_hw_set (hw,RX_INCLUDES_FCS ); +ieee80211_hw_set (hw,TX_AMSDU ); +ieee80211_hw_set (hw,SUPPORT_FAST_XMIT ); +ieee80211_hw_set (hw,SUPPORTS_AMSDU_IN_AMPDU ); +ieee80211_hw_set (hw,SUPPORTS_PS ); +ieee80211_hw_set (hw,SUPPORTS_DYNAMIC_PS ); + + hw->wiphy->interface_modes =BIT (NL80211_IFTYPE_STATION ); + hw->wiphy->available_antennas_tx =BIT (rtwdev->chip->rf_path_num) -1 ; + hw->wiphy->available_antennas_rx =BIT (rtwdev->chip->rf_path_num) -1 ; + + hw->wiphy->features |=NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR ; + +wiphy_ext_feature_set (hw->wiphy,NL80211_EXT_FEATURE_CAN_REPLACE_PTK0 ); + + ret =rtw89_core_set_supported_band (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to set supported band\n" ); +return ret; + } + + hw->wiphy->reg_notifier = rtw89_regd_notifier; + hw->wiphy->sar_capa = &rtw89_sar_capa; + + ret =ieee80211_register_hw (hw); +if (ret) { +rtw89_err (rtwdev,"failed to register hw\n" ); + goto err; + } + + ret =rtw89_regd_init (rtwdev, rtw89_regd_notifier); +if (ret) { +rtw89_err (rtwdev,"failed to init regd\n" ); + goto err; + } + +return 0 ; + +err: +return ret; +} + +static void rtw89_core_unregister_hw (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; + +ieee80211_unregister_hw (hw); +rtw89_core_clr_supported_band (rtwdev); +} + +int rtw89_core_register (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_core_register_hw (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to register core hw\n" ); +return ret; + } + +rtw89_debugfs_init (rtwdev); + +return 0 ; +} +EXPORT_SYMBOL (rtw89_core_register); + +void rtw89_core_unregister (struct rtw89_dev *rtwdev) +{ +rtw89_core_unregister_hw (rtwdev); +} +EXPORT_SYMBOL (rtw89_core_unregister); + +MODULE_AUTHOR ("Realtek Corporation" ); +MODULE_DESCRIPTION ("Realtek 802.11ax wireless core module" ); +MODULE_LICENSE ("Dual BSD/GPL" );
drivers/net/wireless/realtek/rtw89/core.h new file +3336 -0
641 lines not on this page · raw message
drivers/net/wireless/realtek/rtw89/txrx.h new file +393 -0
393 lines not on this page · raw message
drivers/net/wireless/realtek/rtw89/util.c new file +37 -0
Lines of this file are not shown. View the raw message.
drivers/net/wireless/realtek/rtw89/util.h new file +31 -0
Lines of this file are not shown. View the raw message.
The rest of this diff is not shown. View the raw message.
Signature · 1 line
2.25.1
Part of the diff is not shown here. View the raw message.
Re: [PATCH 03/24] rtw89: add core and trx files
Quoted 1,235 lines · Ping-Ke Shih
Implement main flows that contains register/unregister mac80211 hw with hardware capability, power on/off sequence, STA state actions, and TX/RX path.
The chip info is read from efuse while probing PCI, and then it can be used to induce supported channel, band, bitrate, ht/vht/he capability, and etc. Then, we register hardware with these capabilities.
When network interface is up, driver does power-on sequence to enable MAC, BB and RF function blocks. Oppositely, do power-off sequence when interface is going to down.
To maintain STA state, five callbacks are implemented -- add, assoc, disassoc, disconnect and remove. In which state, driver tells firmware STA info via H2C.
TX flow:
When a SKB is going to be transmitted, we must know its type first. If the type is mgmt or fwcmd made by driver, SKB is queued into corresponding DMA channel and PCI ring. The other type is data frame that is more complex, because it needs to establish BA session to have better throughput with AMPDU and AMSDU.
In order to have better PCI DMA efficiency, we don't kick off DMA every SKB. With wake TX queue, kick off DMA after a bunch of SKBs are written. To achieve this, we have two HCI ops --tx_writeandtx_kick_off.BA establishment work:
For data frames, we start to establish BA session if the STA is associated with APMDU capability and the TID session isn't established, and then the BA work is used to ask mac80211 to start AMPDU actions. Driver implements AMPDU action callbacks to know the session is established, so that we can setAGG_ENbit in TX descriptor to enable AMPDU.RX flow:
When a RX SKB is delivered from PCI,rtw89_core_rx()process it depneds on its type -- WIFI, C2H or PPDU. If type is C2H, it's queued into a C2H queue, and wake a work to handle the C2H packet. If type is WIFI, it's a normal RX packet. When mgmt or data frame is received, it is queued into pending RX SKB queue to wait for corresponding PPDU packet (another RX packet with PPDU type) to fill itsrx_status, like RSSI. And, then indicate this packet to mac80211. When control frame is received, indicate it to mac80211 immediately.Track work:
Use track work to monitor PHY status to know the changes of environment, and then update RA status or do RFK accordingly.Signed-off-by Ping-Ke Shih <[email protected]>--- drivers/net/wireless/realtek/rtw89/core.c | 2359 +++++++++++++++ drivers/net/wireless/realtek/rtw89/core.h | 3336 +++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/txrx.h | 393 +++ drivers/net/wireless/realtek/rtw89/util.c | 37 + drivers/net/wireless/realtek/rtw89/util.h | 31 + 5 files changed, 6156 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/core.c create mode 100644 drivers/net/wireless/realtek/rtw89/core.h create mode 100644 drivers/net/wireless/realtek/rtw89/txrx.h create mode 100644 drivers/net/wireless/realtek/rtw89/util.c create mode 100644 drivers/net/wireless/realtek/rtw89/util.hdrivers/net/wireless/realtek/rtw89/core.c new file +1168
-0@@ -0,0 +1,2359 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "coex.h" +#include "core.h" +#include "efuse.h" +#include "fw.h" +#include "mac.h" +#include "phy.h" +#include "ps.h" +#include "reg.h" +#include "sar.h" +#include "ser.h" +#include "txrx.h" +#include "util.h" + +static bool rtw89_disable_ps_mode; +module_param_named (disable_ps_mode, rtw89_disable_ps_mode, bool,0644 ); +MODULE_PARM_DESC (disable_ps_mode,"Set Y to disable low power mode" ); + +static struct ieee80211_channel rtw89_channels_2ghz[] = { + { .center_freq =2412 , .hw_value =1 , }, + { .center_freq =2417 , .hw_value =2 , }, + { .center_freq =2422 , .hw_value =3 , }, + { .center_freq =2427 , .hw_value =4 , }, + { .center_freq =2432 , .hw_value =5 , }, + { .center_freq =2437 , .hw_value =6 , }, + { .center_freq =2442 , .hw_value =7 , }, + { .center_freq =2447 , .hw_value =8 , }, + { .center_freq =2452 , .hw_value =9 , }, + { .center_freq =2457 , .hw_value =10 , }, + { .center_freq =2462 , .hw_value =11 , }, + { .center_freq =2467 , .hw_value =12 , }, + { .center_freq =2472 , .hw_value =13 , }, + { .center_freq =2484 , .hw_value =14 , }, +}; + +static struct ieee80211_channel rtw89_channels_5ghz[] = { + {.center_freq =5180 , .hw_value =36 ,}, + {.center_freq =5200 , .hw_value =40 ,}, + {.center_freq =5220 , .hw_value =44 ,}, + {.center_freq =5240 , .hw_value =48 ,}, + {.center_freq =5260 , .hw_value =52 ,}, + {.center_freq =5280 , .hw_value =56 ,}, + {.center_freq =5300 , .hw_value =60 ,}, + {.center_freq =5320 , .hw_value =64 ,}, + {.center_freq =5500 , .hw_value =100 ,}, + {.center_freq =5520 , .hw_value =104 ,}, + {.center_freq =5540 , .hw_value =108 ,}, + {.center_freq =5560 , .hw_value =112 ,}, + {.center_freq =5580 , .hw_value =116 ,}, + {.center_freq =5600 , .hw_value =120 ,}, + {.center_freq =5620 , .hw_value =124 ,}, + {.center_freq =5640 , .hw_value =128 ,}, + {.center_freq =5660 , .hw_value =132 ,}, + {.center_freq =5680 , .hw_value =136 ,}, + {.center_freq =5700 , .hw_value =140 ,}, + {.center_freq =5720 , .hw_value =144 ,}, + {.center_freq =5745 , .hw_value =149 ,}, + {.center_freq =5765 , .hw_value =153 ,}, + {.center_freq =5785 , .hw_value =157 ,}, + {.center_freq =5805 , .hw_value =161 ,}, + {.center_freq =5825 , .hw_value =165 , + .flags =IEEE80211_CHAN_NO_HT40MINUS }, +}; + +static struct ieee80211_rate rtw89_bitrates[] = { + { .bitrate =10 , .hw_value =0x00 , }, + { .bitrate =20 , .hw_value =0x01 , }, + { .bitrate =55 , .hw_value =0x02 , }, + { .bitrate =110 , .hw_value =0x03 , }, + { .bitrate =60 , .hw_value =0x04 , }, + { .bitrate =90 , .hw_value =0x05 , }, + { .bitrate =120 , .hw_value =0x06 , }, + { .bitrate =180 , .hw_value =0x07 , }, + { .bitrate =240 , .hw_value =0x08 , }, + { .bitrate =360 , .hw_value =0x09 , }, + { .bitrate =480 , .hw_value =0x0a , }, + { .bitrate =540 , .hw_value =0x0b , }, +}; + +u16 rtw89_ra_report_to_bitrate (struct rtw89_dev *rtwdev,u8 rpt_rate) +{ +struct ieee80211_rate rate; + +if (unlikely (rpt_rate >=ARRAY_SIZE (rtw89_bitrates))) { +rtw89_info (rtwdev,"invalid rpt rate %d\n" , rpt_rate); +return 0 ; + } + + rate = rtw89_bitrates[rpt_rate]; + +return rate.bitrate; +} + +static struct ieee80211_supported_band rtw89_sband_2ghz = { + .band =NL80211_BAND_2GHZ , + .channels = rtw89_channels_2ghz, + .n_channels =ARRAY_SIZE (rtw89_channels_2ghz), + .bitrates = rtw89_bitrates, + .n_bitrates =ARRAY_SIZE (rtw89_bitrates), + .ht_cap = {0 }, + .vht_cap = {0 }, +}; + +static struct ieee80211_supported_band rtw89_sband_5ghz = { + .band =NL80211_BAND_5GHZ , + .channels = rtw89_channels_5ghz, + .n_channels =ARRAY_SIZE (rtw89_channels_5ghz), + +/* 5G has no CCK rates, 1M/2M/5.5M/11M */ + .bitrates = rtw89_bitrates +4 , + .n_bitrates =ARRAY_SIZE (rtw89_bitrates) -4 , + .ht_cap = {0 }, + .vht_cap = {0 }, +}; + +static void rtw89_traffic_stats_accu (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats, +struct sk_buff *skb,bool tx) +{ +struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; + +if (!ieee80211_is_data (hdr->frame_control)) +return ; + +if (is_broadcast_ether_addr (hdr->addr1) || +is_multicast_ether_addr (hdr->addr1)) +return ; + +if (tx) { + stats->tx_cnt++; + stats->tx_unicast += skb->len; + }else { + stats->rx_cnt++; + stats->rx_unicast += skb->len; + } +} + +static void rtw89_get_channel_params (struct cfg80211_chan_def *chandef, +struct rtw89_channel_params *chan_param) +{ +struct ieee80211_channel *channel = chandef->chan; +enum nl80211_chan_width width = chandef->width; +u8 *cch_by_bw = chan_param->cch_by_bw; +u32 primary_freq, center_freq; +u8 center_chan; +u8 bandwidth =RTW89_CHANNEL_WIDTH_20 ; +u8 primary_chan_idx =0 ; +u8 i; + + center_chan = channel->hw_value; + primary_freq = channel->center_freq; + center_freq = chandef->center_freq1; + +/* assign the center channel used while 20M bw is selected */ + cch_by_bw[RTW89_CHANNEL_WIDTH_20 ] = channel->hw_value; + +switch (width) { +case NL80211_CHAN_WIDTH_20_NOHT : +case NL80211_CHAN_WIDTH_20 : + bandwidth =RTW89_CHANNEL_WIDTH_20 ; + primary_chan_idx =RTW89_SC_DONT_CARE ; +break ; +case NL80211_CHAN_WIDTH_40 : + bandwidth =RTW89_CHANNEL_WIDTH_40 ; +if (primary_freq > center_freq) { + primary_chan_idx =RTW89_SC_20_UPPER ; + center_chan -=2 ; + }else { + primary_chan_idx =RTW89_SC_20_LOWER ; + center_chan +=2 ; + } +break ; +case NL80211_CHAN_WIDTH_80 : + bandwidth =RTW89_CHANNEL_WIDTH_80 ; +if (primary_freq > center_freq) { +if (primary_freq - center_freq ==10 ) { + primary_chan_idx =RTW89_SC_20_UPPER ; + center_chan -=2 ; + }else { + primary_chan_idx =RTW89_SC_20_UPMOST ; + center_chan -=6 ; + } +/* assign the center channel used +* while 40M bw is selected +*/ + cch_by_bw[RTW89_CHANNEL_WIDTH_40 ] = center_chan +4 ; + }else { +if (center_freq - primary_freq ==10 ) { + primary_chan_idx =RTW89_SC_20_LOWER ; + center_chan +=2 ; + }else { + primary_chan_idx =RTW89_SC_20_LOWEST ; + center_chan +=6 ; + } +/* assign the center channel used +* while 40M bw is selected +*/ + cch_by_bw[RTW89_CHANNEL_WIDTH_40 ] = center_chan -4 ; + } +break ; +default : + center_chan =0 ; +break ; + } + + chan_param->center_chan = center_chan; + chan_param->primary_chan = channel->hw_value; + chan_param->bandwidth = bandwidth; + chan_param->pri_ch_idx = primary_chan_idx; + +/* assign the center channel used while current bw is selected */ + cch_by_bw[bandwidth] = center_chan; + +for (i = bandwidth +1 ; i <=RTW89_MAX_CHANNEL_WIDTH ; i++) + cch_by_bw[i] =0 ; +} + +void rtw89_set_channel (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_hal *hal = &rtwdev->hal; +struct rtw89_channel_params ch_param; +struct rtw89_channel_help_params bak; +u8 center_chan, bandwidth; +u8 band_type; +bool band_changed; +u8 i; + +rtw89_get_channel_params (&hw->conf.chandef, &ch_param); +if (WARN (ch_param.center_chan ==0 ,"Invalid channel\n" )) +return ; + + center_chan = ch_param.center_chan; + bandwidth = ch_param.bandwidth; + band_type = center_chan >14 ?RTW89_BAND_5G :RTW89_BAND_2G ; + band_changed = hal->current_band_type != band_type || + hal->current_channel ==0 ; + + hal->current_band_width = bandwidth; + hal->current_channel = center_chan; + hal->current_primary_channel = ch_param.primary_chan; + hal->current_band_type = band_type; + +switch (center_chan) { + case 1 ... 14: + hal->current_subband =RTW89_CH_2G ; +break ; + case 36 ... 64: + hal->current_subband =RTW89_CH_5G_BAND_1 ; +break ; + case 100 ... 144: + hal->current_subband =RTW89_CH_5G_BAND_3 ; +break ; + case 149 ... 177: + hal->current_subband =RTW89_CH_5G_BAND_4 ; +break ; + } + +for (i =RTW89_CHANNEL_WIDTH_20 ; i <=RTW89_MAX_CHANNEL_WIDTH ; i++) + hal->cch_by_bw[i] = ch_param.cch_by_bw[i]; + +rtw89_chip_set_channel_prepare (rtwdev, &bak); + + chip->ops->set_channel (rtwdev, &ch_param); + +rtw89_chip_set_txpwr (rtwdev); + +rtw89_chip_set_channel_done (rtwdev, &bak); + +if (band_changed) { +rtw89_btc_ntfy_switch_band (rtwdev,RTW89_PHY_0 , hal->current_band_type); +rtw89_chip_rfk_band_changed (rtwdev); + } +} + +static enum rtw89_core_tx_type +rtw89_core_get_tx_type (struct rtw89_dev *rtwdev, +struct sk_buff *skb) +{ +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; + +if (ieee80211_is_mgmt (fc) ||ieee80211_is_nullfunc (fc)) +return RTW89_CORE_TX_TYPE_MGMT ; + +return RTW89_CORE_TX_TYPE_DATA ; +} + +static void +rtw89_core_tx_update_ampdu_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req,u8 tid) +{ +struct ieee80211_sta *sta = tx_req->sta; +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct rtw89_sta *rtwsta; +u8 ampdu_num; + +if (!sta) { +rtw89_warn (rtwdev,"cannot set ampdu info without sta\n" ); +return ; + } + + rtwsta = (struct rtw89_sta *)sta->drv_priv; + + ampdu_num = (u8)((rtwsta->ampdu_params[tid].agg_num ? + rtwsta->ampdu_params[tid].agg_num : +4 << sta->ht_cap.ampdu_factor) -1 ); + + desc_info->agg_en = true; + desc_info->ampdu_density = sta->ht_cap.ampdu_density; + desc_info->ampdu_num = ampdu_num; +} + +static void +rtw89_core_tx_update_sec_key (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct ieee80211_vif *vif = tx_req->vif; +struct ieee80211_tx_info *info; +struct ieee80211_key_conf *key; +struct rtw89_vif *rtwvif; +struct rtw89_addr_cam_entry *addr_cam; +struct rtw89_sec_cam_entry *sec_cam; +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +u8 sec_type =RTW89_SEC_KEY_TYPE_NONE ; + +if (!vif) { +rtw89_warn (rtwdev,"cannot set sec key without vif\n" ); +return ; + } + + rtwvif = (struct rtw89_vif *)vif->drv_priv; + addr_cam = &rtwvif->addr_cam; + + info =IEEE80211_SKB_CB (skb); + key = info->control.hw_key; + sec_cam = addr_cam->sec_entries[key->hw_key_idx]; +if (!sec_cam) { +rtw89_warn (rtwdev,"sec cam entry is empty\n" ); +return ; + } + +switch (key->cipher) { +case WLAN_CIPHER_SUITE_WEP40 : + sec_type =RTW89_SEC_KEY_TYPE_WEP40 ; +break ; +case WLAN_CIPHER_SUITE_WEP104 : + sec_type =RTW89_SEC_KEY_TYPE_WEP104 ; +break ; +case WLAN_CIPHER_SUITE_TKIP : + sec_type =RTW89_SEC_KEY_TYPE_TKIP ; +break ; +case WLAN_CIPHER_SUITE_CCMP : + sec_type =RTW89_SEC_KEY_TYPE_CCMP128 ; +break ; +case WLAN_CIPHER_SUITE_CCMP_256 : + sec_type =RTW89_SEC_KEY_TYPE_CCMP256 ; +break ; +case WLAN_CIPHER_SUITE_GCMP : + sec_type =RTW89_SEC_KEY_TYPE_GCMP128 ; +break ; +case WLAN_CIPHER_SUITE_GCMP_256 : + sec_type =RTW89_SEC_KEY_TYPE_GCMP256 ; +break ; +default : +rtw89_warn (rtwdev,"key cipher not supported %d\n" , key->cipher); +return ; + } + + desc_info->sec_en = true; + desc_info->sec_type = sec_type; + desc_info->sec_cam_idx = sec_cam->sec_cam_idx; +} + +static void +rtw89_core_tx_update_mgmt_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +u8 qsel, ch_dma; + + qsel =RTW89_TX_QSEL_B0_MGMT ; + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + + desc_info->qsel =RTW89_TX_QSEL_B0_MGMT ; + desc_info->ch_dma = ch_dma; + +/* fixed data rate for mgmt frames */ + desc_info->en_wd_info = true; + desc_info->use_rate = true; + desc_info->dis_data_fb = true; + desc_info->data_rate =0x00 ; +} + +static void +rtw89_core_tx_update_h2c_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; + + desc_info->is_bmc = false; + desc_info->wd_page = false; + desc_info->ch_dma =RTW89_DMA_H2C ; +} + +static bool +__rtw89_core_tx_check_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req, +enum btc_pkt_type pkt_type) +{ +struct ieee80211_sta *sta = tx_req->sta; +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; + +/* AP IOT issue with EAPoL, ARP and DHCP */ +if (pkt_type <PACKET_MAX ) +return false; + +if (!sta || !sta->he_cap.has_he) +return false; + +if (!ieee80211_is_data_qos (fc)) +return false; + +if (skb_headroom (skb) <IEEE80211_HT_CTL_LEN ) +return false; + +return true; +} + +static void +__rtw89_core_tx_adjust_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +__le16 fc = hdr->frame_control; +void *data; +__le32 *htc; +u8 *qc; +int hdr_len; + + hdr_len =ieee80211_has_a4 (fc) ?32 :26 ; + data =skb_push (skb,IEEE80211_HT_CTL_LEN ); +memmove (data, data +IEEE80211_HT_CTL_LEN , hdr_len); + + hdr = data; + htc = data + hdr_len; + hdr->frame_control |=cpu_to_le16 (IEEE80211_FCTL_ORDER ); +memset (htc,0 ,sizeof (*htc)); + *htc =le32_encode_bits (RTW89_HTC_VARIANT_HE ,RTW89_HTC_MASK_VARIANT ) | +le32_encode_bits (RTW89_HTC_VARIANT_HE_CID_CAS ,RTW89_HTC_MASK_CTL_ID ); + + qc = data + hdr_len -IEEE80211_QOS_CTL_LEN ; + qc[0 ] |=IEEE80211_QOS_CTL_EOSP ; +} + +static void +rtw89_core_tx_update_he_qos_htc (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req, +enum btc_pkt_type pkt_type) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct ieee80211_vif *vif = tx_req->vif; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +if (!__rtw89_core_tx_check_he_qos_htc (rtwdev, tx_req, pkt_type)) + goto desc_bk; + +__rtw89_core_tx_adjust_he_qos_htc (rtwdev, tx_req); + + desc_info->pkt_size +=IEEE80211_HT_CTL_LEN ; + desc_info->a_ctrl_bsr = true; + +desc_bk: +if (!rtwvif || rtwvif->last_a_ctrl == desc_info->a_ctrl_bsr) +return ; + + rtwvif->last_a_ctrl = desc_info->a_ctrl_bsr; + desc_info->bk = true; +} + +static void +rtw89_core_tx_update_data_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +u8 tid, tid_indicate; +u8 qsel, ch_dma; + + tid = skb->priority &IEEE80211_QOS_CTL_TAG1D_MASK ; + tid_indicate =rtw89_core_get_tid_indicate (rtwdev, tid); + qsel =rtw89_core_get_qsel (rtwdev, tid); + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + + desc_info->ch_dma = ch_dma; + desc_info->tid_indicate = tid_indicate; + desc_info->qsel = qsel; + +/* enable wd_info for AMPDU */ + desc_info->en_wd_info = true; + +if (IEEE80211_SKB_CB (skb)->flags &IEEE80211_TX_CTL_AMPDU ) +rtw89_core_tx_update_ampdu_info (rtwdev, tx_req, tid); +if (IEEE80211_SKB_CB (skb)->control.hw_key) +rtw89_core_tx_update_sec_key (rtwdev, tx_req); +} + +static enum btc_pkt_type +rtw89_core_tx_btc_spec_pkt_notify (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct sk_buff *skb = tx_req->skb; +struct udphdr *udphdr; + +if (IEEE80211_SKB_CB (skb)->control.flags &IEEE80211_TX_CTRL_PORT_CTRL_PROTO ) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.eapol_notify_work); +return PACKET_EAPOL ; + } + +if (skb->protocol ==htons (ETH_P_ARP )) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.arp_notify_work); +return PACKET_ARP ; + } + +if (skb->protocol ==htons (ETH_P_IP ) && +ip_hdr (skb)->protocol ==IPPROTO_UDP ) { + udphdr =udp_hdr (skb); +if (((udphdr->source ==htons (67 ) && udphdr->dest ==htons (68 )) || + (udphdr->source ==htons (68 ) && udphdr->dest ==htons (67 ))) && + skb->len >282 ) { +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.dhcp_notify_work); +return PACKET_DHCP ; + } + } + +return PACKET_MAX ; +} + +static void +rtw89_core_tx_update_desc_info (struct rtw89_dev *rtwdev, +struct rtw89_core_tx_request *tx_req) +{ +struct rtw89_tx_desc_info *desc_info = &tx_req->desc_info; +struct sk_buff *skb = tx_req->skb; +struct ieee80211_hdr *hdr = (void *)skb->data; +enum rtw89_core_tx_type tx_type; +enum btc_pkt_type pkt_type; +bool is_bmc; +u16 seq; + + seq = (le16_to_cpu (hdr->seq_ctrl) &IEEE80211_SCTL_SEQ ) >>4 ; +if (tx_req->tx_type !=RTW89_CORE_TX_TYPE_FWCMD ) { + tx_type =rtw89_core_get_tx_type (rtwdev, skb); + tx_req->tx_type = tx_type; + } + is_bmc = (is_broadcast_ether_addr (hdr->addr1) || +is_multicast_ether_addr (hdr->addr1)); + + desc_info->seq = seq; + desc_info->pkt_size = skb->len; + desc_info->is_bmc = is_bmc; + desc_info->wd_page = true; + +switch (tx_req->tx_type) { +case RTW89_CORE_TX_TYPE_MGMT : +rtw89_core_tx_update_mgmt_info (rtwdev, tx_req); +break ; +case RTW89_CORE_TX_TYPE_DATA : +rtw89_core_tx_update_data_info (rtwdev, tx_req); + pkt_type =rtw89_core_tx_btc_spec_pkt_notify (rtwdev, tx_req); +rtw89_core_tx_update_he_qos_htc (rtwdev, tx_req, pkt_type); +break ; +case RTW89_CORE_TX_TYPE_FWCMD : +rtw89_core_tx_update_h2c_info (rtwdev, tx_req); +break ; + } +} + +void rtw89_core_tx_kick_off (struct rtw89_dev *rtwdev,u8 qsel) +{ +u8 ch_dma; + + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + +rtw89_hci_tx_kick_off (rtwdev, ch_dma); +} + +int rtw89_h2c_tx (struct rtw89_dev *rtwdev, +struct sk_buff *skb,bool fwdl) +{ +struct rtw89_core_tx_request tx_req = {0 }; +int ret; + + tx_req.skb = skb; + tx_req.tx_type =RTW89_CORE_TX_TYPE_FWCMD ; +if (fwdl) + tx_req.desc_info.fw_dl = true; + +rtw89_core_tx_update_desc_info (rtwdev, &tx_req); + +if (!fwdl) +rtw89_hex_dump (rtwdev,RTW89_DBG_FW ,"H2C: " , skb->data, skb->len); + + ret =rtw89_hci_tx_write (rtwdev, &tx_req); +if (ret) { +rtw89_err (rtwdev,"failed to transmit skb to HCI\n" ); +return ret; + } +rtw89_hci_tx_kick_off (rtwdev,RTW89_TXCH_CH12 ); + +return 0 ; +} + +int rtw89_core_tx_write (struct rtw89_dev *rtwdev,struct ieee80211_vif *vif, +struct ieee80211_sta *sta,struct sk_buff *skb,int *qsel) +{ +struct rtw89_core_tx_request tx_req = {0 }; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +int ret; + + tx_req.skb = skb; + tx_req.sta = sta; + tx_req.vif = vif; + +rtw89_traffic_stats_accu (rtwdev, &rtwdev->stats, skb, true); +rtw89_traffic_stats_accu (rtwdev, &rtwvif->stats, skb, true); +rtw89_core_tx_update_desc_info (rtwdev, &tx_req); + ret =rtw89_hci_tx_write (rtwdev, &tx_req); +if (ret) { +rtw89_err (rtwdev,"failed to transmit skb to HCI\n" ); +return ret; + } + +if (qsel) + *qsel = tx_req.desc_info.qsel; + +return 0 ; +} + +void rtw89_core_fill_txdesc (struct rtw89_dev *rtwdev, +struct rtw89_tx_desc_info *desc_info, +void *txdesc) +{ +RTW89_SET_TXWD_BODY_WP_OFFSET (txdesc, desc_info->wp_offset); +RTW89_SET_TXWD_BODY_WD_INFO_EN (txdesc, desc_info->en_wd_info); +RTW89_SET_TXWD_BODY_CHANNEL_DMA (txdesc, desc_info->ch_dma); +RTW89_SET_TXWD_BODY_HDR_LLC_LEN (txdesc, desc_info->hdr_llc_len); +RTW89_SET_TXWD_BODY_WD_PAGE (txdesc, desc_info->wd_page); +RTW89_SET_TXWD_BODY_FW_DL (txdesc, desc_info->fw_dl); +RTW89_SET_TXWD_BODY_SW_SEQ (txdesc, desc_info->seq); + +RTW89_SET_TXWD_BODY_TID_INDICATE (txdesc, desc_info->tid_indicate); +RTW89_SET_TXWD_BODY_QSEL (txdesc, desc_info->qsel); +RTW89_SET_TXWD_BODY_TXPKT_SIZE (txdesc, desc_info->pkt_size); +RTW89_SET_TXWD_BODY_AGG_EN (txdesc, desc_info->agg_en); +RTW89_SET_TXWD_BODY_BK (txdesc, desc_info->bk); + +if (!desc_info->en_wd_info) +return ; + +RTW89_SET_TXWD_INFO_USE_RATE (txdesc, desc_info->use_rate); +RTW89_SET_TXWD_INFO_DATA_RATE (txdesc, desc_info->data_rate); +RTW89_SET_TXWD_INFO_DISDATAFB (txdesc, desc_info->dis_data_fb); +RTW89_SET_TXWD_INFO_MAX_AGGNUM (txdesc, desc_info->ampdu_num); +RTW89_SET_TXWD_INFO_AMPDU_DENSITY (txdesc, desc_info->ampdu_density); +RTW89_SET_TXWD_INFO_SEC_TYPE (txdesc, desc_info->sec_type); +RTW89_SET_TXWD_INFO_SEC_HW_ENC (txdesc, desc_info->sec_en); +RTW89_SET_TXWD_INFO_SEC_CAM_IDX (txdesc, desc_info->sec_cam_idx); +RTW89_SET_TXWD_INFO_RTS_EN (txdesc,1 ); +RTW89_SET_TXWD_INFO_HW_RTS_EN (txdesc,1 ); +RTW89_SET_TXWD_INFO_A_CTRL_BSR (txdesc, desc_info->a_ctrl_bsr); +} +EXPORT_SYMBOL (rtw89_core_fill_txdesc); + +static int rtw89_core_rx_process_mac_ppdu (struct rtw89_dev *rtwdev, +struct sk_buff *skb, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +bool rx_cnt_valid = false; +u8 plcp_size =0 ; +u8 usr_num =0 ; +u8 *phy_sts; + + rx_cnt_valid =RTW89_GET_RXINFO_RX_CNT_VLD (skb->data); + plcp_size =RTW89_GET_RXINFO_PLCP_LEN (skb->data) <<3 ; + usr_num =RTW89_GET_RXINFO_USR_NUM (skb->data); +if (usr_num >RTW89_PPDU_MAX_USR ) { +rtw89_warn (rtwdev,"Invalid user number in mac info\n" ); +return -EINVAL ; + } + + phy_sts = skb->data +RTW89_PPDU_MAC_INFO_SIZE ; + phy_sts += usr_num *RTW89_PPDU_MAC_INFO_USR_SIZE ; +/* 8-byte alignment */ +if (usr_num &BIT (0 )) + phy_sts +=RTW89_PPDU_MAC_INFO_USR_SIZE ; +if (rx_cnt_valid) + phy_sts +=RTW89_PPDU_MAC_RX_CNT_SIZE ; + phy_sts += plcp_size; + + phy_ppdu->buf = phy_sts; + phy_ppdu->len = skb->data + skb->len - phy_sts; + +return 0 ; +} + +static void rtw89_core_rx_process_phy_ppdu_iter (void *data, +struct ieee80211_sta *sta) +{ +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rtw89_rx_phy_ppdu *phy_ppdu = (struct rtw89_rx_phy_ppdu *)data; + +if (rtwsta->mac_id == phy_ppdu->mac_id && phy_ppdu->to_self) +ewma_rssi_add (&rtwsta->avg_rssi, phy_ppdu->rssi_avg); +} + +#define VAR_LEN 0xff +#define VAR_LEN_UNIT 8 +static u16 rtw89_core_get_phy_status_ie_len (struct rtw89_dev *rtwdev,u8 *addr) +{ +static const u8 physts_ie_len_tab[32 ] = { +16 ,32 ,24 ,24 ,8 ,8 ,8 ,8 ,VAR_LEN ,8 ,VAR_LEN ,176 ,VAR_LEN , +VAR_LEN ,VAR_LEN ,VAR_LEN ,VAR_LEN ,VAR_LEN ,16 ,24 ,VAR_LEN , +VAR_LEN ,VAR_LEN ,0 ,24 ,24 ,24 ,24 ,32 ,32 ,32 ,32 + }; +u16 ie_len; +u8 ie; + + ie =RTW89_GET_PHY_STS_IE_TYPE (addr); +if (physts_ie_len_tab[ie] !=VAR_LEN ) + ie_len = physts_ie_len_tab[ie]; +else + ie_len =RTW89_GET_PHY_STS_IE_LEN (addr) *VAR_LEN_UNIT ; + +return ie_len; +} + +static void rtw89_core_parse_phy_status_ie01 (struct rtw89_dev *rtwdev,u8 *addr, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +s16 cfo; + +/* sign conversion for S(12,2) */ + cfo =sign_extend32 (RTW89_GET_PHY_STS_IE0_CFO (addr),11 ); +rtw89_phy_cfo_parse (rtwdev, cfo, phy_ppdu); +} + +static int rtw89_core_process_phy_status_ie (struct rtw89_dev *rtwdev,u8 *addr, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +u8 ie; + + ie =RTW89_GET_PHY_STS_IE_TYPE (addr); +switch (ie) { +case RTW89_PHYSTS_IE01_CMN_OFDM : +rtw89_core_parse_phy_status_ie01 (rtwdev, addr, phy_ppdu); +break ; +default : +break ; + } + +return 0 ; +} + +static void rtw89_core_update_phy_ppdu (struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +s8 *rssi = phy_ppdu->rssi; +u8 *buf = phy_ppdu->buf; + + phy_ppdu->rssi_avg =RTW89_GET_PHY_STS_RSSI_AVG (buf); + rssi[RF_PATH_A ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_A (buf)); + rssi[RF_PATH_B ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_B (buf)); + rssi[RF_PATH_C ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_C (buf)); + rssi[RF_PATH_D ] =RTW89_RSSI_RAW_TO_DBM (RTW89_GET_PHY_STS_RSSI_D (buf)); +} + +static int rtw89_core_rx_process_phy_ppdu (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +if (RTW89_GET_PHY_STS_LEN (phy_ppdu->buf) <<3 != phy_ppdu->len) { +rtw89_warn (rtwdev,"phy ppdu len mismatch\n" ); +return -EINVAL ; + } +rtw89_core_update_phy_ppdu (phy_ppdu); +ieee80211_iterate_stations_atomic (rtwdev->hw, + rtw89_core_rx_process_phy_ppdu_iter, + phy_ppdu); + +return 0 ; +} + +static int rtw89_core_rx_parse_phy_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +u16 ie_len; +u8 *pos, *end; + +if (!phy_ppdu->to_self) +return 0 ; + + pos = (u8 *)phy_ppdu->buf +PHY_STS_HDR_LEN ; + end = (u8 *)phy_ppdu->buf + phy_ppdu->len; +while (pos < end) { + ie_len =rtw89_core_get_phy_status_ie_len (rtwdev, pos); +rtw89_core_process_phy_status_ie (rtwdev, pos, phy_ppdu); + pos += ie_len; +if (pos > end || ie_len ==0 ) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"phy status parse failed\n" ); +return -EINVAL ; + } + } + +return 0 ; +} + +static void rtw89_core_rx_process_phy_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu) +{ +int ret; + + ret =rtw89_core_rx_parse_phy_sts (rtwdev, phy_ppdu); +if (ret) +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"parse phy sts failed\n" ); +else + phy_ppdu->valid = true; +} + +static u8 rtw89_rxdesc_to_nl_he_gi (struct rtw89_dev *rtwdev, +const struct rtw89_rx_desc_info *desc_info, +bool rx_status) +{ +switch (desc_info->gi_ltf) { +case RTW89_GILTF_SGI_4XHE08 : +case RTW89_GILTF_2XHE08 : +case RTW89_GILTF_1XHE08 : +return NL80211_RATE_INFO_HE_GI_0_8 ; +case RTW89_GILTF_2XHE16 : +case RTW89_GILTF_1XHE16 : +return NL80211_RATE_INFO_HE_GI_1_6 ; +case RTW89_GILTF_LGI_4XHE32 : +return NL80211_RATE_INFO_HE_GI_3_2 ; +default : +rtw89_warn (rtwdev,"invalid gi_ltf=%d" , desc_info->gi_ltf); +return rx_status ?NL80211_RATE_INFO_HE_GI_3_2 :U8_MAX ; + } +} + +static bool rtw89_core_rx_ppdu_match (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *status) +{ +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +u8 data_rate_mode, bw, rate_idx =MASKBYTE0 , gi_ltf; +u16 data_rate; +bool ret; + + data_rate = desc_info->data_rate; + data_rate_mode =GET_DATA_RATE_MODE (data_rate); +if (data_rate_mode ==DATA_RATE_MODE_NON_HT ) { + rate_idx =GET_DATA_RATE_NOT_HT_IDX (data_rate); +/* No 4 CCK rates for 5G */ +if (status->band ==NL80211_BAND_5GHZ ) + rate_idx -=4 ; + }else if (data_rate_mode ==DATA_RATE_MODE_HT ) { + rate_idx =GET_DATA_RATE_HT_IDX (data_rate); + }else if (data_rate_mode ==DATA_RATE_MODE_VHT ) { + rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + }else if (data_rate_mode ==DATA_RATE_MODE_HE ) { + rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + }else { +rtw89_warn (rtwdev,"invalid RX rate mode %d\n" , data_rate_mode); + } + +if (desc_info->bw ==RTW89_CHANNEL_WIDTH_80 ) + bw =RATE_INFO_BW_80 ; +else if (desc_info->bw ==RTW89_CHANNEL_WIDTH_40 ) + bw =RATE_INFO_BW_40 ; +else + bw =RATE_INFO_BW_20 ; + + gi_ltf =rtw89_rxdesc_to_nl_he_gi (rtwdev, desc_info, false); + ret = rtwdev->ppdu_sts.curr_rx_ppdu_cnt[band] == desc_info->ppdu_cnt && + status->rate_idx == rate_idx && + status->he_gi == gi_ltf && + status->bw == bw; + +return ret; +} + +struct rtw89_vif_rx_stats_iter_data { +struct rtw89_dev *rtwdev; +struct rtw89_rx_phy_ppdu *phy_ppdu; +struct rtw89_rx_desc_info *desc_info; +struct sk_buff *skb; +const u8 *bssid; +}; + +static void rtw89_vif_rx_stats_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_vif_rx_stats_iter_data *iter_data = data; +struct rtw89_dev *rtwdev = iter_data->rtwdev; +struct rtw89_pkt_stat *pkt_stat = &rtwdev->phystat.cur_pkt_stat; +struct rtw89_rx_desc_info *desc_info = iter_data->desc_info; +struct sk_buff *skb = iter_data->skb; +struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; +const u8 *bssid = iter_data->bssid; + +if (!ether_addr_equal (vif->bss_conf.bssid, bssid)) +return ; + +if (ieee80211_is_beacon (hdr->frame_control)) + pkt_stat->beacon_nr++; + +if (!ether_addr_equal (vif->addr, hdr->addr1)) +return ; + +if (desc_info->data_rate <RTW89_HW_RATE_NR ) + pkt_stat->rx_rate_cnt[desc_info->data_rate]++; + +rtw89_traffic_stats_accu (rtwdev, &rtwvif->stats, skb, false); +} + +static void rtw89_core_rx_stats (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct rtw89_vif_rx_stats_iter_data iter_data; + +rtw89_traffic_stats_accu (rtwdev, &rtwdev->stats, skb, false); + + iter_data.rtwdev = rtwdev; + iter_data.phy_ppdu = phy_ppdu; + iter_data.desc_info = desc_info; + iter_data.skb = skb; + iter_data.bssid =get_hdr_bssid ((struct ieee80211_hdr *)skb->data); +rtw89_iterate_vifs_bh (rtwdev, rtw89_vif_rx_stats_iter, &iter_data); +} + +static void rtw89_core_rx_pending_skb (struct rtw89_dev *rtwdev, +struct rtw89_rx_phy_ppdu *phy_ppdu, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +int curr = rtwdev->ppdu_sts.curr_rx_ppdu_cnt[band]; +struct sk_buff *skb_ppdu =NULL , *tmp; +struct ieee80211_rx_status *rx_status; + +if (curr >RTW89_MAX_PPDU_CNT ) +return ; + + skb_queue_walk_safe(&rtwdev->ppdu_sts.rx_queue[band], skb_ppdu, tmp) { +skb_unlink (skb_ppdu, &rtwdev->ppdu_sts.rx_queue[band]); + rx_status =IEEE80211_SKB_RXCB (skb_ppdu); +if (rtw89_core_rx_ppdu_match (rtwdev, desc_info, rx_status)) +rtw89_chip_query_ppdu (rtwdev, phy_ppdu, rx_status); +rtw89_core_rx_stats (rtwdev, phy_ppdu, desc_info, skb_ppdu); +ieee80211_rx_napi (rtwdev->hw,NULL , skb_ppdu, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} + +static void rtw89_core_rx_process_ppdu_sts (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct rtw89_rx_phy_ppdu phy_ppdu = {.buf = skb->data, .valid = false, + .len = skb->len, + .to_self = desc_info->addr1_match, + .mac_id = desc_info->mac_id}; +int ret; + +if (desc_info->mac_info_valid) +rtw89_core_rx_process_mac_ppdu (rtwdev, skb, &phy_ppdu); + ret =rtw89_core_rx_process_phy_ppdu (rtwdev, &phy_ppdu); +if (ret) +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"process ppdu failed\n" ); + +rtw89_core_rx_process_phy_sts (rtwdev, &phy_ppdu); +rtw89_core_rx_pending_skb (rtwdev, &phy_ppdu, desc_info, skb); +dev_kfree_skb_any (skb); +} + +static void rtw89_core_rx_process_report (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +switch (desc_info->pkt_type) { +case RTW89_CORE_RX_TYPE_C2H : +rtw89_fw_c2h_irqsafe (rtwdev, skb); +break ; +case RTW89_CORE_RX_TYPE_PPDU_STAT : +rtw89_core_rx_process_ppdu_sts (rtwdev, desc_info, skb); +break ; +default : +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"unhandled pkt_type=%d\n" , + desc_info->pkt_type); +dev_kfree_skb_any (skb); +break ; + } +} + +void rtw89_core_query_rxdesc (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +u8 *data,u32 data_offset) +{ +struct rtw89_rxdesc_short *rxd_s; +struct rtw89_rxdesc_long *rxd_l; +u8 shift_len, drv_info_len; + + rxd_s = (struct rtw89_rxdesc_short *)(data + data_offset); + desc_info->pkt_size =RTW89_GET_RXWD_PKT_SIZE (rxd_s); + desc_info->drv_info_size =RTW89_GET_RXWD_DRV_INFO_SIZE (rxd_s); + desc_info->long_rxdesc =RTW89_GET_RXWD_LONG_RXD (rxd_s); + desc_info->pkt_type =RTW89_GET_RXWD_RPKT_TYPE (rxd_s); + desc_info->mac_info_valid =RTW89_GET_RXWD_MAC_INFO_VALID (rxd_s); + desc_info->bw =RTW89_GET_RXWD_BW (rxd_s); + desc_info->data_rate =RTW89_GET_RXWD_DATA_RATE (rxd_s); + desc_info->gi_ltf =RTW89_GET_RXWD_GI_LTF (rxd_s); + desc_info->user_id =RTW89_GET_RXWD_USER_ID (rxd_s); + desc_info->sr_en =RTW89_GET_RXWD_SR_EN (rxd_s); + desc_info->ppdu_cnt =RTW89_GET_RXWD_PPDU_CNT (rxd_s); + desc_info->ppdu_type =RTW89_GET_RXWD_PPDU_TYPE (rxd_s); + desc_info->free_run_cnt =RTW89_GET_RXWD_FREE_RUN_CNT (rxd_s); + desc_info->icv_err =RTW89_GET_RXWD_ICV_ERR (rxd_s); + desc_info->crc32_err =RTW89_GET_RXWD_CRC32_ERR (rxd_s); + desc_info->hw_dec =RTW89_GET_RXWD_HW_DEC (rxd_s); + desc_info->sw_dec =RTW89_GET_RXWD_SW_DEC (rxd_s); + desc_info->addr1_match =RTW89_GET_RXWD_A1_MATCH (rxd_s); + + shift_len = desc_info->shift <<1 ;/* 2-byte unit */ + drv_info_len = desc_info->drv_info_size <<3 ;/* 8-byte unit */ + desc_info->offset = data_offset + shift_len + drv_info_len; + desc_info->ready = true; + +if (!desc_info->long_rxdesc) +return ; + + rxd_l = (struct rtw89_rxdesc_long *)(data + data_offset); + desc_info->frame_type =RTW89_GET_RXWD_TYPE (rxd_l); + desc_info->addr_cam_valid =RTW89_GET_RXWD_ADDR_CAM_VLD (rxd_l); + desc_info->addr_cam_id =RTW89_GET_RXWD_ADDR_CAM_ID (rxd_l); + desc_info->sec_cam_id =RTW89_GET_RXWD_SEC_CAM_ID (rxd_l); + desc_info->mac_id =RTW89_GET_RXWD_MAC_ID (rxd_l); + desc_info->rx_pl_id =RTW89_GET_RXWD_RX_PL_ID (rxd_l); +} +EXPORT_SYMBOL (rtw89_core_query_rxdesc); + +struct rtw89_core_iter_rx_status { +struct rtw89_dev *rtwdev; +struct ieee80211_rx_status *rx_status; +struct rtw89_rx_desc_info *desc_info; +u8 mac_id; +}; + +static +void rtw89_core_stats_sta_rx_status_iter (void *data,struct ieee80211_sta *sta) +{ +struct rtw89_core_iter_rx_status *iter_data = + (struct rtw89_core_iter_rx_status *)data; +struct ieee80211_rx_status *rx_status = iter_data->rx_status; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rtw89_rx_desc_info *desc_info = iter_data->desc_info; +u8 mac_id = iter_data->mac_id; + +if (mac_id != rtwsta->mac_id) +return ; + + rtwsta->rx_status = *rx_status; + rtwsta->rx_hw_rate = desc_info->data_rate; +} + +static void rtw89_core_stats_sta_rx_status (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *rx_status) +{ +struct rtw89_core_iter_rx_status iter_data; + +if (!desc_info->addr1_match || !desc_info->long_rxdesc) +return ; + +if (desc_info->frame_type !=RTW89_RX_TYPE_DATA ) +return ; + + iter_data.rtwdev = rtwdev; + iter_data.rx_status = rx_status; + iter_data.desc_info = desc_info; + iter_data.mac_id = desc_info->mac_id; +ieee80211_iterate_stations_atomic (rtwdev->hw, + rtw89_core_stats_sta_rx_status_iter, + &iter_data); +} + +static void rtw89_core_update_rx_status (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct ieee80211_rx_status *rx_status) +{ +struct ieee80211_hw *hw = rtwdev->hw; +u16 data_rate; +u8 data_rate_mode; + +/* currently using single PHY */ + rx_status->freq = hw->conf.chandef.chan->center_freq; + rx_status->band = hw->conf.chandef.chan->band; + +if (desc_info->icv_err || desc_info->crc32_err) + rx_status->flag |=RX_FLAG_FAILED_FCS_CRC ; + +if (desc_info->hw_dec && + !(desc_info->sw_dec || desc_info->icv_err)) + rx_status->flag |=RX_FLAG_DECRYPTED ; + +if (desc_info->bw ==RTW89_CHANNEL_WIDTH_80 ) + rx_status->bw =RATE_INFO_BW_80 ; +else if (desc_info->bw ==RTW89_CHANNEL_WIDTH_40 ) + rx_status->bw =RATE_INFO_BW_40 ; +else + rx_status->bw =RATE_INFO_BW_20 ; + + data_rate = desc_info->data_rate; + data_rate_mode =GET_DATA_RATE_MODE (data_rate); +if (data_rate_mode ==DATA_RATE_MODE_NON_HT ) { + rx_status->encoding =RX_ENC_LEGACY ; + rx_status->rate_idx =GET_DATA_RATE_NOT_HT_IDX (data_rate); +/* No 4 CCK rates for 5G */ +if (rx_status->band ==NL80211_BAND_5GHZ ) + rx_status->rate_idx -=4 ; +if (rtwdev->scanning) + rx_status->rate_idx =min_t (u8, rx_status->rate_idx, +ARRAY_SIZE (rtw89_bitrates) -5 ); + }else if (data_rate_mode ==DATA_RATE_MODE_HT ) { + rx_status->encoding =RX_ENC_HT ; + rx_status->rate_idx =GET_DATA_RATE_HT_IDX (data_rate); +if (desc_info->gi_ltf) + rx_status->enc_flags |=RX_ENC_FLAG_SHORT_GI ; + }else if (data_rate_mode ==DATA_RATE_MODE_VHT ) { + rx_status->encoding =RX_ENC_VHT ; + rx_status->rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + rx_status->nss =GET_DATA_RATE_NSS (data_rate) +1 ; +if (desc_info->gi_ltf) + rx_status->enc_flags |=RX_ENC_FLAG_SHORT_GI ; + }else if (data_rate_mode ==DATA_RATE_MODE_HE ) { + rx_status->encoding =RX_ENC_HE ; + rx_status->rate_idx =GET_DATA_RATE_VHT_HE_IDX (data_rate); + rx_status->nss =GET_DATA_RATE_NSS (data_rate) +1 ; + }else { +rtw89_warn (rtwdev,"invalid RX rate mode %d\n" , data_rate_mode); + } + +/* he_gi is used to match ppdu, so we always fill it. */ + rx_status->he_gi =rtw89_rxdesc_to_nl_he_gi (rtwdev, desc_info, true); + rx_status->flag |=RX_FLAG_MACTIME_START ; + rx_status->mactime = desc_info->free_run_cnt; + +rtw89_core_stats_sta_rx_status (rtwdev, desc_info, rx_status); +}
drivers/net/wireless/realtek/rtw89/core.c line 1178
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/core.c new file +10
-0+ +static enum rtw89_ps_mode rtw89_update_ps_mode (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; + +if (rtw89_disable_ps_mode || !chip->ps_mode_supported) +return RTW89_PS_MODE_NONE ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_PWR_GATED )) +return RTW89_PS_MODE_PWR_GATED ;
Current driver support only one chip with RTW89_PS_MODE_PWR_GATED, RTW89_PS_MODE_CLK_GATED and RTW89_PS_MODE_RFOFF.
According to this code, only RTW89_PS_MODE_PWR_GATED will return. Please remove all other modes to reduce review overhead.
Quoted 429 lines
drivers/net/wireless/realtek/rtw89/core.c new file +429
-0+if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_CLK_GATED )) +return RTW89_PS_MODE_CLK_GATED ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_RFOFF )) +return RTW89_PS_MODE_RFOFF ; + +return RTW89_PS_MODE_NONE ; +} + +static void rtw89_core_flush_ppdu_rx_queue (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info) +{ +struct rtw89_ppdu_sts_info *ppdu_sts = &rtwdev->ppdu_sts; +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; +struct sk_buff *skb_ppdu, *tmp; + + skb_queue_walk_safe(&ppdu_sts->rx_queue[band], skb_ppdu, tmp) { +skb_unlink (skb_ppdu, &ppdu_sts->rx_queue[band]); +rtw89_core_rx_stats (rtwdev,NULL , desc_info, skb_ppdu); +ieee80211_rx_napi (rtwdev->hw,NULL , skb_ppdu, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} + +void rtw89_core_rx (struct rtw89_dev *rtwdev, +struct rtw89_rx_desc_info *desc_info, +struct sk_buff *skb) +{ +struct ieee80211_rx_status *rx_status; +struct rtw89_ppdu_sts_info *ppdu_sts = &rtwdev->ppdu_sts; +u8 ppdu_cnt = desc_info->ppdu_cnt; +u8 band = desc_info->bb_sel ?RTW89_PHY_1 :RTW89_PHY_0 ; + +if (desc_info->pkt_type !=RTW89_CORE_RX_TYPE_WIFI ) { +rtw89_core_rx_process_report (rtwdev, desc_info, skb); +return ; + } + +if (ppdu_sts->curr_rx_ppdu_cnt[band] != ppdu_cnt) { +rtw89_core_flush_ppdu_rx_queue (rtwdev, desc_info); + ppdu_sts->curr_rx_ppdu_cnt[band] = ppdu_cnt; + } + + rx_status =IEEE80211_SKB_RXCB (skb); +memset (rx_status,0 ,sizeof (*rx_status)); +rtw89_core_update_rx_status (rtwdev, desc_info, rx_status); +if (desc_info->long_rxdesc && +BIT (desc_info->frame_type) &PPDU_FILTER_BITMAP ) { +skb_queue_tail (&ppdu_sts->rx_queue[band], skb); + }else { +rtw89_core_rx_stats (rtwdev,NULL , desc_info, skb); +ieee80211_rx_napi (rtwdev->hw,NULL , skb, &rtwdev->napi); + rtwdev->napi_budget_countdown--; + } +} +EXPORT_SYMBOL (rtw89_core_rx); + +void rtw89_core_napi_start (struct rtw89_dev *rtwdev) +{ +if (test_and_set_bit (RTW89_FLAG_NAPI_RUNNING , rtwdev->flags)) +return ; + +napi_enable (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_start); + +void rtw89_core_napi_stop (struct rtw89_dev *rtwdev) +{ +if (!test_and_clear_bit (RTW89_FLAG_NAPI_RUNNING , rtwdev->flags)) +return ; + +napi_synchronize (&rtwdev->napi); +napi_disable (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_stop); + +void rtw89_core_napi_init (struct rtw89_dev *rtwdev) +{ +init_dummy_netdev (&rtwdev->netdev); +netif_napi_add (&rtwdev->netdev, &rtwdev->napi, + rtwdev->hci.ops->napi_poll,NAPI_POLL_WEIGHT ); +} +EXPORT_SYMBOL (rtw89_core_napi_init); + +void rtw89_core_napi_deinit (struct rtw89_dev *rtwdev) +{ +rtw89_core_napi_stop (rtwdev); +netif_napi_del (&rtwdev->napi); +} +EXPORT_SYMBOL (rtw89_core_napi_deinit); + +static void rtw89_core_ba_work (struct work_struct *work) +{ +struct rtw89_dev *rtwdev = + container_of(work, struct rtw89_dev, ba_work); +struct rtw89_txq *rtwtxq, *tmp; +int ret; + +spin_lock_bh (&rtwdev->ba_lock); +list_for_each_entry_safe (rtwtxq, tmp, &rtwdev->ba_list, list) { +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +u8 tid = txq->tid; + +if (!sta) { +rtw89_warn (rtwdev,"cannot start BA without sta\n" ); + goto skip_ba_work; + } + +if (rtwsta->disassoc) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"cannot start BA with disassoc sta\n" ); + goto skip_ba_work; + } + + ret =ieee80211_start_tx_ba_session (sta, tid,0 ); +if (ret) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX , +"failed to setup BA session for %pM:%2d: %d\n" , + sta->addr, tid, ret); +if (ret == -EINVAL ) +set_bit (RTW89_TXQ_F_BLOCK_BA , &rtwtxq->flags); + } +skip_ba_work: +list_del_init (&rtwtxq->list); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_free_sta_pending_ba (struct rtw89_dev *rtwdev, +struct ieee80211_sta *sta) +{ +struct rtw89_txq *rtwtxq, *tmp; + +spin_lock_bh (&rtwdev->ba_lock); +list_for_each_entry_safe (rtwtxq, tmp, &rtwdev->ba_list, list) { +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); + +if (sta == txq->sta) +list_del_init (&rtwtxq->list); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_txq_check_agg (struct rtw89_dev *rtwdev, +struct rtw89_txq *rtwtxq, +struct sk_buff *skb) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (unlikely (skb_get_queue_mapping (skb) ==IEEE80211_AC_VO )) +return ; + +if (unlikely (skb->protocol ==cpu_to_be16 (ETH_P_PAE ))) +return ; + +if (unlikely (!sta)) +return ; + +if (unlikely (test_bit (RTW89_TXQ_F_BLOCK_BA , &rtwtxq->flags))) +return ; + +if (test_bit (RTW89_TXQ_F_AMPDU , &rtwtxq->flags)) { +IEEE80211_SKB_CB (skb)->flags |=IEEE80211_TX_CTL_AMPDU ; +return ; + } + +spin_lock_bh (&rtwdev->ba_lock); +if (!rtwsta->disassoc &&list_empty (&rtwtxq->list)) { +list_add_tail (&rtwtxq->list, &rtwdev->ba_list); +ieee80211_queue_work (hw, &rtwdev->ba_work); + } +spin_unlock_bh (&rtwdev->ba_lock); +} + +static void rtw89_core_txq_push (struct rtw89_dev *rtwdev, +struct rtw89_txq *rtwtxq, +unsigned long frame_cnt, +unsigned long byte_cnt) +{ +struct ieee80211_txq *txq =rtw89_txq_to_txq (rtwtxq); +struct ieee80211_vif *vif = txq->vif; +struct ieee80211_sta *sta = txq->sta; +struct sk_buff *skb; +unsigned long i; +int ret; + +for (i =0 ; i < frame_cnt; i++) { + skb =ieee80211_tx_dequeue_ni (rtwdev->hw, txq); +if (!skb) { +rtw89_debug (rtwdev,RTW89_DBG_TXRX ,"dequeue a NULL skb\n" ); +return ; + } +rtw89_core_txq_check_agg (rtwdev, rtwtxq, skb); + ret =rtw89_core_tx_write (rtwdev, vif, sta, skb,NULL ); +if (ret) { +rtw89_err (rtwdev,"failed to push txq: %d\n" , ret); +ieee80211_free_txskb (rtwdev->hw, skb); +break ; + } + } +} + +static u32 rtw89_check_and_reclaim_tx_resource (struct rtw89_dev *rtwdev,u8 tid) +{ +u8 qsel, ch_dma; + + qsel =rtw89_core_get_qsel (rtwdev, tid); + ch_dma =rtw89_core_get_ch_dma (rtwdev, qsel); + +return rtw89_hci_check_and_reclaim_tx_resource (rtwdev, ch_dma); +} + +static bool rtw89_core_txq_agg_wait (struct rtw89_dev *rtwdev, +struct ieee80211_txq *txq, +unsigned long *frame_cnt, +bool *sched_txq,bool *reinvoke) +{ +struct rtw89_txq *rtwtxq = (struct rtw89_txq *)txq->drv_priv; +struct ieee80211_sta *sta = txq->sta; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (!sta || rtwsta->max_agg_wait <=0 ) +return false; + +if (rtwdev->stats.tx_tfc_lv <=RTW89_TFC_MID ) +return false; + +if (*frame_cnt >1 ) { + *frame_cnt -=1 ; + *sched_txq = true; + *reinvoke = true; + rtwtxq->wait_cnt =1 ; +return false; + } + +if (*frame_cnt ==1 && rtwtxq->wait_cnt < rtwsta->max_agg_wait) { + *reinvoke = true; + rtwtxq->wait_cnt++; +return true; + } + + rtwtxq->wait_cnt =0 ; +return false; +} + +static void rtw89_core_txq_schedule (struct rtw89_dev *rtwdev,u8 ac,bool *reinvoke) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_txq *txq; +struct rtw89_txq *rtwtxq; +unsigned long frame_cnt; +unsigned long byte_cnt; +u32 tx_resource; +bool sched_txq; + +ieee80211_txq_schedule_start (hw, ac); +while ((txq =ieee80211_next_txq (hw, ac))) { + rtwtxq = (struct rtw89_txq *)txq->drv_priv; + tx_resource =rtw89_check_and_reclaim_tx_resource (rtwdev, txq->tid); + sched_txq = false; + +ieee80211_txq_get_depth (txq, &frame_cnt, &byte_cnt); +if (rtw89_core_txq_agg_wait (rtwdev, txq, &frame_cnt, &sched_txq, reinvoke)) { +ieee80211_return_txq (hw, txq, true); +continue ; + } + frame_cnt = min_t(unsigned long, frame_cnt, tx_resource); +rtw89_core_txq_push (rtwdev, rtwtxq, frame_cnt, byte_cnt); +ieee80211_return_txq (hw, txq, sched_txq); +if (frame_cnt !=0 ) +rtw89_core_tx_kick_off (rtwdev,rtw89_core_get_qsel (rtwdev, txq->tid)); + } +ieee80211_txq_schedule_end (hw, ac); +} + +static void rtw89_core_txq_work (struct work_struct *w) +{ + struct rtw89_dev *rtwdev = container_of(w, struct rtw89_dev, txq_work); +bool reinvoke = false; +u8 ac; + +for (ac =0 ; ac <IEEE80211_NUM_ACS ; ac++) +rtw89_core_txq_schedule (rtwdev, ac, &reinvoke); + +if (reinvoke) { +/* reinvoke to process the last frame */ +mod_delayed_work (rtwdev->txq_wq, &rtwdev->txq_reinvoke_work,1 ); + } +} + +static void rtw89_core_txq_reinvoke_work (struct work_struct *w) +{ + struct rtw89_dev *rtwdev = container_of(w, struct rtw89_dev, + txq_reinvoke_work.work); + +queue_work (rtwdev->txq_wq, &rtwdev->txq_work); +} + +static enum rtw89_tfc_lv rtw89_get_traffic_level (struct rtw89_dev *rtwdev, +u32 throughput,u64 cnt) +{ +if (cnt <100 ) +return RTW89_TFC_IDLE ; +if (throughput >50 ) +return RTW89_TFC_HIGH ; +if (throughput >10 ) +return RTW89_TFC_MID ; +if (throughput >2 ) +return RTW89_TFC_LOW ; +return RTW89_TFC_ULTRA_LOW ; +} + +static void rtw89_traffic_stats_calc (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{ +enum rtw89_tfc_lv tx_tfc_lv = stats->tx_tfc_lv; +enum rtw89_tfc_lv rx_tfc_lv = stats->rx_tfc_lv; + + stats->tx_throughput_raw = (u32)(stats->tx_unicast >>RTW89_TP_SHIFT ); + stats->rx_throughput_raw = (u32)(stats->rx_unicast >>RTW89_TP_SHIFT ); + +ewma_tp_add (&stats->tx_ewma_tp, stats->tx_throughput_raw); +ewma_tp_add (&stats->rx_ewma_tp, stats->rx_throughput_raw); + + stats->tx_throughput =ewma_tp_read (&stats->tx_ewma_tp); + stats->rx_throughput =ewma_tp_read (&stats->rx_ewma_tp); + stats->tx_tfc_lv =rtw89_get_traffic_level (rtwdev, stats->tx_throughput, + stats->tx_cnt); + stats->rx_tfc_lv =rtw89_get_traffic_level (rtwdev, stats->rx_throughput, + stats->rx_cnt); + stats->tx_avg_len = (u32)(stats->tx_cnt ? stats->tx_unicast / stats->tx_cnt :0 ); + stats->rx_avg_len = (u32)(stats->rx_cnt ? stats->rx_unicast / stats->rx_cnt :0 ); + + stats->tx_unicast =0 ; + stats->rx_unicast =0 ; + stats->tx_cnt =0 ; + stats->rx_cnt =0 ; + +if (tx_tfc_lv != stats->tx_tfc_lv || rx_tfc_lv != stats->rx_tfc_lv) +ieee80211_queue_work (rtwdev->hw, &rtwdev->btc.wl_sta_notify_work); +} + +static void rtw89_vif_traffic_stats_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_dev *rtwdev = data; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +rtw89_traffic_stats_calc (rtwdev, &rtwvif->stats); +} + +static void rtw89_traffic_stats_track (struct rtw89_dev *rtwdev) +{ +rtw89_traffic_stats_calc (rtwdev, &rtwdev->stats); + +rtw89_iterate_vifs (rtwdev, rtw89_vif_traffic_stats_iter, rtwdev, false); +} + +static void rtw89_vif_enter_lps_iter (void *data,u8 *mac, +struct ieee80211_vif *vif) +{ +struct rtw89_dev *rtwdev = data; +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +if (rtwvif->wifi_role !=RTW89_WIFI_ROLE_STATION ) +return ; + +if (rtwvif->stats.tx_tfc_lv ==RTW89_TFC_IDLE && + rtwvif->stats.rx_tfc_lv ==RTW89_TFC_IDLE ) +rtw89_enter_lps (rtwdev, rtwvif->mac_id); +} + +static void rtw89_enter_lps_track (struct rtw89_dev *rtwdev) +{ +rtw89_iterate_vifs (rtwdev, rtw89_vif_enter_lps_iter, rtwdev, false); +} + +void rtw89_traffic_stats_init (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{ + stats->tx_unicast =0 ; + stats->rx_unicast =0 ; + stats->tx_cnt =0 ; + stats->rx_cnt =0 ; +ewma_tp_init (&stats->tx_ewma_tp); +ewma_tp_init (&stats->rx_ewma_tp); +} + +static void rtw89_track_work (struct work_struct *work) +{ + struct rtw89_dev *rtwdev = container_of(work, struct rtw89_dev, + track_work.work); + +mutex_lock (&rtwdev->mutex); + +if (!test_bit (RTW89_FLAG_RUNNING , rtwdev->flags)) + goto out; + +ieee80211_queue_delayed_work (rtwdev->hw, &rtwdev->track_work, +RTW89_TRACK_WORK_PERIOD ); + +rtw89_leave_lps (rtwdev, false); + +rtw89_traffic_stats_track (rtwdev); +rtw89_mac_bf_monitor_track (rtwdev); +rtw89_phy_stat_track (rtwdev); +rtw89_phy_env_monitor_track (rtwdev); +rtw89_phy_dig (rtwdev); +rtw89_chip_rfk_track (rtwdev); +rtw89_phy_ra_update (rtwdev); +rtw89_phy_cfo_track (rtwdev); + +if (rtwdev->lps_enabled && !rtwdev->btc.lps && !rtwdev->scanning) +rtw89_enter_lps_track (rtwdev); + +out: +mutex_unlock (&rtwdev->mutex); +} + +int rtw89_core_power_on (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_mac_pwr_on (rtwdev);
drivers/net/wireless/realtek/rtw89/core.c line 1618
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/core.c new file +10
-0+if (ret) { +rtw89_err (rtwdev,"failed to start power sequence\n" ); + goto err; + } + +return 0 ; + +err: +return ret; +}
rtw89_core_power_on() is not used. please remote it to avoid review overhead.
Quoted 34 lines
drivers/net/wireless/realtek/rtw89/core.c new file +34
-0+u8 rtw89_core_acquire_bit_map (unsigned long *addr,unsigned long size) +{ +unsigned long bit; + + bit =find_first_zero_bit (addr, size); +if (bit < size) +set_bit (bit, addr); + +return bit; +} + +void rtw89_core_release_bit_map (unsigned long *addr,u8 bit) +{ +clear_bit (bit, addr); +} + +void rtw89_core_release_all_bits_map (unsigned long *addr,unsigned int nbits) +{ +bitmap_zero (addr, nbits); +} + +#define RTW89_TYPE_MAPPING (_type) \ + case NL80211_IFTYPE_ ## _type: \ + rtwvif->wifi_role = RTW89_WIFI_ROLE_ ## _type; \ + break +void rtw89_vif_type_mapping (struct ieee80211_vif *vif,bool assoc) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +switch (vif->type) { +RTW89_TYPE_MAPPING (ADHOC ); +RTW89_TYPE_MAPPING (STATION ); +RTW89_TYPE_MAPPING (AP ); +RTW89_TYPE_MAPPING (AP_VLAN );
drivers/net/wireless/realtek/rtw89/core.c line 1663
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/core.c new file +10
-0+RTW89_TYPE_MAPPING (MONITOR ); +RTW89_TYPE_MAPPING (MESH_POINT ); +RTW89_TYPE_MAPPING (P2P_CLIENT ); +RTW89_TYPE_MAPPING (P2P_GO ); +RTW89_TYPE_MAPPING (P2P_DEVICE ); +RTW89_TYPE_MAPPING (NAN ); +default : +WARN_ON (1 ); +break ; + }
This switch statement makes no sense. Only NL80211_IFTYPE_AP, NL80211_IFTYPE_MESH_POINT, NL80211_IFTYPE_ADHOC and NL80211_IFTYPE_STATION are supported. Please remove this mapping open code rtwvif->wifi_role in the following switch
drivers/net/wireless/realtek/rtw89/core.c line 1672
Quoted 8 lines
drivers/net/wireless/realtek/rtw89/core.c new file +8
-0+switch (vif->type) { +case NL80211_IFTYPE_AP : +case NL80211_IFTYPE_MESH_POINT : + rtwvif->net_type =RTW89_NET_TYPE_AP_MODE ; + rtwvif->self_role =RTW89_SELF_ROLE_AP ; +break ; +case NL80211_IFTYPE_ADHOC : + rtwvif->net_type =RTW89_NET_TYPE_AD_HOC ;
Please set rtwvif->self_role here, to make it easy to read.
Quoted 4,510 lines
drivers/net/wireless/realtek/rtw89/core.c new file +687
-0+break ; +case NL80211_IFTYPE_STATION : +if (assoc) { + rtwvif->net_type =RTW89_NET_TYPE_INFRA ; + rtwvif->trigger = vif->bss_conf.he_support; + }else { + rtwvif->net_type =RTW89_NET_TYPE_NO_LINK ; + rtwvif->trigger = false; + } + rtwvif->self_role =RTW89_SELF_ROLE_CLIENT ; + rtwvif->addr_cam.sec_ent_mode =RTW89_ADDR_CAM_SEC_NORMAL ; +break ; +default : +WARN_ON (1 ); +break ; + } +} + +int rtw89_core_sta_add (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +int i; + + rtwsta->rtwvif = rtwvif; + rtwsta->prev_rssi =0 ; + +for (i =0 ; i <ARRAY_SIZE (sta->txq); i++) +rtw89_core_txq_init (rtwdev, sta->txq[i]); + +ewma_rssi_init (&rtwsta->avg_rssi); + +if (vif->type ==NL80211_IFTYPE_STATION ) { + rtwvif->mgd.ap = sta; +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_CONN_START ); +rtw89_chip_rfk_channel (rtwdev); + } + +return 0 ; +} + +int rtw89_core_sta_disassoc (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + + rtwdev->total_sta_assoc--; + rtwsta->disassoc = true; + +return 0 ; +} + +int rtw89_core_sta_disconnect (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +int ret; + +rtw89_mac_bf_monitor_calc (rtwdev, sta, true); +rtw89_mac_bf_disassoc (rtwdev, vif, sta); +rtw89_core_free_sta_pending_ba (rtwdev, sta); + +rtw89_vif_type_mapping (vif, false); + + ret =rtw89_fw_h2c_assoc_cmac_tbl (rtwdev, vif, sta); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cmac table\n" ); +return ret; + } + + ret =rtw89_fw_h2c_join_info (rtwdev, rtwvif,1 ); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c join info\n" ); +return ret; + } + +/* update cam aid mac_id net_type */ +rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cam\n" ); +return ret; + } + +return ret; +} + +int rtw89_core_sta_assoc (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +int ret; + +rtw89_vif_type_mapping (vif, true); + + ret =rtw89_fw_h2c_assoc_cmac_tbl (rtwdev, vif, sta); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cmac table\n" ); +return ret; + } + +/* for station mode, assign the mac_id from itself */ +if (vif->type ==NL80211_IFTYPE_STATION ) + rtwsta->mac_id = rtwvif->mac_id; + + ret =rtw89_fw_h2c_join_info (rtwdev, rtwvif,0 ); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c join info\n" ); +return ret; + } + +/* update cam aid mac_id net_type */ +rtw89_fw_h2c_cam (rtwdev, rtwvif); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c cam\n" ); +return ret; + } + + ret =rtw89_fw_h2c_general_pkt (rtwdev, rtwsta->mac_id); +if (ret) { +rtw89_warn (rtwdev,"failed to send h2c general packet\n" ); +return ret; + } + + rtwdev->total_sta_assoc++; +rtw89_phy_ra_assoc (rtwdev, sta); +rtw89_mac_bf_assoc (rtwdev, vif, sta); +rtw89_mac_bf_monitor_calc (rtwdev, sta, false); + +if (vif->type ==NL80211_IFTYPE_STATION ) +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_CONN_END ); + +return ret; +} + +int rtw89_core_sta_remove (struct rtw89_dev *rtwdev, +struct ieee80211_vif *vif, +struct ieee80211_sta *sta) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; + +if (vif->type ==NL80211_IFTYPE_STATION ) +rtw89_btc_ntfy_role_info (rtwdev, rtwvif, rtwsta, +BTC_ROLE_MSTS_STA_DIS_CONN ); + +return 0 ; +} + +static void rtw89_init_ht_cap (struct rtw89_dev *rtwdev, +struct ieee80211_sta_ht_cap *ht_cap) +{ + ht_cap->ht_supported = true; + ht_cap->cap =0 ; + ht_cap->cap |=IEEE80211_HT_CAP_SGI_20 | +IEEE80211_HT_CAP_MAX_AMSDU | +IEEE80211_HT_CAP_TX_STBC | + (1 <<IEEE80211_HT_CAP_RX_STBC_SHIFT ); + + ht_cap->cap |=IEEE80211_HT_CAP_LDPC_CODING ; + + ht_cap->cap |=IEEE80211_HT_CAP_SUP_WIDTH_20_40 | +IEEE80211_HT_CAP_DSSSCCK40 | +IEEE80211_HT_CAP_SGI_40 ; + ht_cap->ampdu_factor =IEEE80211_HT_MAX_AMPDU_64K ; + ht_cap->ampdu_density =IEEE80211_HT_MPDU_DENSITY_NONE ; + ht_cap->mcs.tx_params =IEEE80211_HT_MCS_TX_DEFINED ; + ht_cap->mcs.rx_mask[0 ] =0xFF ; + ht_cap->mcs.rx_mask[1 ] =0xFF ; + ht_cap->mcs.rx_mask[4 ] =0x01 ; + ht_cap->mcs.rx_highest =cpu_to_le16 (300 ); +} + +static void rtw89_init_vht_cap (struct rtw89_dev *rtwdev, +struct ieee80211_sta_vht_cap *vht_cap) +{ +u16 mcs_map; +__le16 highest; +u8 sts_cap =3 ; + + vht_cap->vht_supported = true; + vht_cap->cap =IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 | +IEEE80211_VHT_CAP_SHORT_GI_80 | +IEEE80211_VHT_CAP_RXSTBC_1 | +IEEE80211_VHT_CAP_HTC_VHT | +IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK | +0 ; + vht_cap->cap |=IEEE80211_VHT_CAP_TXSTBC ; + vht_cap->cap |=IEEE80211_VHT_CAP_RXLDPC ; + vht_cap->cap |=IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE | +IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE ; + vht_cap->cap |= sts_cap <<IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT ; + + mcs_map =IEEE80211_VHT_MCS_SUPPORT_0_9 <<0 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<4 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<6 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<8 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<10 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<12 | +IEEE80211_VHT_MCS_NOT_SUPPORTED <<14 ; + highest =cpu_to_le16 (867 ); + mcs_map |=IEEE80211_VHT_MCS_SUPPORT_0_9 <<2 ; + vht_cap->vht_mcs.rx_mcs_map =cpu_to_le16 (mcs_map); + vht_cap->vht_mcs.tx_mcs_map =cpu_to_le16 (mcs_map); + vht_cap->vht_mcs.rx_highest = highest; + vht_cap->vht_mcs.tx_highest = highest; +} + +#define RTW89_SBAND_IFTYPES_NR 2 + +static void rtw89_init_he_cap (struct rtw89_dev *rtwdev, +enum nl80211_band band, +struct ieee80211_supported_band *sband) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; +struct rtw89_hal *hal = &rtwdev->hal; +struct ieee80211_sband_iftype_data *iftype_data; +bool no_ng16 = (chip->chip_id ==RTL8852A && hal->cv ==CHIP_CBV ) || + (chip->chip_id ==RTL8852B && hal->cv ==CHIP_CAV ); +u16 mcs_map =0 ; +int i; +int nss = chip->rx_nss; +int idx =0 ; + + iftype_data =kcalloc (RTW89_SBAND_IFTYPES_NR ,sizeof (*iftype_data),GFP_KERNEL ); +if (!iftype_data) +return ; + +for (i =0 ; i <8 ; i++) { +if (i < nss) + mcs_map |=IEEE80211_HE_MCS_SUPPORT_0_11 << (i *2 ); +else + mcs_map |=IEEE80211_HE_MCS_NOT_SUPPORTED << (i *2 ); + } + +for (i =0 ; i <NUM_NL80211_IFTYPES ; i++) { +struct ieee80211_sta_he_cap *he_cap; +u8 *mac_cap_info; +u8 *phy_cap_info; + +switch (i) { +case NL80211_IFTYPE_STATION : +case NL80211_IFTYPE_AP : +break ; +default : +continue ; + } + +if (idx >=RTW89_SBAND_IFTYPES_NR ) { +rtw89_warn (rtwdev,"run out of iftype_data\n" ); +break ; + } + + iftype_data[idx].types_mask =BIT (i); + he_cap = &iftype_data[idx].he_cap; + mac_cap_info = he_cap->he_cap_elem.mac_cap_info; + phy_cap_info = he_cap->he_cap_elem.phy_cap_info; + + he_cap->has_he = true; +if (i ==NL80211_IFTYPE_AP ) + mac_cap_info[0 ] =IEEE80211_HE_MAC_CAP0_HTC_HE ; +if (i ==NL80211_IFTYPE_STATION ) + mac_cap_info[1 ] =IEEE80211_HE_MAC_CAP1_TF_MAC_PAD_DUR_16US ; + mac_cap_info[2 ] =IEEE80211_HE_MAC_CAP2_ALL_ACK | +IEEE80211_HE_MAC_CAP2_BSR ; + mac_cap_info[3 ] =IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_2 ; +if (i ==NL80211_IFTYPE_AP ) + mac_cap_info[3 ] |=IEEE80211_HE_MAC_CAP3_OMI_CONTROL ; + mac_cap_info[4 ] =IEEE80211_HE_MAC_CAP4_OPS | +IEEE80211_HE_MAC_CAP4_AMSDU_IN_AMPDU ; +if (i ==NL80211_IFTYPE_STATION ) + mac_cap_info[5 ] =IEEE80211_HE_MAC_CAP5_HT_VHT_TRIG_FRAME_RX ; + phy_cap_info[0 ] =IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_IN_2G | +IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G ; + phy_cap_info[1 ] =IEEE80211_HE_PHY_CAP1_DEVICE_CLASS_A | +IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD | +IEEE80211_HE_PHY_CAP1_HE_LTF_AND_GI_FOR_HE_PPDUS_0_8US ; + phy_cap_info[2 ] = IEEE80211_HE_PHY_CAP2_NDP_4x_LTF_AND_3_2US | +IEEE80211_HE_PHY_CAP2_STBC_TX_UNDER_80MHZ | +IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ | +IEEE80211_HE_PHY_CAP2_DOPPLER_TX ; + phy_cap_info[3 ] =IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_16_QAM ; +if (i ==NL80211_IFTYPE_STATION ) + phy_cap_info[3 ] |=IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_16_QAM | +IEEE80211_HE_PHY_CAP3_DCM_MAX_TX_NSS_2 ; +if (i ==NL80211_IFTYPE_AP ) + phy_cap_info[3 ] |=IEEE80211_HE_PHY_CAP3_RX_PARTIAL_BW_SU_IN_20MHZ_MU ; + phy_cap_info[4 ] =IEEE80211_HE_PHY_CAP4_SU_BEAMFORMEE | +IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_UNDER_80MHZ_4 ; + phy_cap_info[5 ] = no_ng16 ?0 : +IEEE80211_HE_PHY_CAP5_NG16_SU_FEEDBACK | +IEEE80211_HE_PHY_CAP5_NG16_MU_FEEDBACK ; + phy_cap_info[6 ] =IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_42_SU | +IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_75_MU | +IEEE80211_HE_PHY_CAP6_TRIG_SU_BEAMFORMING_FB | +IEEE80211_HE_PHY_CAP6_PARTIAL_BW_EXT_RANGE ; + phy_cap_info[7 ] =IEEE80211_HE_PHY_CAP7_POWER_BOOST_FACTOR_SUPP | +IEEE80211_HE_PHY_CAP7_HE_SU_MU_PPDU_4XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP7_MAX_NC_1 ; + phy_cap_info[8 ] =IEEE80211_HE_PHY_CAP8_HE_ER_SU_PPDU_4XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP8_HE_ER_SU_1XLTF_AND_08_US_GI | +IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_996 ; + phy_cap_info[9 ] =IEEE80211_HE_PHY_CAP9_LONGER_THAN_16_SIGB_OFDM_SYM | +IEEE80211_HE_PHY_CAP9_RX_1024_QAM_LESS_THAN_242_TONE_RU | +IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_COMP_SIGB | +IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_NON_COMP_SIGB | +IEEE80211_HE_PHY_CAP9_NOMIMAL_PKT_PADDING_16US ; +if (i ==NL80211_IFTYPE_STATION ) + phy_cap_info[9 ] |=IEEE80211_HE_PHY_CAP9_TX_1024_QAM_LESS_THAN_242_TONE_RU ; + he_cap->he_mcs_nss_supp.rx_mcs_80 =cpu_to_le16 (mcs_map); + he_cap->he_mcs_nss_supp.tx_mcs_80 =cpu_to_le16 (mcs_map); + + idx++; + } + + sband->iftype_data = iftype_data; + sband->n_iftype_data = idx; +} + +static int rtw89_core_set_supported_band (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct ieee80211_supported_band *sband_2ghz =NULL , *sband_5ghz =NULL ; +u32 size =sizeof (struct ieee80211_supported_band ); + + sband_2ghz =kmemdup (&rtw89_sband_2ghz, size,GFP_KERNEL ); +if (!sband_2ghz) + goto err; +rtw89_init_ht_cap (rtwdev, &sband_2ghz->ht_cap); +rtw89_init_he_cap (rtwdev,NL80211_BAND_2GHZ , sband_2ghz); + hw->wiphy->bands[NL80211_BAND_2GHZ ] = sband_2ghz; + + sband_5ghz =kmemdup (&rtw89_sband_5ghz, size,GFP_KERNEL ); +if (!sband_5ghz) + goto err; +rtw89_init_ht_cap (rtwdev, &sband_5ghz->ht_cap); +rtw89_init_vht_cap (rtwdev, &sband_5ghz->vht_cap); +rtw89_init_he_cap (rtwdev,NL80211_BAND_5GHZ , sband_5ghz); + hw->wiphy->bands[NL80211_BAND_5GHZ ] = sband_5ghz; + +return 0 ; + +err: + hw->wiphy->bands[NL80211_BAND_2GHZ ] =NULL ; + hw->wiphy->bands[NL80211_BAND_5GHZ ] =NULL ; +if (sband_2ghz) +kfree (sband_2ghz->iftype_data); +if (sband_5ghz) +kfree (sband_5ghz->iftype_data); +kfree (sband_2ghz); +kfree (sband_5ghz); +return -ENOMEM ; +} + +static void rtw89_core_clr_supported_band (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; + +kfree (hw->wiphy->bands[NL80211_BAND_2GHZ ]->iftype_data); +kfree (hw->wiphy->bands[NL80211_BAND_5GHZ ]->iftype_data); +kfree (hw->wiphy->bands[NL80211_BAND_2GHZ ]); +kfree (hw->wiphy->bands[NL80211_BAND_5GHZ ]); + hw->wiphy->bands[NL80211_BAND_2GHZ ] =NULL ; + hw->wiphy->bands[NL80211_BAND_5GHZ ] =NULL ; +} + +static void rtw89_core_ppdu_sts_init (struct rtw89_dev *rtwdev) +{ +int i; + +for (i =0 ; i <RTW89_PHY_MAX ; i++) +skb_queue_head_init (&rtwdev->ppdu_sts.rx_queue[i]); +for (i =0 ; i <RTW89_PHY_MAX ; i++) + rtwdev->ppdu_sts.curr_rx_ppdu_cnt[i] =U8_MAX ; +} + +int rtw89_core_start (struct rtw89_dev *rtwdev) +{ +int ret; + + rtwdev->mac.qta_mode =RTW89_QTA_SCC ; + ret =rtw89_mac_init (rtwdev); +if (ret) { +rtw89_err (rtwdev,"mac init fail, ret:%d\n" , ret); +return ret; + } + +rtw89_btc_ntfy_poweron (rtwdev); + +/* efuse process */ + +/* pre-config BB/RF, BB reset/RFC reset */ +rtw89_mac_disable_bb_rf (rtwdev); +rtw89_mac_enable_bb_rf (rtwdev); +rtw89_phy_init_bb_reg (rtwdev); +rtw89_phy_init_rf_reg (rtwdev); + +rtw89_btc_ntfy_init (rtwdev,BTC_MODE_NORMAL ); + +rtw89_phy_dm_init (rtwdev); + +rtw89_mac_cfg_ppdu_status (rtwdev,RTW89_MAC_0 , true); +rtw89_mac_update_rts_threshold (rtwdev,RTW89_MAC_0 ); + + ret =rtw89_hci_start (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to start hci\n" ); +return ret; + } + +ieee80211_queue_delayed_work (rtwdev->hw, &rtwdev->track_work, +RTW89_TRACK_WORK_PERIOD ); + +set_bit (RTW89_FLAG_RUNNING , rtwdev->flags); + +rtw89_btc_ntfy_radio_state (rtwdev,BTC_RFCTRL_WL_ON ); +rtw89_fw_h2c_fw_log (rtwdev, rtwdev->fw.fw_log_enable); + +return 0 ; +} + +void rtw89_core_stop (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; + +/* Prvent to stop twice; enter_ips and ops_stop */ +if (!test_bit (RTW89_FLAG_RUNNING , rtwdev->flags)) +return ; + +rtw89_btc_ntfy_radio_state (rtwdev,BTC_RFCTRL_WL_OFF ); + +clear_bit (RTW89_FLAG_RUNNING , rtwdev->flags); + +mutex_unlock (&rtwdev->mutex); + +cancel_work_sync (&rtwdev->c2h_work); +cancel_work_sync (&btc->eapol_notify_work); +cancel_work_sync (&btc->arp_notify_work); +cancel_work_sync (&btc->dhcp_notify_work); +cancel_work_sync (&btc->wl_sta_notify_work); +cancel_delayed_work_sync (&rtwdev->txq_reinvoke_work); +cancel_delayed_work_sync (&rtwdev->track_work); +cancel_delayed_work_sync (&rtwdev->coex_act1_work); +cancel_delayed_work_sync (&rtwdev->cfo_track_work); + +mutex_lock (&rtwdev->mutex); + +rtw89_btc_ntfy_poweroff (rtwdev); +rtw89_hci_flush_queues (rtwdev,BIT (rtwdev->hw->queues) -1 , true); +rtw89_mac_flush_txq (rtwdev,BIT (rtwdev->hw->queues) -1 , true); +rtw89_hci_stop (rtwdev); +rtw89_hci_deinit (rtwdev); +rtw89_mac_pwr_off (rtwdev); +rtw89_hci_reset (rtwdev); +} + +int rtw89_core_init (struct rtw89_dev *rtwdev) +{ +struct rtw89_btc *btc = &rtwdev->btc; +int ret; + +INIT_LIST_HEAD (&rtwdev->ba_list); +INIT_WORK (&rtwdev->ba_work, rtw89_core_ba_work); +INIT_WORK (&rtwdev->txq_work, rtw89_core_txq_work); +INIT_DELAYED_WORK (&rtwdev->txq_reinvoke_work, rtw89_core_txq_reinvoke_work); +INIT_DELAYED_WORK (&rtwdev->track_work, rtw89_track_work); +INIT_DELAYED_WORK (&rtwdev->coex_act1_work, rtw89_coex_act1_work); +INIT_DELAYED_WORK (&rtwdev->cfo_track_work, rtw89_phy_cfo_track_work); + rtwdev->txq_wq =alloc_workqueue ("rtw89_tx_wq" ,WQ_UNBOUND |WQ_HIGHPRI ,0 ); +spin_lock_init (&rtwdev->ba_lock); +mutex_init (&rtwdev->mutex); +mutex_init (&rtwdev->rf_mutex); + rtwdev->total_sta_assoc =0 ; + +INIT_WORK (&rtwdev->c2h_work, rtw89_fw_c2h_work); +skb_queue_head_init (&rtwdev->c2h_queue); +rtw89_core_ppdu_sts_init (rtwdev); +rtw89_traffic_stats_init (rtwdev, &rtwdev->stats); + + rtwdev->ps_mode =rtw89_update_ps_mode (rtwdev); + rtwdev->hal.rx_fltr =DEFAULT_AX_RX_FLTR ; + +INIT_WORK (&btc->eapol_notify_work, rtw89_btc_ntfy_eapol_packet_work); +INIT_WORK (&btc->arp_notify_work, rtw89_btc_ntfy_arp_packet_work); +INIT_WORK (&btc->dhcp_notify_work, rtw89_btc_ntfy_dhcp_packet_work); +INIT_WORK (&btc->wl_sta_notify_work, rtw89_btc_ntfy_wl_sta_work); + + ret =rtw89_load_firmware (rtwdev); +if (ret) { +rtw89_warn (rtwdev,"no firmware loaded\n" ); +return ret; + } +rtw89_ser_init (rtwdev); + +return 0 ; +} +EXPORT_SYMBOL (rtw89_core_init); + +void rtw89_core_deinit (struct rtw89_dev *rtwdev) +{ +rtw89_ser_deinit (rtwdev); +rtw89_unload_firmware (rtwdev); + +destroy_workqueue (rtwdev->txq_wq); +mutex_destroy (&rtwdev->rf_mutex); +mutex_destroy (&rtwdev->mutex); +} +EXPORT_SYMBOL (rtw89_core_deinit); + +static void rtw89_read_chip_ver (struct rtw89_dev *rtwdev) +{ +u8 cv; + + cv =rtw89_read32_mask (rtwdev,R_AX_SYS_CFG1 ,B_AX_CHIP_VER_MSK ); +if (cv <=CHIP_CBV ) { +if (rtw89_read32 (rtwdev,R_AX_GPIO0_7_FUNC_SEL ) ==RTW89_R32_DEAD ) + cv =CHIP_CAV ; +else + cv =CHIP_CBV ; + } + + rtwdev->hal.cv = cv; +} + +static int rtw89_chip_efuse_info_setup (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_mac_partial_init (rtwdev); +if (ret) +return ret; + + ret =rtw89_parse_efuse_map (rtwdev); +if (ret) +return ret; + + ret =rtw89_parse_phycap_map (rtwdev); +if (ret) +return ret; + +rtw89_mac_pwr_off (rtwdev); + +return 0 ; +} + +static int rtw89_chip_board_info_setup (struct rtw89_dev *rtwdev) +{ +rtw89_chip_fem_setup (rtwdev); + +return 0 ; +} + +int rtw89_chip_info_setup (struct rtw89_dev *rtwdev) +{ +int ret; + +rtw89_read_chip_ver (rtwdev); + + ret =rtw89_wait_firmware_completion (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to wait firmware completion\n" ); +return ret; + } + + ret =rtw89_fw_recognize (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to recognize firmware\n" ); +return ret; + } + + ret =rtw89_chip_efuse_info_setup (rtwdev); +if (ret) +return ret; + + ret =rtw89_chip_board_info_setup (rtwdev); +if (ret) +return ret; + +return 0 ; +} +EXPORT_SYMBOL (rtw89_chip_info_setup); + +static int rtw89_core_register_hw (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; +struct rtw89_efuse *efuse = &rtwdev->efuse; +int ret; +int tx_headroom =IEEE80211_HT_CTL_LEN ; + + hw->vif_data_size =sizeof (struct rtw89_vif ); + hw->sta_data_size =sizeof (struct rtw89_sta ); + hw->txq_data_size =sizeof (struct rtw89_txq ); + +SET_IEEE80211_PERM_ADDR (hw, efuse->addr); + + hw->extra_tx_headroom = tx_headroom; + hw->queues =IEEE80211_NUM_ACS ; + hw->max_rx_aggregation_subframes =RTW89_MAX_RX_AGG_NUM ; + hw->max_tx_aggregation_subframes =RTW89_MAX_TX_AGG_NUM ; + +ieee80211_hw_set (hw,SIGNAL_DBM ); +ieee80211_hw_set (hw,HAS_RATE_CONTROL ); +ieee80211_hw_set (hw,MFP_CAPABLE ); +ieee80211_hw_set (hw,REPORTS_TX_ACK_STATUS ); +ieee80211_hw_set (hw,AMPDU_AGGREGATION ); +ieee80211_hw_set (hw,RX_INCLUDES_FCS ); +ieee80211_hw_set (hw,TX_AMSDU ); +ieee80211_hw_set (hw,SUPPORT_FAST_XMIT ); +ieee80211_hw_set (hw,SUPPORTS_AMSDU_IN_AMPDU ); +ieee80211_hw_set (hw,SUPPORTS_PS ); +ieee80211_hw_set (hw,SUPPORTS_DYNAMIC_PS ); + + hw->wiphy->interface_modes =BIT (NL80211_IFTYPE_STATION ); + hw->wiphy->available_antennas_tx =BIT (rtwdev->chip->rf_path_num) -1 ; + hw->wiphy->available_antennas_rx =BIT (rtwdev->chip->rf_path_num) -1 ; + + hw->wiphy->features |=NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR ; + +wiphy_ext_feature_set (hw->wiphy,NL80211_EXT_FEATURE_CAN_REPLACE_PTK0 ); + + ret =rtw89_core_set_supported_band (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to set supported band\n" ); +return ret; + } + + hw->wiphy->reg_notifier = rtw89_regd_notifier; + hw->wiphy->sar_capa = &rtw89_sar_capa; + + ret =ieee80211_register_hw (hw); +if (ret) { +rtw89_err (rtwdev,"failed to register hw\n" ); + goto err; + } + + ret =rtw89_regd_init (rtwdev, rtw89_regd_notifier); +if (ret) { +rtw89_err (rtwdev,"failed to init regd\n" ); + goto err; + } + +return 0 ; + +err: +return ret; +} + +static void rtw89_core_unregister_hw (struct rtw89_dev *rtwdev) +{ +struct ieee80211_hw *hw = rtwdev->hw; + +ieee80211_unregister_hw (hw); +rtw89_core_clr_supported_band (rtwdev); +} + +int rtw89_core_register (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_core_register_hw (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to register core hw\n" ); +return ret; + } + +rtw89_debugfs_init (rtwdev); + +return 0 ; +} +EXPORT_SYMBOL (rtw89_core_register); + +void rtw89_core_unregister (struct rtw89_dev *rtwdev) +{ +rtw89_core_unregister_hw (rtwdev); +} +EXPORT_SYMBOL (rtw89_core_unregister); + +MODULE_AUTHOR ("Realtek Corporation" ); +MODULE_DESCRIPTION ("Realtek 802.11ax wireless core module" ); +MODULE_LICENSE ("Dual BSD/GPL" );drivers/net/wireless/realtek/rtw89/core.h new file +3336
-0@@ -0,0 +1,3336 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#ifndef __RTW89_CORE_H__ +#define __RTW89_CORE_H__ + +#include <linux/average.h> +#include <linux/bitfield.h> +#include <linux/firmware.h> +#include <linux/iopoll.h> +#include <linux/workqueue.h> +#include <net/mac80211.h> + +struct rtw89_dev; + +extern const struct ieee80211_ops rtw89_ops; +extern const struct rtw89_chip_info rtw8852a_chip_info; + +#define MASKBYTE0 0xff +#define MASKBYTE1 0xff00 +#define MASKBYTE2 0xff0000 +#define MASKBYTE3 0xff000000 +#define MASKBYTE4 0xff00000000ULL +#define MASKHWORD 0xffff0000 +#define MASKLWORD 0x0000ffff +#define MASKDWORD 0xffffffff +#define RFREG_MASK 0xfffff +#define INV_RF_DATA 0xffffffff + +#define RTW89_TRACK_WORK_PERIOD round_jiffies_relative(HZ * 2) +#define CFO_TRACK_MAX_USER 64 +#define MAX_RSSI 110 +#define RSSI_FACTOR 1 +#define RTW89_RSSI_RAW_TO_DBM(rssi) ((s8)((rssi) >> RSSI_FACTOR) - MAX_RSSI) +#define RTW89_MAX_HW_PORT_NUM 5 + +#define RTW89_HTC_MASK_VARIANT GENMASK(1, 0) +#define RTW89_HTC_VARIANT_HE 3 +#define RTW89_HTC_MASK_CTL_ID GENMASK(5, 2) +#define RTW89_HTC_VARIANT_HE_CID_CAS 6 +#define RTW89_HTC_MASK_CTL_INFO GENMASK(31, 6) + +enum rtw89_subband { + RTW89_CH_2G = 0, + RTW89_CH_5G_BAND_1 = 1, + /* RTW89_CH_5G_BAND_2 = 2, unused */ + RTW89_CH_5G_BAND_3 = 3, + RTW89_CH_5G_BAND_4 = 4, + + RTW89_SUBBAND_NR, +}; + +enum rtw89_hci_type { + RTW89_HCI_TYPE_PCIE, + RTW89_HCI_TYPE_USB, + RTW89_HCI_TYPE_SDIO, +}; + +enum rtw89_core_chip_id { + RTL8852A, + RTL8852B, + RTL8852C, +}; + +enum rtw89_cv { + CHIP_CAV, + CHIP_CBV, + CHIP_CCV, + CHIP_CDV, + CHIP_CEV, + CHIP_CFV, + CHIP_CV_MAX, + CHIP_CV_INVALID = CHIP_CV_MAX, +}; + +enum rtw89_core_tx_type { + RTW89_CORE_TX_TYPE_DATA, + RTW89_CORE_TX_TYPE_MGMT, + RTW89_CORE_TX_TYPE_FWCMD, +}; + +enum rtw89_core_rx_type { + RTW89_CORE_RX_TYPE_WIFI = 0, + RTW89_CORE_RX_TYPE_PPDU_STAT = 1, + RTW89_CORE_RX_TYPE_CHAN_INFO = 2, + RTW89_CORE_RX_TYPE_BB_SCOPE = 3, + RTW89_CORE_RX_TYPE_F2P_TXCMD = 4, + RTW89_CORE_RX_TYPE_SS2FW = 5, + RTW89_CORE_RX_TYPE_TX_REPORT = 6, + RTW89_CORE_RX_TYPE_TX_REL_HOST = 7, + RTW89_CORE_RX_TYPE_DFS_REPORT = 8, + RTW89_CORE_RX_TYPE_TX_REL_CPU = 9, + RTW89_CORE_RX_TYPE_C2H = 10, + RTW89_CORE_RX_TYPE_CSI = 11, + RTW89_CORE_RX_TYPE_CQI = 12, +}; + +enum rtw89_txq_flags { + RTW89_TXQ_F_AMPDU = 0, + RTW89_TXQ_F_BLOCK_BA = 1, +}; + +enum rtw89_net_type { + RTW89_NET_TYPE_NO_LINK = 0, + RTW89_NET_TYPE_AD_HOC = 1, + RTW89_NET_TYPE_INFRA = 2, + RTW89_NET_TYPE_AP_MODE = 3, +}; + +enum rtw89_wifi_role { + RTW89_WIFI_ROLE_NONE, + RTW89_WIFI_ROLE_STATION, + RTW89_WIFI_ROLE_AP, + RTW89_WIFI_ROLE_AP_VLAN, + RTW89_WIFI_ROLE_ADHOC, + RTW89_WIFI_ROLE_ADHOC_MASTER, + RTW89_WIFI_ROLE_MESH_POINT, + RTW89_WIFI_ROLE_MONITOR, + RTW89_WIFI_ROLE_P2P_DEVICE, + RTW89_WIFI_ROLE_P2P_CLIENT, + RTW89_WIFI_ROLE_P2P_GO, + RTW89_WIFI_ROLE_NAN, + RTW89_WIFI_ROLE_MLME_MAX +}; + +enum rtw89_upd_mode { + RTW89_VIF_CREATE, + RTW89_VIF_REMOVE, + RTW89_VIF_TYPE_CHANGE, + RTW89_VIF_INFO_CHANGE, + RTW89_VIF_CON_DISCONN +}; + +enum rtw89_self_role { + RTW89_SELF_ROLE_CLIENT, + RTW89_SELF_ROLE_AP, + RTW89_SELF_ROLE_AP_CLIENT +}; + +enum rtw89_msk_sO_el { + RTW89_NO_MSK, + RTW89_SMA, + RTW89_TMA, + RTW89_BSSID +}; + +enum rtw89_sch_tx_sel { + RTW89_SCH_TX_SEL_ALL, + RTW89_SCH_TX_SEL_HIQ, + RTW89_SCH_TX_SEL_MG0, + RTW89_SCH_TX_SEL_MACID, +}; + +/* RTW89_ADDR_CAM_SEC_NONE : not enabled + * RTW89_ADDR_CAM_SEC_ALL_UNI : 0 - 6 unicast + * RTW89_ADDR_CAM_SEC_NORMAL : 0 - 1 unicast, 2 - 4 group, 5 - 6 BIP + * RTW89_ADDR_CAM_SEC_4GROUP : 0 - 1 unicast, 2 - 5 group, 6 BIP + */ +enum rtw89_add_cam_sec_mode { + RTW89_ADDR_CAM_SEC_NONE = 0, + RTW89_ADDR_CAM_SEC_ALL_UNI = 1, + RTW89_ADDR_CAM_SEC_NORMAL = 2, + RTW89_ADDR_CAM_SEC_4GROUP = 3, +}; + +enum rtw89_sec_key_type { + RTW89_SEC_KEY_TYPE_NONE = 0, + RTW89_SEC_KEY_TYPE_WEP40 = 1, + RTW89_SEC_KEY_TYPE_WEP104 = 2, + RTW89_SEC_KEY_TYPE_TKIP = 3, + RTW89_SEC_KEY_TYPE_WAPI = 4, + RTW89_SEC_KEY_TYPE_GCMSMS4 = 5, + RTW89_SEC_KEY_TYPE_CCMP128 = 6, + RTW89_SEC_KEY_TYPE_CCMP256 = 7, + RTW89_SEC_KEY_TYPE_GCMP128 = 8, + RTW89_SEC_KEY_TYPE_GCMP256 = 9, + RTW89_SEC_KEY_TYPE_BIP_CCMP128 = 10, +}; + +enum rtw89_port { + RTW89_PORT_0 = 0, + RTW89_PORT_1 = 1, + RTW89_PORT_2 = 2, + RTW89_PORT_3 = 3, + RTW89_PORT_4 = 4, + RTW89_PORT_NUM +}; + +enum rtw89_band { + RTW89_BAND_2G = 0, + RTW89_BAND_5G = 1, + RTW89_BAND_MAX, +}; + +enum rtw89_hw_rate { + RTW89_HW_RATE_CCK1 = 0x0, + RTW89_HW_RATE_CCK2 = 0x1, + RTW89_HW_RATE_CCK5_5 = 0x2, + RTW89_HW_RATE_CCK11 = 0x3, + RTW89_HW_RATE_OFDM6 = 0x4, + RTW89_HW_RATE_OFDM9 = 0x5, + RTW89_HW_RATE_OFDM12 = 0x6, + RTW89_HW_RATE_OFDM18 = 0x7, + RTW89_HW_RATE_OFDM24 = 0x8, + RTW89_HW_RATE_OFDM36 = 0x9, + RTW89_HW_RATE_OFDM48 = 0xA, + RTW89_HW_RATE_OFDM54 = 0xB, + RTW89_HW_RATE_MCS0 = 0x80, + RTW89_HW_RATE_MCS1 = 0x81, + RTW89_HW_RATE_MCS2 = 0x82, + RTW89_HW_RATE_MCS3 = 0x83, + RTW89_HW_RATE_MCS4 = 0x84, + RTW89_HW_RATE_MCS5 = 0x85, + RTW89_HW_RATE_MCS6 = 0x86, + RTW89_HW_RATE_MCS7 = 0x87, + RTW89_HW_RATE_MCS8 = 0x88, + RTW89_HW_RATE_MCS9 = 0x89, + RTW89_HW_RATE_MCS10 = 0x8A, + RTW89_HW_RATE_MCS11 = 0x8B, + RTW89_HW_RATE_MCS12 = 0x8C, + RTW89_HW_RATE_MCS13 = 0x8D, + RTW89_HW_RATE_MCS14 = 0x8E, + RTW89_HW_RATE_MCS15 = 0x8F, + RTW89_HW_RATE_MCS16 = 0x90, + RTW89_HW_RATE_MCS17 = 0x91, + RTW89_HW_RATE_MCS18 = 0x92, + RTW89_HW_RATE_MCS19 = 0x93, + RTW89_HW_RATE_MCS20 = 0x94, + RTW89_HW_RATE_MCS21 = 0x95, + RTW89_HW_RATE_MCS22 = 0x96, + RTW89_HW_RATE_MCS23 = 0x97, + RTW89_HW_RATE_MCS24 = 0x98, + RTW89_HW_RATE_MCS25 = 0x99, + RTW89_HW_RATE_MCS26 = 0x9A, + RTW89_HW_RATE_MCS27 = 0x9B, + RTW89_HW_RATE_MCS28 = 0x9C, + RTW89_HW_RATE_MCS29 = 0x9D, + RTW89_HW_RATE_MCS30 = 0x9E, + RTW89_HW_RATE_MCS31 = 0x9F, + RTW89_HW_RATE_VHT_NSS1_MCS0 = 0x100, + RTW89_HW_RATE_VHT_NSS1_MCS1 = 0x101, + RTW89_HW_RATE_VHT_NSS1_MCS2 = 0x102, + RTW89_HW_RATE_VHT_NSS1_MCS3 = 0x103, + RTW89_HW_RATE_VHT_NSS1_MCS4 = 0x104, + RTW89_HW_RATE_VHT_NSS1_MCS5 = 0x105, + RTW89_HW_RATE_VHT_NSS1_MCS6 = 0x106, + RTW89_HW_RATE_VHT_NSS1_MCS7 = 0x107, + RTW89_HW_RATE_VHT_NSS1_MCS8 = 0x108, + RTW89_HW_RATE_VHT_NSS1_MCS9 = 0x109, + RTW89_HW_RATE_VHT_NSS2_MCS0 = 0x110, + RTW89_HW_RATE_VHT_NSS2_MCS1 = 0x111, + RTW89_HW_RATE_VHT_NSS2_MCS2 = 0x112, + RTW89_HW_RATE_VHT_NSS2_MCS3 = 0x113, + RTW89_HW_RATE_VHT_NSS2_MCS4 = 0x114, + RTW89_HW_RATE_VHT_NSS2_MCS5 = 0x115, + RTW89_HW_RATE_VHT_NSS2_MCS6 = 0x116, + RTW89_HW_RATE_VHT_NSS2_MCS7 = 0x117, + RTW89_HW_RATE_VHT_NSS2_MCS8 = 0x118, + RTW89_HW_RATE_VHT_NSS2_MCS9 = 0x119, + RTW89_HW_RATE_VHT_NSS3_MCS0 = 0x120, + RTW89_HW_RATE_VHT_NSS3_MCS1 = 0x121, + RTW89_HW_RATE_VHT_NSS3_MCS2 = 0x122, + RTW89_HW_RATE_VHT_NSS3_MCS3 = 0x123, + RTW89_HW_RATE_VHT_NSS3_MCS4 = 0x124, + RTW89_HW_RATE_VHT_NSS3_MCS5 = 0x125, + RTW89_HW_RATE_VHT_NSS3_MCS6 = 0x126, + RTW89_HW_RATE_VHT_NSS3_MCS7 = 0x127, + RTW89_HW_RATE_VHT_NSS3_MCS8 = 0x128, + RTW89_HW_RATE_VHT_NSS3_MCS9 = 0x129, + RTW89_HW_RATE_VHT_NSS4_MCS0 = 0x130, + RTW89_HW_RATE_VHT_NSS4_MCS1 = 0x131, + RTW89_HW_RATE_VHT_NSS4_MCS2 = 0x132, + RTW89_HW_RATE_VHT_NSS4_MCS3 = 0x133, + RTW89_HW_RATE_VHT_NSS4_MCS4 = 0x134, + RTW89_HW_RATE_VHT_NSS4_MCS5 = 0x135, + RTW89_HW_RATE_VHT_NSS4_MCS6 = 0x136, + RTW89_HW_RATE_VHT_NSS4_MCS7 = 0x137, + RTW89_HW_RATE_VHT_NSS4_MCS8 = 0x138, + RTW89_HW_RATE_VHT_NSS4_MCS9 = 0x139, + RTW89_HW_RATE_HE_NSS1_MCS0 = 0x180, + RTW89_HW_RATE_HE_NSS1_MCS1 = 0x181, + RTW89_HW_RATE_HE_NSS1_MCS2 = 0x182, + RTW89_HW_RATE_HE_NSS1_MCS3 = 0x183, + RTW89_HW_RATE_HE_NSS1_MCS4 = 0x184, + RTW89_HW_RATE_HE_NSS1_MCS5 = 0x185, + RTW89_HW_RATE_HE_NSS1_MCS6 = 0x186, + RTW89_HW_RATE_HE_NSS1_MCS7 = 0x187, + RTW89_HW_RATE_HE_NSS1_MCS8 = 0x188, + RTW89_HW_RATE_HE_NSS1_MCS9 = 0x189, + RTW89_HW_RATE_HE_NSS1_MCS10 = 0x18A, + RTW89_HW_RATE_HE_NSS1_MCS11 = 0x18B, + RTW89_HW_RATE_HE_NSS2_MCS0 = 0x190, + RTW89_HW_RATE_HE_NSS2_MCS1 = 0x191, + RTW89_HW_RATE_HE_NSS2_MCS2 = 0x192, + RTW89_HW_RATE_HE_NSS2_MCS3 = 0x193, + RTW89_HW_RATE_HE_NSS2_MCS4 = 0x194, + RTW89_HW_RATE_HE_NSS2_MCS5 = 0x195, + RTW89_HW_RATE_HE_NSS2_MCS6 = 0x196, + RTW89_HW_RATE_HE_NSS2_MCS7 = 0x197, + RTW89_HW_RATE_HE_NSS2_MCS8 = 0x198, + RTW89_HW_RATE_HE_NSS2_MCS9 = 0x199, + RTW89_HW_RATE_HE_NSS2_MCS10 = 0x19A, + RTW89_HW_RATE_HE_NSS2_MCS11 = 0x19B, + RTW89_HW_RATE_HE_NSS3_MCS0 = 0x1A0, + RTW89_HW_RATE_HE_NSS3_MCS1 = 0x1A1, + RTW89_HW_RATE_HE_NSS3_MCS2 = 0x1A2, + RTW89_HW_RATE_HE_NSS3_MCS3 = 0x1A3, + RTW89_HW_RATE_HE_NSS3_MCS4 = 0x1A4, + RTW89_HW_RATE_HE_NSS3_MCS5 = 0x1A5, + RTW89_HW_RATE_HE_NSS3_MCS6 = 0x1A6, + RTW89_HW_RATE_HE_NSS3_MCS7 = 0x1A7, + RTW89_HW_RATE_HE_NSS3_MCS8 = 0x1A8, + RTW89_HW_RATE_HE_NSS3_MCS9 = 0x1A9, + RTW89_HW_RATE_HE_NSS3_MCS10 = 0x1AA, + RTW89_HW_RATE_HE_NSS3_MCS11 = 0x1AB, + RTW89_HW_RATE_HE_NSS4_MCS0 = 0x1B0, + RTW89_HW_RATE_HE_NSS4_MCS1 = 0x1B1, + RTW89_HW_RATE_HE_NSS4_MCS2 = 0x1B2, + RTW89_HW_RATE_HE_NSS4_MCS3 = 0x1B3, + RTW89_HW_RATE_HE_NSS4_MCS4 = 0x1B4, + RTW89_HW_RATE_HE_NSS4_MCS5 = 0x1B5, + RTW89_HW_RATE_HE_NSS4_MCS6 = 0x1B6, + RTW89_HW_RATE_HE_NSS4_MCS7 = 0x1B7, + RTW89_HW_RATE_HE_NSS4_MCS8 = 0x1B8, + RTW89_HW_RATE_HE_NSS4_MCS9 = 0x1B9, + RTW89_HW_RATE_HE_NSS4_MCS10 = 0x1BA, + RTW89_HW_RATE_HE_NSS4_MCS11 = 0x1BB, + RTW89_HW_RATE_NR, + + RTW89_HW_RATE_MASK_MOD = GENMASK(8, 7), + RTW89_HW_RATE_MASK_VAL = GENMASK(6, 0), +}; + +/* 2G channels, + * 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14 + */ +#define RTW89_2G_CH_NUM 14 + +/* 5G channels, + * 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, 142, 144, + * 149, 151, 153, 155, 157, 159, 161, 163, + * 165, 167, 169, 171, 173, 175, 177 + */ +#define RTW89_5G_CH_NUM 53 + +enum rtw89_rate_section { + RTW89_RS_CCK, + RTW89_RS_OFDM, + RTW89_RS_MCS, /* for HT/VHT/HE */ + RTW89_RS_HEDCM, + RTW89_RS_OFFSET, + RTW89_RS_MAX, + RTW89_RS_LMT_NUM = RTW89_RS_MCS + 1, +}; + +enum rtw89_rate_max { + RTW89_RATE_CCK_MAX = 4, + RTW89_RATE_OFDM_MAX = 8, + RTW89_RATE_MCS_MAX = 12, + RTW89_RATE_HEDCM_MAX = 4, /* for HEDCM MCS0/1/3/4 */ + RTW89_RATE_OFFSET_MAX = 5, /* for HE(HEDCM)/VHT/HT/OFDM/CCK offset */ +}; + +enum rtw89_nss { + RTW89_NSS_1 = 0, + RTW89_NSS_2 = 1, + /* HE DCM only support 1ss and 2ss */ + RTW89_NSS_HEDCM_MAX = RTW89_NSS_2 + 1, + RTW89_NSS_3 = 2, + RTW89_NSS_4 = 3, + RTW89_NSS_MAX, +}; + +enum rtw89_ntx { + RTW89_1TX = 0, + RTW89_2TX = 1, + RTW89_NTX_NUM, +}; + +enum rtw89_beamforming_type { + RTW89_NONBF = 0, + RTW89_BF = 1, + RTW89_BF_NUM, +}; + +enum rtw89_regulation_type { + RTW89_WW = 0, + RTW89_ETSI = 1, + RTW89_FCC = 2, + RTW89_MKK = 3, + RTW89_NA = 4, + RTW89_IC = 5, + RTW89_KCC = 6, + RTW89_NCC = 7, + RTW89_CHILE = 8, + RTW89_ACMA = 9, + RTW89_MEXICO = 10, + RTW89_UKRAINE = 11, + RTW89_CN = 12, + RTW89_REGD_NUM, +}; + +extern const u8 rtw89_rs_idx_max[RTW89_RS_MAX]; +extern const u8 rtw89_rs_nss_max[RTW89_RS_MAX]; + +struct rtw89_txpwr_byrate { + s8 cck[RTW89_RATE_CCK_MAX]; + s8 ofdm[RTW89_RATE_OFDM_MAX]; + s8 mcs[RTW89_NSS_MAX][RTW89_RATE_MCS_MAX]; + s8 hedcm[RTW89_NSS_HEDCM_MAX][RTW89_RATE_HEDCM_MAX]; + s8 offset[RTW89_RATE_OFFSET_MAX]; +}; + +enum rtw89_bandwidth_section_num { + RTW89_BW20_SEC_NUM = 8, + RTW89_BW40_SEC_NUM = 4, + RTW89_BW80_SEC_NUM = 2, +}; + +struct rtw89_txpwr_limit { + s8 cck_20m[RTW89_BF_NUM]; + s8 cck_40m[RTW89_BF_NUM]; + s8 ofdm[RTW89_BF_NUM]; + s8 mcs_20m[RTW89_BW20_SEC_NUM][RTW89_BF_NUM]; + s8 mcs_40m[RTW89_BW40_SEC_NUM][RTW89_BF_NUM]; + s8 mcs_80m[RTW89_BW80_SEC_NUM][RTW89_BF_NUM]; + s8 mcs_160m[RTW89_BF_NUM]; + s8 mcs_40m_0p5[RTW89_BF_NUM]; + s8 mcs_40m_2p5[RTW89_BF_NUM]; +}; + +#define RTW89_RU_SEC_NUM 8 + +struct rtw89_txpwr_limit_ru { + s8 ru26[RTW89_RU_SEC_NUM]; + s8 ru52[RTW89_RU_SEC_NUM]; + s8 ru106[RTW89_RU_SEC_NUM]; +}; + +struct rtw89_rate_desc { + enum rtw89_nss nss; + enum rtw89_rate_section rs; + u8 idx; +}; + +#define PHY_STS_HDR_LEN 8 +#define RF_PATH_MAX 4 +#define RTW89_MAX_PPDU_CNT 8 +struct rtw89_rx_phy_ppdu { + u8 *buf; + u32 len; + u8 rssi_avg; + s8 rssi[RF_PATH_MAX]; + u8 mac_id; + bool to_self; + bool valid; +}; + +enum rtw89_mac_idx { + RTW89_MAC_0 = 0, + RTW89_MAC_1 = 1, +}; + +enum rtw89_phy_idx { + RTW89_PHY_0 = 0, + RTW89_PHY_1 = 1, + RTW89_PHY_MAX +}; + +enum rtw89_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 rtw89_rf_path_bit { + RF_A = BIT(0), + RF_B = BIT(1), + RF_C = BIT(2), + RF_D = BIT(3), + + RF_AB = (RF_A | RF_B), + RF_AC = (RF_A | RF_C), + RF_AD = (RF_A | RF_D), + RF_BC = (RF_B | RF_C), + RF_BD = (RF_B | RF_D), + RF_CD = (RF_C | RF_D), + + RF_ABC = (RF_A | RF_B | RF_C), + RF_ABD = (RF_A | RF_B | RF_D), + RF_ACD = (RF_A | RF_C | RF_D), + RF_BCD = (RF_B | RF_C | RF_D), + + RF_ABCD = (RF_A | RF_B | RF_C | RF_D), +}; + +enum rtw89_bandwidth { + RTW89_CHANNEL_WIDTH_20 = 0, + RTW89_CHANNEL_WIDTH_40 = 1, + RTW89_CHANNEL_WIDTH_80 = 2, + RTW89_CHANNEL_WIDTH_160 = 3, + RTW89_CHANNEL_WIDTH_80_80 = 4, + RTW89_CHANNEL_WIDTH_5 = 5, + RTW89_CHANNEL_WIDTH_10 = 6, +}; + +enum rtw89_ps_mode { + RTW89_PS_MODE_NONE = 0, + RTW89_PS_MODE_RFOFF = 1, + RTW89_PS_MODE_CLK_GATED = 2, + RTW89_PS_MODE_PWR_GATED = 3, +}; + +#define RTW89_MAX_CHANNEL_WIDTH RTW89_CHANNEL_WIDTH_80 +#define RTW89_2G_BW_NUM (RTW89_CHANNEL_WIDTH_40 + 1) +#define RTW89_5G_BW_NUM (RTW89_CHANNEL_WIDTH_80 + 1) +#define RTW89_PPE_BW_NUM (RTW89_CHANNEL_WIDTH_80 + 1) + +enum rtw89_ru_bandwidth { + RTW89_RU26 = 0, + RTW89_RU52 = 1, + RTW89_RU106 = 2, + RTW89_RU_NUM, +}; + +enum rtw89_sc_offset { + RTW89_SC_DONT_CARE = 0, + RTW89_SC_20_UPPER = 1, + RTW89_SC_20_LOWER = 2, + RTW89_SC_20_UPMOST = 3, + RTW89_SC_20_LOWEST = 4, + RTW89_SC_40_UPPER = 9, + RTW89_SC_40_LOWER = 10, +}; + +struct rtw89_channel_params { + u8 center_chan; + u8 primary_chan; + u8 bandwidth; + u8 pri_ch_idx; + u8 cch_by_bw[RTW89_MAX_CHANNEL_WIDTH + 1]; +}; + +struct rtw89_channel_help_params { + u16 tx_en; +}; + +struct rtw89_port_reg { + u32 port_cfg; + u32 tbtt_prohib; + u32 bcn_area; + u32 bcn_early; + u32 tbtt_early; + u32 tbtt_agg; + u32 bcn_space; + u32 bcn_forcetx; + u32 bcn_err_cnt; + u32 bcn_err_flag; + u32 dtim_ctrl; + u32 tbtt_shift; + u32 bcn_cnt_tmr; + u32 tsftr_l; + u32 tsftr_h; +}; + +struct rtw89_txwd_body { + __le32 dword0; + __le32 dword1; + __le32 dword2; + __le32 dword3; + __le32 dword4; + __le32 dword5; +} __packed; + +struct rtw89_txwd_info { + __le32 dword0; + __le32 dword1; + __le32 dword2; + __le32 dword3; + __le32 dword4; + __le32 dword5; +} __packed; + +struct rtw89_rx_desc_info { + u16 pkt_size; + u8 pkt_type; + u8 drv_info_size; + u8 shift; + u8 wl_hd_iv_len; + bool long_rxdesc; + bool bb_sel; + bool mac_info_valid; + u16 data_rate; + u8 gi_ltf; + u8 bw; + u32 free_run_cnt; + u8 user_id; + bool sr_en; + u8 ppdu_cnt; + u8 ppdu_type; + bool icv_err; + bool crc32_err; + bool hw_dec; + bool sw_dec; + bool addr1_match; + u8 frag; + u16 seq; + u8 frame_type; + u8 rx_pl_id; + bool addr_cam_valid; + u8 addr_cam_id; + u8 sec_cam_id; + u8 mac_id; + u16 offset; + bool ready; +}; + +struct rtw89_rxdesc_short { + __le32 dword0; + __le32 dword1; + __le32 dword2; + __le32 dword3; +} __packed; + +struct rtw89_rxdesc_long { + __le32 dword0; + __le32 dword1;Lines of this file are not shown. View the raw message.
drivers/net/wireless/realtek/rtw89/txrx.h new file +393
-0Lines of this file are not shown. View the raw message.
drivers/net/wireless/realtek/rtw89/util.c new file +37
-0Lines of this file are not shown. View the raw message.
drivers/net/wireless/realtek/rtw89/util.h new file +31
-0Lines of this file are not shown. View the raw message.
The rest of this diff is not shown. View the raw message.
Signature · 1 line
2.25.1
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Part of the diff is not shown here. View the raw message.
Pkshih
maintainerRE: [PATCH 03/24] rtw89: add core and trx files
Quoted 76 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]
Sent: Saturday, July 10, 2021 1:32 AM
To: Pkshih
Cc: [email protected]; [email protected]
Subject: Re: [PATCH 03/24] rtw89: add core and trx filesQuoted 67 lines · Ping-Ke Shih
Implement main flows that contains register/unregister mac80211 hw with hardware capability, power on/off sequence, STA state actions, and TX/RX path.
The chip info is read from efuse while probing PCI, and then it can be used to induce supported channel, band, bitrate, ht/vht/he capability, and etc. Then, we register hardware with these capabilities.
When network interface is up, driver does power-on sequence to enable MAC, BB and RF function blocks. Oppositely, do power-off sequence when interface is going to down.
To maintain STA state, five callbacks are implemented -- add, assoc, disassoc, disconnect and remove. In which state, driver tells firmware STA info via H2C.
TX flow:
When a SKB is going to be transmitted, we must know its type first. If the type is mgmt or fwcmd made by driver, SKB is queued into corresponding DMA channel and PCI ring. The other type is data frame that is more complex, because it needs to establish BA session to have better throughput with AMPDU and AMSDU.
In order to have better PCI DMA efficiency, we don't kick off DMA every SKB. With wake TX queue, kick off DMA after a bunch of SKBs are written. To achieve this, we have two HCI ops --tx_writeandtx_kick_off.BA establishment work:
For data frames, we start to establish BA session if the STA is associated with APMDU capability and the TID session isn't established, and then the BA work is used to ask mac80211 to start AMPDU actions. Driver implements AMPDU action callbacks to know the session is established, so that we can setAGG_ENbit in TX descriptor to enable AMPDU.RX flow:
When a RX SKB is delivered from PCI,rtw89_core_rx()process it depneds on its type -- WIFI, C2H or PPDU. If type is C2H, it's queued into a C2H queue, and wake a work to handle the C2H packet. If type is WIFI, it's a normal RX packet. When mgmt or data frame is received, it is queued into pending RX SKB queue to wait for corresponding PPDU packet (another RX packet with PPDU type) to fill itsrx_status, like RSSI. And, then indicate this packet to mac80211. When control frame is received, indicate it to mac80211 immediately.Track work:
Use track work to monitor PHY status to know the changes of environment, and then update RA status or do RFK accordingly.Signed-off-by Ping-Ke Shih <[email protected]>--- drivers/net/wireless/realtek/rtw89/core.c | 2359 +++++++++++++++ drivers/net/wireless/realtek/rtw89/core.h | 3336 +++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/txrx.h | 393 +++ drivers/net/wireless/realtek/rtw89/util.c | 37 + drivers/net/wireless/realtek/rtw89/util.h | 31 + 5 files changed, 6156 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/core.c create mode 100644 drivers/net/wireless/realtek/rtw89/core.h create mode 100644 drivers/net/wireless/realtek/rtw89/txrx.h create mode 100644 drivers/net/wireless/realtek/rtw89/util.c create mode 100644 drivers/net/wireless/realtek/rtw89/util.hdrivers/net/wireless/realtek/rtw89/core.c new file +0
-0@@ -0,0 +1,2359 @@
[...]
Quoted 14 lines
drivers/net/wireless/realtek/rtw89/core.c line 1178
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/core.c new file +10
-0+ +static enum rtw89_ps_mode rtw89_update_ps_mode (struct rtw89_dev *rtwdev) +{ +const struct rtw89_chip_info *chip = rtwdev->chip; + +if (rtw89_disable_ps_mode || !chip->ps_mode_supported) +return RTW89_PS_MODE_NONE ; + +if (chip->ps_mode_supported &BIT (RTW89_PS_MODE_PWR_GATED )) +return RTW89_PS_MODE_PWR_GATED ;Current driver support only one chip with
RTW89_PS_MODE_PWR_GATED,RTW89_PS_MODE_CLK_GATEDandRTW89_PS_MODE_RFOFF.
Quoted 3 lines
According to this code, only
RTW89_PS_MODE_PWR_GATEDwill return. Please remove all other modes to reduce review overhead.
They are not only list of modes, but also the priority. So, I'd like to preserve the code to change the priority easier. And, I think the logic is very easy that there's no too much overhead.
[...]
Quoted 11 lines
Quoted 11 lines
drivers/net/wireless/realtek/rtw89/core.c new file +11
-0+ +int rtw89_core_power_on (struct rtw89_dev *rtwdev) +{ +int ret; + + ret =rtw89_mac_pwr_on (rtwdev); +if (ret) { +rtw89_err (rtwdev,"failed to start power sequence\n" ); + goto err; + } +
Quoted 9 lines
drivers/net/wireless/realtek/rtw89/core.c line 1618
Quoted 5 lines
drivers/net/wireless/realtek/rtw89/core.c new file +5
-0+return 0 ; + +err: +return ret; +}
rtw89_core_power_on()is not used. please remote it to avoid review overhead.
Removed.
Quoted 41 lines
Quoted 41 lines
drivers/net/wireless/realtek/rtw89/core.c new file +41
-0+u8 rtw89_core_acquire_bit_map (unsigned long *addr,unsigned long size) +{ +unsigned long bit; + + bit =find_first_zero_bit (addr, size); +if (bit < size) +set_bit (bit, addr); + +return bit; +} + +void rtw89_core_release_bit_map (unsigned long *addr,u8 bit) +{ +clear_bit (bit, addr); +} + +void rtw89_core_release_all_bits_map (unsigned long *addr,unsigned int nbits) +{ +bitmap_zero (addr, nbits); +} + +#define RTW89_TYPE_MAPPING (_type) \ + case NL80211_IFTYPE_ ## _type: \ + rtwvif->wifi_role = RTW89_WIFI_ROLE_ ## _type; \ + break +void rtw89_vif_type_mapping (struct ieee80211_vif *vif,bool assoc) +{ +struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv; + +switch (vif->type) { +RTW89_TYPE_MAPPING (ADHOC ); +RTW89_TYPE_MAPPING (STATION ); +RTW89_TYPE_MAPPING (AP ); +RTW89_TYPE_MAPPING (AP_VLAN ); +RTW89_TYPE_MAPPING (MONITOR ); +RTW89_TYPE_MAPPING (MESH_POINT ); +RTW89_TYPE_MAPPING (P2P_CLIENT ); +RTW89_TYPE_MAPPING (P2P_GO ); +RTW89_TYPE_MAPPING (P2P_DEVICE ); +RTW89_TYPE_MAPPING (NAN ); +default :
Quoted 9 lines
drivers/net/wireless/realtek/rtw89/core.c line 1663
Quoted 3 lines
drivers/net/wireless/realtek/rtw89/core.c new file +3
-0+WARN_ON (1 ); +break ; + }This switch statement makes no sense. Only
NL80211_IFTYPE_AP,NL80211_IFTYPE_MESH_POINT,NL80211_IFTYPE_ADHOCandNL80211_IFTYPE_STATIONare supported. Please remove this mapping open codertwvif->wifi_rolein the following switch
Removed.
Quoted 11 lines
drivers/net/wireless/realtek/rtw89/core.c line 1672
Quoted 8 lines
drivers/net/wireless/realtek/rtw89/core.c new file +8
-0+switch (vif->type) { +case NL80211_IFTYPE_AP : +case NL80211_IFTYPE_MESH_POINT : + rtwvif->net_type =RTW89_NET_TYPE_AP_MODE ; + rtwvif->self_role =RTW89_SELF_ROLE_AP ; +break ; +case NL80211_IFTYPE_ADHOC : + rtwvif->net_type =RTW89_NET_TYPE_AD_HOC ;Please set
rtwvif->self_rolehere, to make it easy to read.
Will add it.
[...]
Re: [PATCH 03/24] rtw89: add core and trx files
In reply to Ping-Ke ShihHi,
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/core.c new file +3
-0@@ -0,0 +1,2359 @@ +static void rtw89_traffic_stats_calc (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{
...
drivers/net/wireless/realtek/rtw89/core.c line 1516
Quoted 2 lines
drivers/net/wireless/realtek/rtw89/core.c new file +2
-0+ stats->tx_avg_len = (u32)(stats->tx_cnt ? stats->tx_unicast / stats->tx_cnt :0 ); + stats->rx_avg_len = (u32)(stats->rx_cnt ? stats->rx_unicast / stats->rx_cnt :0 );
You're doing 64-bit division which isn't supported on all architectures. You need a do_div()-based solution here, like:
stats->tx_avg_len = stats->tx_cnt ? DIV_ROUND_DOWN_ULL(stats->tx_unicast, stats->tx_cnt) : 0; stats->rx_avg_len = stats->rx_cnt ? DIV_ROUND_DOWN_ULL(stats->rx_unicast, stats->rx_cnt) : 0;
Brian
Pkshih
maintainerRE: [PATCH 03/24] rtw89: add core and trx files
Quoted 24 lines
-----Original Message-----
From: Brian Norris [mailto:[email protected]]
Sent: Friday, July 16, 2021 2:57 AM
To: Pkshih
Cc: [email protected]; [email protected]
Subject: Re: [PATCH 03/24] rtw89: add core and trx filesHi,
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/core.c new file +3
-0@@ -0,0 +1,2359 @@ +static void rtw89_traffic_stats_calc (struct rtw89_dev *rtwdev, +struct rtw89_traffic_stats *stats) +{...
drivers/net/wireless/realtek/rtw89/core.c line 1516
Quoted 2 lines
drivers/net/wireless/realtek/rtw89/core.c new file +2
-0+ stats->tx_avg_len = (u32)(stats->tx_cnt ? stats->tx_unicast / stats->tx_cnt :0 ); + stats->rx_avg_len = (u32)(stats->rx_cnt ? stats->rx_unicast / stats->rx_cnt :0 );You're doing 64-bit division which isn't supported on all architectures. You need a do_div()-based solution here, like:
Quoted 7 lines
stats->tx_avg_len = stats->tx_cnt ? DIV_ROUND_DOWN_ULL(stats->tx_unicast, stats->tx_cnt) : 0; stats->rx_avg_len = stats->rx_cnt ? DIV_ROUND_DOWN_ULL(stats->rx_unicast, stats->rx_cnt) : 0;
The kernel test robot has reported this on mips arch.
ERROR: modpost: "__udivdi3" [drivers/net/wireless/realtek/rtw89/rtw89_core.ko] undefined!
And, my fix is the same as yours. Next submission will include this. Thank you.
--
Ping-Ke
Ping-Ke Shih
maintainerPATCH 4/24 rtw89: add debug files
In reply to Ping-Ke ShihTo recognize issues happened in field, two debug methods, debug message and debugfs, are added.
The debug messages are written to kernel log, and four levels can be chosen according to the cases -- debug, info, warn and err.
Debugfs is used to read and write registers and driver status.
--- drivers/net/wireless/realtek/rtw89/debug.c | 2404 ++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/debug.h | 77 + 2 files changed, 2481 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/debug.c create mode 100644 drivers/net/wireless/realtek/rtw89/debug.h
drivers/net/wireless/realtek/rtw89/debug.c new file +2404 -0
@@ -0,0 +1,2404 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "coex.h" +#include "debug.h" +#include "fw.h" +#include "mac.h" +#include "ps.h" +#include "reg.h" +#include "sar.h" + +#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif + +#ifdef CONFIG_RTW89_DEBUGFS +struct rtw89_debugfs_priv { +struct rtw89_dev *rtwdev; +int (*cb_read)(struct seq_file *m,void *v); +ssize_t (*cb_write)(struct file *filp,const char __user *buffer, +size_t count,loff_t *loff); +union { +u32 cb_data; +struct { +u32 addr; +u8 len; + } read_reg; +struct { +u32 addr; +u32 mask; +u8 path; + } read_rf; +struct { +u8 ss_dbg:1 ; +u8 dle_dbg:1 ; +u8 dmac_dbg:1 ; +u8 cmac_dbg:1 ; +u8 dbg_port:1 ; + } dbgpkg_en; +struct { +u32 start; +u32 len; +u8 sel; + } mac_mem; + }; +}; + +static int rtw89_debugfs_single_show (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; + +return debugfs_priv->cb_read (m, v); +} + +static ssize_t rtw89_debugfs_single_write (struct file *filp, +const char __user *buffer, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; + +return debugfs_priv->cb_write (filp, buffer, count, loff); +} + +static ssize_t rtw89_debugfs_seq_file_write (struct file *filp, +const char __user *buffer, +size_t count,loff_t *loff) +{ +struct seq_file *seqpriv = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = seqpriv->private; + +return debugfs_priv->cb_write (filp, buffer, count, loff); +} + +static int rtw89_debugfs_single_open (struct inode *inode,struct file *filp) +{ +return single_open (filp, rtw89_debugfs_single_show, inode->i_private); +} + +static int rtw89_debugfs_close (struct inode *inode,struct file *filp) +{ +return 0 ; +} + +static const struct file_operations file_ops_single_r = { + .owner =THIS_MODULE , + .open = rtw89_debugfs_single_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static const struct file_operations file_ops_common_rw = { + .owner =THIS_MODULE , + .open = rtw89_debugfs_single_open, + .release = single_release, + .read = seq_read, + .llseek = seq_lseek, + .write = rtw89_debugfs_seq_file_write, +}; + +static const struct file_operations file_ops_single_w = { + .owner =THIS_MODULE , + .write = rtw89_debugfs_single_write, + .open = simple_open, + .release = rtw89_debugfs_close, +}; + +static ssize_t +rtw89_debug_priv_read_reg_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, len; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%x %x" , &addr, &len); +if (num !=2 ) { +rtw89_info (rtwdev,"invalid format: <addr> <len>\n" ); +return -EINVAL ; + } + + debugfs_priv->read_reg.addr = addr; + debugfs_priv->read_reg.len = len; + +rtw89_info (rtwdev,"select read %d bytes from 0x%08x\n" , len, addr); + +return count; +} + +static int rtw89_debug_priv_read_reg_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +u32 addr, data; +u8 len; + + len = debugfs_priv->read_reg.len; + addr = debugfs_priv->read_reg.addr; + +switch (len) { +case 1 : + data =rtw89_read8 (rtwdev, addr); +break ; +case 2 : + data =rtw89_read16 (rtwdev, addr); +break ; +case 4 : + data =rtw89_read32 (rtwdev, addr); +break ; +default : +rtw89_info (rtwdev,"invalid read reg len %d\n" , len); +return -EINVAL ; + } + +seq_printf (m,"get %d bytes at 0x%08x=0x%08x\n" , len, addr, data); + +return 0 ; +} + +static ssize_t rtw89_debug_priv_write_reg_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, val, len; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%x %x %x" , &addr, &val, &len); +if (num !=3 ) { +rtw89_info (rtwdev,"invalid format: <addr> <val> <len>\n" ); +return -EINVAL ; + } + +switch (len) { +case 1 : +rtw89_info (rtwdev,"reg write8 0x%08x: 0x%02x\n" , addr, val); +rtw89_write8 (rtwdev, addr, (u8 )val); +break ; +case 2 : +rtw89_info (rtwdev,"reg write16 0x%08x: 0x%04x\n" , addr, val); +rtw89_write16 (rtwdev, addr, (u16 )val); +break ; +case 4 : +rtw89_info (rtwdev,"reg write32 0x%08x: 0x%08x\n" , addr, val); +rtw89_write32 (rtwdev, addr, (u32 )val); +break ; +default : +rtw89_info (rtwdev,"invalid read write len %d\n" , len); +break ; + } + +return count; +} + +static ssize_t +rtw89_debug_priv_read_rf_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, mask; +u8 path; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%hhd %x %x" , &path, &addr, &mask); +if (num !=3 ) { +rtw89_info (rtwdev,"invalid format: <path> <addr> <mask>\n" ); +return -EINVAL ; + } + +if (path >= rtwdev->chip->rf_path_num) { +rtw89_info (rtwdev,"wrong rf path\n" ); +return -EINVAL ; + } + debugfs_priv->read_rf.addr = addr; + debugfs_priv->read_rf.mask = mask; + debugfs_priv->read_rf.path = path; + +rtw89_info (rtwdev,"select read rf path %d from 0x%08x\n" , path, addr); + +return count; +} + +static int rtw89_debug_priv_read_rf_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +u32 addr, data, mask; +u8 path; + + addr = debugfs_priv->read_rf.addr; + mask = debugfs_priv->read_rf.mask; + path = debugfs_priv->read_rf.path; + + data =rtw89_read_rf (rtwdev, path, addr, mask); + +seq_printf (m,"path %d, rf register 0x%08x=0x%08x\n" , path, addr, data); + +return 0 ; +} + +static ssize_t rtw89_debug_priv_write_rf_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, val, mask; +u8 path; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%hhd %x %x %x" , &path, &addr, &mask, &val); +if (num !=4 ) { +rtw89_info (rtwdev,"invalid format: <path> <addr> <mask> <val>\n" ); +return -EINVAL ; + } + +if (path >= rtwdev->chip->rf_path_num) { +rtw89_info (rtwdev,"wrong rf path\n" ); +return -EINVAL ; + } + +rtw89_info (rtwdev,"path %d, rf register write 0x%08x=0x%08x (mask = 0x%08x)\n" , + path, addr, val, mask); +rtw89_write_rf (rtwdev, path, addr, mask, val); + +return count; +} + +static int rtw89_debug_priv_rf_reg_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +const struct rtw89_chip_info *chip = rtwdev->chip; +u32 addr, offset, data; +u8 path; + +for (path =0 ; path < chip->rf_path_num; path++) { +seq_printf (m,"RF path %d:\n\n" , path); +for (addr =0 ; addr <0x100 ; addr +=4 ) { +seq_printf (m,"0x%08x: " , addr); +for (offset =0 ; offset <4 ; offset++) { + data =rtw89_read_rf (rtwdev, path, + addr + offset,RFREG_MASK ); +seq_printf (m,"0x%05x " , data); + } +seq_puts (m,"\n" ); + } +seq_puts (m,"\n" ); + } + +return 0 ; +} + +struct txpwr_ent { +const char *txt; +u8 len; +}; + +struct txpwr_map { +const struct txpwr_ent *ent; +u8 size; +u32 addr_from; +u32 addr_to; +}; + +#define __GEN_TXPWR_ENT2 (_t, _e0, _e1) \ + { .len = 2, .txt = _t "\t- " _e0 " " _e1 } + +#define __GEN_TXPWR_ENT4 (_t, _e0, _e1, _e2, _e3) \ + { .len = 4, .txt = _t "\t- " _e0 " " _e1 " " _e2 " " _e3 } + +#define __GEN_TXPWR_ENT8 (_t, _e0, _e1, _e2, _e3, _e4, _e5, _e6, _e7) \ + { .len = 8, .txt = _t "\t- " \ + _e0 " " _e1 " " _e2 " " _e3 " " \ + _e4 " " _e5 " " _e6 " " _e7 } + +static const struct txpwr_ent __txpwr_ent_byr[] = { +__GEN_TXPWR_ENT4 ("CCK " ,"1M " ,"2M " ,"5.5M " ,"11M " ), +__GEN_TXPWR_ENT4 ("LEGACY " ,"6M " ,"9M " ,"12M " ,"18M " ), +__GEN_TXPWR_ENT4 ("LEGACY " ,"24M " ,"36M " ,"48M " ,"54M " ), +/* 1NSS */ +__GEN_TXPWR_ENT4 ("MCS_1NSS " ,"MCS0 " ,"MCS1 " ,"MCS2 " ,"MCS3 " ), +__GEN_TXPWR_ENT4 ("MCS_1NSS " ,"MCS4 " ,"MCS5 " ,"MCS6 " ,"MCS7 " ), +__GEN_TXPWR_ENT4 ("MCS_1NSS " ,"MCS8 " ,"MCS9 " ,"MCS10" ,"MCS11" ), +__GEN_TXPWR_ENT4 ("HEDCM_1NSS" ,"MCS0 " ,"MCS1 " ,"MCS3 " ,"MCS4 " ), +/* 2NSS */ +__GEN_TXPWR_ENT4 ("MCS_2NSS " ,"MCS0 " ,"MCS1 " ,"MCS2 " ,"MCS3 " ), +__GEN_TXPWR_ENT4 ("MCS_2NSS " ,"MCS4 " ,"MCS5 " ,"MCS6 " ,"MCS7 " ), +__GEN_TXPWR_ENT4 ("MCS_2NSS " ,"MCS8 " ,"MCS9 " ,"MCS10" ,"MCS11" ), +__GEN_TXPWR_ENT4 ("HEDCM_2NSS" ,"MCS0 " ,"MCS1 " ,"MCS3 " ,"MCS4 " ), +}; + +static_assert ((ARRAY_SIZE (__txpwr_ent_byr) *4 ) == + (R_AX_PWR_BY_RATE_MAX -R_AX_PWR_BY_RATE +4 )); + +static const struct txpwr_map __txpwr_map_byr = { + .ent = __txpwr_ent_byr, + .size =ARRAY_SIZE (__txpwr_ent_byr), + .addr_from =R_AX_PWR_BY_RATE , + .addr_to =R_AX_PWR_BY_RATE_MAX , +}; + +static const struct txpwr_ent __txpwr_ent_lmt[] = { +/* 1TX */ +__GEN_TXPWR_ENT2 ("CCK_1TX_20M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("CCK_1TX_40M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("OFDM_1TX " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_2 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_3 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_4 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_5 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_6 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_20M_7 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_2 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_3 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_80M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_80M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_160M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_0p5" ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_1TX_40M_2p5" ,"NON_BF" ,"BF" ), +/* 2TX */ +__GEN_TXPWR_ENT2 ("CCK_2TX_20M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("CCK_2TX_40M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("OFDM_2TX " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_2 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_3 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_4 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_5 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_6 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_20M_7 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_2 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_3 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_80M_0 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_80M_1 " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_160M " ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_0p5" ,"NON_BF" ,"BF" ), +__GEN_TXPWR_ENT2 ("MCS_2TX_40M_2p5" ,"NON_BF" ,"BF" ), +}; + +static_assert ((ARRAY_SIZE (__txpwr_ent_lmt) *2 ) == + (R_AX_PWR_LMT_MAX -R_AX_PWR_LMT +4 )); + +static const struct txpwr_map __txpwr_map_lmt = { + .ent = __txpwr_ent_lmt, + .size =ARRAY_SIZE (__txpwr_ent_lmt), + .addr_from =R_AX_PWR_LMT , + .addr_to =R_AX_PWR_LMT_MAX , +}; + +static const struct txpwr_ent __txpwr_ent_lmt_ru[] = { +/* 1TX */ +__GEN_TXPWR_ENT8 ("1TX" ,"RU26__0" ,"RU26__1" ,"RU26__2" ,"RU26__3" , +"RU26__4" ,"RU26__5" ,"RU26__6" ,"RU26__7" ), +__GEN_TXPWR_ENT8 ("1TX" ,"RU52__0" ,"RU52__1" ,"RU52__2" ,"RU52__3" , +"RU52__4" ,"RU52__5" ,"RU52__6" ,"RU52__7" ), +__GEN_TXPWR_ENT8 ("1TX" ,"RU106_0" ,"RU106_1" ,"RU106_2" ,"RU106_3" , +"RU106_4" ,"RU106_5" ,"RU106_6" ,"RU106_7" ), +/* 2TX */ +__GEN_TXPWR_ENT8 ("2TX" ,"RU26__0" ,"RU26__1" ,"RU26__2" ,"RU26__3" , +"RU26__4" ,"RU26__5" ,"RU26__6" ,"RU26__7" ), +__GEN_TXPWR_ENT8 ("2TX" ,"RU52__0" ,"RU52__1" ,"RU52__2" ,"RU52__3" , +"RU52__4" ,"RU52__5" ,"RU52__6" ,"RU52__7" ), +__GEN_TXPWR_ENT8 ("2TX" ,"RU106_0" ,"RU106_1" ,"RU106_2" ,"RU106_3" , +"RU106_4" ,"RU106_5" ,"RU106_6" ,"RU106_7" ), +}; + +static_assert ((ARRAY_SIZE (__txpwr_ent_lmt_ru) *8 ) == + (R_AX_PWR_RU_LMT_MAX -R_AX_PWR_RU_LMT +4 )); + +static const struct txpwr_map __txpwr_map_lmt_ru = { + .ent = __txpwr_ent_lmt_ru, + .size =ARRAY_SIZE (__txpwr_ent_lmt_ru), + .addr_from =R_AX_PWR_RU_LMT , + .addr_to =R_AX_PWR_RU_LMT_MAX , +}; + +static u8 __print_txpwr_ent (struct seq_file *m,const struct txpwr_ent *ent, +const u8 *buf,const u8 cur) +{ +char *fmt; + +switch (ent->len) { +case 2 : + fmt ="%s\t| %3d, %3d,\tdBm\n" ; +seq_printf (m, fmt, ent->txt, buf[cur], buf[cur +1 ]); +return 2 ; +case 4 : + fmt ="%s\t| %3d, %3d, %3d, %3d,\tdBm\n" ; +seq_printf (m, fmt, ent->txt, buf[cur], buf[cur +1 ], + buf[cur +2 ], buf[cur +3 ]); +return 4 ; +case 8 : + fmt ="%s\t| %3d, %3d, %3d, %3d, %3d, %3d, %3d, %3d,\tdBm\n" ; +seq_printf (m, fmt, ent->txt, buf[cur], buf[cur +1 ], + buf[cur +2 ], buf[cur +3 ], buf[cur +4 ], + buf[cur +5 ], buf[cur +6 ], buf[cur +7 ]); +return 8 ; +default : +return 0 ; + } +} + +static int __print_txpwr_map (struct seq_file *m,struct rtw89_dev *rtwdev, +const struct txpwr_map *map) +{ +u8 fct = rtwdev->chip->txpwr_factor_mac; +u8 *buf, cur, i; +u32 val, addr; +int ret; + + buf =vzalloc (map->addr_to - map->addr_from +4 ); +if (!buf) +return -ENOMEM ; + +for (addr = map->addr_from; addr <= map->addr_to; addr +=4 ) { + ret =rtw89_mac_txpwr_read32 (rtwdev,RTW89_PHY_0 , addr, &val); +if (ret) + val =MASKDWORD ; + + cur = addr - map->addr_from; +for (i =0 ; i <4 ; i++, val >>=8 ) + buf[cur + i] =FIELD_GET (MASKBYTE0 , val) >> fct; + } + +for (cur =0 , i =0 ; i < map->size; i++) + cur +=__print_txpwr_ent (m, &map->ent[i], buf, cur); + +vfree (buf); +return 0 ; +} + +#define case_REGD (_regd) \ + case RTW89_ ## _regd: \ + seq_puts(m, #_regd "\n"); \ + break + +static void __print_regd (struct seq_file *m,struct rtw89_dev *rtwdev) +{ +u8 band = rtwdev->hal.current_band_type; +u8 regd =rtw89_regd_get (rtwdev, band); + +switch (regd) { +default : +seq_printf (m,"UNKNOWN: %d\n" , regd); +break ; +case_REGD (WW ); +case_REGD (ETSI ); +case_REGD (FCC ); +case_REGD (MKK ); +case_REGD (NA ); +case_REGD (IC ); +case_REGD (KCC ); +case_REGD (NCC ); +case_REGD (CHILE ); +case_REGD (ACMA ); +case_REGD (MEXICO ); +case_REGD (UKRAINE ); +case_REGD (CN ); + } +} + +#undef case_REGD + +static int rtw89_debug_priv_txpwr_table_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +int ret =0 ; + +mutex_lock (&rtwdev->mutex); +rtw89_leave_ps_mode (rtwdev); + +seq_puts (m,"[Regulatory] " ); +__print_regd (m, rtwdev); + +seq_puts (m,"[SAR]\n" ); +rtw89_print_sar (m, rtwdev); + +seq_puts (m,"\n[TX power byrate]\n" ); + ret =__print_txpwr_map (m, rtwdev, &__txpwr_map_byr); +if (ret) + goto err; + +seq_puts (m,"\n[TX power limit]\n" ); + ret =__print_txpwr_map (m, rtwdev, &__txpwr_map_lmt); +if (ret) + goto err; + +seq_puts (m,"\n[TX power limit_ru]\n" ); + ret =__print_txpwr_map (m, rtwdev, &__txpwr_map_lmt_ru); +if (ret) + goto err; + +err: +mutex_unlock (&rtwdev->mutex); +return ret; +} + +static ssize_t +rtw89_debug_priv_mac_reg_dump_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +int sel; +int ret; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + ret =kstrtoint (buf,0 , &sel); +if (ret) +return ret; + +if (sel <RTW89_DBG_SEL_MAC_00 || sel >RTW89_DBG_SEL_RFC ) { +rtw89_info (rtwdev,"invalid args: %d\n" , sel); +return -EINVAL ; + } + + debugfs_priv->cb_data = sel; +rtw89_info (rtwdev,"select mac page dump %d\n" , debugfs_priv->cb_data); + +return count; +} + +#define RTW89_MAC_PAGE_SIZE 0x100 + +static int rtw89_debug_priv_mac_reg_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +enum rtw89_debug_mac_reg_sel reg_sel = debugfs_priv->cb_data; +u32 start, end; +u32 i, j, k, page; +u32 val; + +switch (reg_sel) { +case RTW89_DBG_SEL_MAC_00 : +seq_puts (m,"Debug selected MAC page 0x00\n" ); + start =0x000 ; + end =0x014 ; +break ; +case RTW89_DBG_SEL_MAC_40 : +seq_puts (m,"Debug selected MAC page 0x40\n" ); + start =0x040 ; + end =0x07f ; +break ; +case RTW89_DBG_SEL_MAC_80 : +seq_puts (m,"Debug selected MAC page 0x80\n" ); + start =0x080 ; + end =0x09f ; +break ; +case RTW89_DBG_SEL_MAC_C0 : +seq_puts (m,"Debug selected MAC page 0xc0\n" ); + start =0x0c0 ; + end =0x0df ; +break ; +case RTW89_DBG_SEL_MAC_E0 : +seq_puts (m,"Debug selected MAC page 0xe0\n" ); + start =0x0e0 ; + end =0x0ff ; +break ; +case RTW89_DBG_SEL_BB : +seq_puts (m,"Debug selected BB register\n" ); + start =0x100 ; + end =0x17f ; +break ; +case RTW89_DBG_SEL_IQK : +seq_puts (m,"Debug selected IQK register\n" ); + start =0x180 ; + end =0x1bf ; +break ; +case RTW89_DBG_SEL_RFC : +seq_puts (m,"Debug selected RFC register\n" ); + start =0x1c0 ; + end =0x1ff ; +break ; +default : +seq_puts (m,"Selected invalid register page\n" ); +return -EINVAL ; + } + +for (i = start; i <= end; i++) { + page = i <<8 ; +for (j = page; j < page +RTW89_MAC_PAGE_SIZE ; j +=16 ) { +seq_printf (m,"%08xh : " ,0x18600000 + j); +for (k =0 ; k <4 ; k++) { + val =rtw89_read32 (rtwdev, j + (k <<2 )); +seq_printf (m,"%08x " , val); + } +seq_puts (m,"\n" ); + } + } + +return 0 ; +} + +static ssize_t +rtw89_debug_priv_mac_mem_dump_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 sel, start_addr, len; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%x %x %x" , &sel, &start_addr, &len); +if (num !=3 ) { +rtw89_info (rtwdev,"invalid format: <sel> <start> <len>\n" ); +return -EINVAL ; + } + + debugfs_priv->mac_mem.sel = sel; + debugfs_priv->mac_mem.start = start_addr; + debugfs_priv->mac_mem.len = len; + +rtw89_info (rtwdev,"select mem %d start %d len %d\n" , + sel, start_addr, len); + +return count; +} + +static const u32 mac_mem_base_addr_table[RTW89_MAC_MEM_MAX ] = { + [RTW89_MAC_MEM_SHARED_BUF ] =SHARED_BUF_BASE_ADDR , + [RTW89_MAC_MEM_DMAC_TBL ] =DMAC_TBL_BASE_ADDR , + [RTW89_MAC_MEM_SHCUT_MACHDR ] =SHCUT_MACHDR_BASE_ADDR , + [RTW89_MAC_MEM_STA_SCHED ] =STA_SCHED_BASE_ADDR , + [RTW89_MAC_MEM_RXPLD_FLTR_CAM ] =RXPLD_FLTR_CAM_BASE_ADDR , + [RTW89_MAC_MEM_SECURITY_CAM ] =SECURITY_CAM_BASE_ADDR , + [RTW89_MAC_MEM_WOW_CAM ] =WOW_CAM_BASE_ADDR , + [RTW89_MAC_MEM_CMAC_TBL ] =CMAC_TBL_BASE_ADDR , + [RTW89_MAC_MEM_ADDR_CAM ] =ADDR_CAM_BASE_ADDR , + [RTW89_MAC_MEM_BA_CAM ] =BA_CAM_BASE_ADDR , + [RTW89_MAC_MEM_BCN_IE_CAM0 ] =BCN_IE_CAM0_BASE_ADDR , + [RTW89_MAC_MEM_BCN_IE_CAM1 ] =BCN_IE_CAM1_BASE_ADDR , +}; + +static void rtw89_debug_dump_mac_mem (struct seq_file *m, +struct rtw89_dev *rtwdev, +u8 sel,u32 start_addr,u32 len) +{ +u32 base_addr, start_page, residue; +u32 i, j, p, pages; +u32 dump_len, remain; +u32 val; + + remain = len; + pages = len /MAC_MEM_DUMP_PAGE_SIZE +1 ; + start_page = start_addr /MAC_MEM_DUMP_PAGE_SIZE ; + residue = start_addr %MAC_MEM_DUMP_PAGE_SIZE ; + base_addr = mac_mem_base_addr_table[sel]; + base_addr += start_page *MAC_MEM_DUMP_PAGE_SIZE ; + +for (p =0 ; p < pages; p++) { + dump_len =min_t (u32, remain,MAC_MEM_DUMP_PAGE_SIZE ); +rtw89_write32 (rtwdev,R_AX_FILTER_MODEL_ADDR , base_addr); +for (i =R_AX_INDIR_ACCESS_ENTRY + residue; + i <R_AX_INDIR_ACCESS_ENTRY + dump_len;) { +seq_printf (m,"%08xh:" , i); +for (j =0 ; + j <4 && i <R_AX_INDIR_ACCESS_ENTRY + dump_len; + j++, i +=4 ) { + val =rtw89_read32 (rtwdev, i); +seq_printf (m," %08x" , val); + remain -=4 ; + } +seq_puts (m,"\n" ); + } + base_addr +=MAC_MEM_DUMP_PAGE_SIZE ; + } +} + +static int +rtw89_debug_priv_mac_mem_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; + +mutex_lock (&rtwdev->mutex); +rtw89_leave_ps_mode (rtwdev); +rtw89_debug_dump_mac_mem (m, rtwdev, + debugfs_priv->mac_mem.sel, + debugfs_priv->mac_mem.start, + debugfs_priv->mac_mem.len); +mutex_unlock (&rtwdev->mutex); + +return 0 ; +} + +static ssize_t +rtw89_debug_priv_mac_dbg_port_dump_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +int sel, set; +int num; +bool enable; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%d %d" , &sel, &set); +if (num !=2 ) { +rtw89_info (rtwdev,"invalid format: <sel> <set>\n" ); +return -EINVAL ; + } + + enable = set ==0 ? false : true; +switch (sel) { +case 0 : + debugfs_priv->dbgpkg_en.ss_dbg = enable; +break ; +case 1 : + debugfs_priv->dbgpkg_en.dle_dbg = enable; +break ; +case 2 : + debugfs_priv->dbgpkg_en.dmac_dbg = enable; +break ; +case 3 : + debugfs_priv->dbgpkg_en.cmac_dbg = enable; +break ; +case 4 : + debugfs_priv->dbgpkg_en.dbg_port = enable; +break ; +default : +rtw89_info (rtwdev,"invalid args: sel %d set %d\n" , sel, set); +return -EINVAL ; + } + +rtw89_info (rtwdev,"%s debug port dump %d\n" , + enable ?"Enable" :"Disable" , sel); + +return count; +} + +static int rtw89_debug_mac_dump_ss_dbg (struct rtw89_dev *rtwdev, +struct seq_file *m) +{ +return 0 ; +} + +static int rtw89_debug_mac_dump_dle_dbg (struct rtw89_dev *rtwdev, +struct seq_file *m) +{ +#define DLE_DFI_DUMP (__type, __target, __sel) \ +({ \ + u32 __ctrl; \ + u32 __reg_ctrl = R_AX_##__type##_DBG_FUN_INTF_CTL; \ + u32 __reg_data = R_AX_##__type##_DBG_FUN_INTF_DATA; \ + u32 __data, __val32; \ + int __ret; \ + \ + __ctrl = FIELD_PREP(B_AX_##__type##_DFI_TRGSEL, \ + DLE_DFI_TYPE_##__target) | \ + FIELD_PREP(B_AX_##__type##_DFI_ADDR, __sel) | \ + B_AX_WDE_DFI_ACTIVE; \ + rtw89_write32(rtwdev, __reg_ctrl, __ctrl); \ + __ret = read_poll_timeout(rtw89_read32, __val32, \ + !(__val32 & B_AX_##__type##_DFI_ACTIVE), \ + 1000, 50000, false, \ + rtwdev, __reg_ctrl); \ + if (__ret) { \ + rtw89_err(rtwdev, "failed to dump DLE %s %s %d\n", \ + #__type, #__target, __sel); \ + return __ret; \ + } \ + \ + __data = rtw89_read32(rtwdev, __reg_data); \ + __data; \ +}) + +#define DLE_DFI_FREE_PAGE_DUMP (__m, __type) \ +({ \ + u32 __freepg, __pubpg; \ + u32 __freepg_head, __freepg_tail, __pubpg_num; \ + \ + __freepg = DLE_DFI_DUMP(__type, FREEPG, 0); \ + __pubpg = DLE_DFI_DUMP(__type, FREEPG, 1); \ + __freepg_head = FIELD_GET(B_AX_DLE_FREE_HEADPG, __freepg); \ + __freepg_tail = FIELD_GET(B_AX_DLE_FREE_TAILPG, __freepg); \ + __pubpg_num = FIELD_GET(B_AX_DLE_PUB_PGNUM, __pubpg); \ + seq_printf(__m, "[%s] freepg head: %d\n", \ + #__type, __freepg_head); \ + seq_printf(__m, "[%s] freepg tail: %d\n", \ + #__type, __freepg_tail); \ + seq_printf(__m, "[%s] pubpg num : %d\n", \ + #__type, __pubpg_num); \ +}) + +#define case_QUOTA (__m, __type, __id) \ + case __type##_QTAID_##__id: \ + val32 = DLE_DFI_DUMP(__type, QUOTA, __type##_QTAID_##__id); \ + rsv_pgnum = FIELD_GET(B_AX_DLE_RSV_PGNUM, val32); \ + use_pgnum = FIELD_GET(B_AX_DLE_USE_PGNUM, val32); \ + seq_printf(__m, "[%s][%s] rsv_pgnum: %d\n", \ + #__type, #__id, rsv_pgnum); \ + seq_printf(__m, "[%s][%s] use_pgnum: %d\n", \ + #__type, #__id, use_pgnum); \ + break +u32 quota_id; +u32 val32; +u16 rsv_pgnum, use_pgnum; +int ret; + + ret =rtw89_mac_check_mac_en (rtwdev,0 ,RTW89_DMAC_SEL ); +if (ret) { +seq_puts (m,"[DLE] : DMAC not enabled\n" ); +return ret; + } + +DLE_DFI_FREE_PAGE_DUMP (m,WDE ); +DLE_DFI_FREE_PAGE_DUMP (m,PLE ); +for (quota_id =0 ; quota_id <=WDE_QTAID_CPUIO ; quota_id++) { +switch (quota_id) { +case_QUOTA (m,WDE ,HOST_IF ); +case_QUOTA (m,WDE ,WLAN_CPU ); +case_QUOTA (m,WDE ,DATA_CPU ); +case_QUOTA (m,WDE ,PKTIN ); +case_QUOTA (m,WDE ,CPUIO ); + } + } +for (quota_id =0 ; quota_id <=PLE_QTAID_CPUIO ; quota_id++) { +switch (quota_id) { +case_QUOTA (m,PLE ,B0_TXPL ); +case_QUOTA (m,PLE ,B1_TXPL ); +case_QUOTA (m,PLE ,C2H ); +case_QUOTA (m,PLE ,H2C ); +case_QUOTA (m,PLE ,WLAN_CPU ); +case_QUOTA (m,PLE ,MPDU ); +case_QUOTA (m,PLE ,CMAC0_RX ); +case_QUOTA (m,PLE ,CMAC1_RX ); +case_QUOTA (m,PLE ,CMAC1_BBRPT ); +case_QUOTA (m,PLE ,WDRLS ); +case_QUOTA (m,PLE ,CPUIO ); + } + } + +return 0 ; + +#undef case_QUOTA +#undef DLE_DFI_DUMP +#undef DLE_DFI_FREE_PAGE_DUMP +} + +static int rtw89_debug_mac_dump_dmac_dbg (struct rtw89_dev *rtwdev, +struct seq_file *m) +{ +int ret; + + ret =rtw89_mac_check_mac_en (rtwdev,0 ,RTW89_DMAC_SEL ); +if (ret) { +seq_puts (m,"[DMAC] : DMAC not enabled\n" ); +return ret; + } + +seq_printf (m,"R_AX_DMAC_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_DMAC_ERR_ISR )); +seq_printf (m,"[0]R_AX_WDRLS_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_WDRLS_ERR_ISR )); +seq_printf (m,"[1]R_AX_SEC_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_SEC_ERR_IMR_ISR )); +seq_printf (m,"[2.1]R_AX_MPDU_TX_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_MPDU_TX_ERR_ISR )); +seq_printf (m,"[2.2]R_AX_MPDU_RX_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_MPDU_RX_ERR_ISR )); +seq_printf (m,"[3]R_AX_STA_SCHEDULER_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_STA_SCHEDULER_ERR_ISR )); +seq_printf (m,"[4]R_AX_WDE_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_WDE_ERR_ISR )); +seq_printf (m,"[5.1]R_AX_TXPKTCTL_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TXPKTCTL_ERR_IMR_ISR )); +seq_printf (m,"[5.2]R_AX_TXPKTCTL_ERR_IMR_ISR_B1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TXPKTCTL_ERR_IMR_ISR_B1 )); +seq_printf (m,"[6]R_AX_PLE_ERR_FLAG_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_PLE_ERR_FLAG_ISR )); +seq_printf (m,"[7]R_AX_PKTIN_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_PKTIN_ERR_ISR )); +seq_printf (m,"[8.1]R_AX_OTHER_DISPATCHER_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_OTHER_DISPATCHER_ERR_ISR )); +seq_printf (m,"[8.2]R_AX_HOST_DISPATCHER_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_HOST_DISPATCHER_ERR_ISR )); +seq_printf (m,"[8.3]R_AX_CPU_DISPATCHER_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_CPU_DISPATCHER_ERR_ISR )); +seq_printf (m,"[10]R_AX_CPUIO_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_CPUIO_ERR_ISR )); +seq_printf (m,"[11.1]R_AX_BBRPT_COM_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_BBRPT_COM_ERR_IMR_ISR )); +seq_printf (m,"[11.2]R_AX_BBRPT_CHINFO_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_BBRPT_CHINFO_ERR_IMR_ISR )); +seq_printf (m,"[11.3]R_AX_BBRPT_DFS_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_BBRPT_DFS_ERR_IMR_ISR )); +seq_printf (m,"[11.4]R_AX_LA_ERRFLAG=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_LA_ERRFLAG )); + +return 0 ; +} + +static int rtw89_debug_mac_dump_cmac_dbg (struct rtw89_dev *rtwdev, +struct seq_file *m) +{ +int ret; + + ret =rtw89_mac_check_mac_en (rtwdev,0 ,RTW89_CMAC_SEL ); +if (ret) { +seq_puts (m,"[CMAC] : CMAC 0 not enabled\n" ); +return ret; + } + +seq_printf (m,"R_AX_CMAC_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_CMAC_ERR_ISR )); +seq_printf (m,"[0]R_AX_SCHEDULE_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_SCHEDULE_ERR_ISR )); +seq_printf (m,"[1]R_AX_PTCL_ISR0=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_PTCL_ISR0 )); +seq_printf (m,"[3]R_AX_DLE_CTRL=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_DLE_CTRL )); +seq_printf (m,"[4]R_AX_PHYINFO_ERR_ISR=0x%02x\n" , +rtw89_read8 (rtwdev,R_AX_PHYINFO_ERR_ISR )); +seq_printf (m,"[5]R_AX_TXPWR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TXPWR_ISR )); +seq_printf (m,"[6]R_AX_RMAC_ERR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_RMAC_ERR_ISR )); +seq_printf (m,"[7]R_AX_TMAC_ERR_IMR_ISR=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TMAC_ERR_IMR_ISR )); + + ret =rtw89_mac_check_mac_en (rtwdev,1 ,RTW89_CMAC_SEL ); +if (ret) { +seq_puts (m,"[CMAC] : CMAC 1 not enabled\n" ); +return ret; + } + +seq_printf (m,"R_AX_CMAC_ERR_ISR_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_CMAC_ERR_ISR_C1 )); +seq_printf (m,"[0]R_AX_SCHEDULE_ERR_ISR_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_SCHEDULE_ERR_ISR_C1 )); +seq_printf (m,"[1]R_AX_PTCL_ISR0_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_PTCL_ISR0_C1 )); +seq_printf (m,"[3]R_AX_DLE_CTRL_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_DLE_CTRL_C1 )); +seq_printf (m,"[4]R_AX_PHYINFO_ERR_ISR_C1=0x%02x\n" , +rtw89_read8 (rtwdev,R_AX_PHYINFO_ERR_ISR_C1 )); +seq_printf (m,"[5]R_AX_TXPWR_ISR_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TXPWR_ISR_C1 )); +seq_printf (m,"[6]R_AX_RMAC_ERR_ISR_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_RMAC_ERR_ISR_C1 )); +seq_printf (m,"[7]R_AX_TMAC_ERR_IMR_ISR_C1=0x%08x\n" , +rtw89_read32 (rtwdev,R_AX_TMAC_ERR_IMR_ISR_C1 )); + +return 0 ; +} + +static const struct rtw89_mac_dbg_port_info dbg_port_ptcl_c0 = { + .sel_addr =R_AX_PTCL_DBG , + .sel_byte =1 , + .sel_msk =B_AX_PTCL_DBG_SEL , + .srt =0x00 , + .end =0x3F , + .rd_addr =R_AX_PTCL_DBG_INFO , + .rd_byte =4 , + .rd_msk =B_AX_PTCL_DBG_INFO_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ptcl_c1 = { + .sel_addr =R_AX_PTCL_DBG_C1 , + .sel_byte =1 , + .sel_msk =B_AX_PTCL_DBG_SEL , + .srt =0x00 , + .end =0x3F , + .rd_addr =R_AX_PTCL_DBG_INFO_C1 , + .rd_byte =4 , + .rd_msk =B_AX_PTCL_DBG_INFO_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_sch_c0 = { + .sel_addr =R_AX_SCH_DBG_SEL , + .sel_byte =1 , + .sel_msk =B_AX_SCH_DBG_SEL_MSK , + .srt =0x00 , + .end =0x2F , + .rd_addr =R_AX_SCH_DBG , + .rd_byte =4 , + .rd_msk =B_AX_SCHEDULER_DBG_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_sch_c1 = { + .sel_addr =R_AX_SCH_DBG_SEL_C1 , + .sel_byte =1 , + .sel_msk =B_AX_SCH_DBG_SEL_MSK , + .srt =0x00 , + .end =0x2F , + .rd_addr =R_AX_SCH_DBG_C1 , + .rd_byte =4 , + .rd_msk =B_AX_SCHEDULER_DBG_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tmac_c0 = { + .sel_addr =R_AX_MACTX_DBG_SEL_CNT , + .sel_byte =1 , + .sel_msk =B_AX_DBGSEL_MACTX , + .srt =0x00 , + .end =0x19 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tmac_c1 = { + .sel_addr =R_AX_MACTX_DBG_SEL_CNT_C1 , + .sel_byte =1 , + .sel_msk =B_AX_DBGSEL_MACTX , + .srt =0x00 , + .end =0x19 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmac_c0 = { + .sel_addr =R_AX_RX_DEBUG_SELECT , + .sel_byte =1 , + .sel_msk =B_AX_DEBUG_SEL , + .srt =0x00 , + .end =0x58 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmac_c1 = { + .sel_addr =R_AX_RX_DEBUG_SELECT_C1 , + .sel_byte =1 , + .sel_msk =B_AX_DEBUG_SEL , + .srt =0x00 , + .end =0x58 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmacst_c0 = { + .sel_addr =R_AX_RX_STATE_MONITOR , + .sel_byte =1 , + .sel_msk =B_AX_STATE_SEL , + .srt =0x00 , + .end =0x17 , + .rd_addr =R_AX_RX_STATE_MONITOR , + .rd_byte =4 , + .rd_msk =R_AX_RX_STATE_MONITOR_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmacst_c1 = { + .sel_addr =R_AX_RX_STATE_MONITOR_C1 , + .sel_byte =1 , + .sel_msk =B_AX_STATE_SEL , + .srt =0x00 , + .end =0x17 , + .rd_addr =R_AX_RX_STATE_MONITOR_C1 , + .rd_byte =4 , + .rd_msk =R_AX_RX_STATE_MONITOR_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmac_plcp_c0 = { + .sel_addr =R_AX_RMAC_PLCP_MON , + .sel_byte =4 , + .sel_msk =B_AX_PCLP_MON_SEL , + .srt =0x0 , + .end =0xF , + .rd_addr =R_AX_RMAC_PLCP_MON , + .rd_byte =4 , + .rd_msk =R_AX_RMAC_PLCP_MON_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_rmac_plcp_c1 = { + .sel_addr =R_AX_RMAC_PLCP_MON_C1 , + .sel_byte =4 , + .sel_msk =B_AX_PCLP_MON_SEL , + .srt =0x0 , + .end =0xF , + .rd_addr =R_AX_RMAC_PLCP_MON_C1 , + .rd_byte =4 , + .rd_msk =R_AX_RMAC_PLCP_MON_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_trxptcl_c0 = { + .sel_addr =R_AX_DBGSEL_TRXPTCL , + .sel_byte =1 , + .sel_msk =B_AX_DBGSEL_TRXPTCL_MSK , + .srt =0x08 , + .end =0x10 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_trxptcl_c1 = { + .sel_addr =R_AX_DBGSEL_TRXPTCL_C1 , + .sel_byte =1 , + .sel_msk =B_AX_DBGSEL_TRXPTCL_MSK , + .srt =0x08 , + .end =0x10 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tx_infol_c0 = { + .sel_addr =R_AX_WMAC_TX_CTRL_DEBUG , + .sel_byte =1 , + .sel_msk =B_AX_TX_CTRL_DEBUG_SEL , + .srt =0x00 , + .end =0x07 , + .rd_addr =R_AX_WMAC_TX_INFO0_DEBUG , + .rd_byte =4 , + .rd_msk =B_AX_TX_CTRL_INFO_P0_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tx_infoh_c0 = { + .sel_addr =R_AX_WMAC_TX_CTRL_DEBUG , + .sel_byte =1 , + .sel_msk =B_AX_TX_CTRL_DEBUG_SEL , + .srt =0x00 , + .end =0x07 , + .rd_addr =R_AX_WMAC_TX_INFO1_DEBUG , + .rd_byte =4 , + .rd_msk =B_AX_TX_CTRL_INFO_P1_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tx_infol_c1 = { + .sel_addr =R_AX_WMAC_TX_CTRL_DEBUG_C1 , + .sel_byte =1 , + .sel_msk =B_AX_TX_CTRL_DEBUG_SEL , + .srt =0x00 , + .end =0x07 , + .rd_addr =R_AX_WMAC_TX_INFO0_DEBUG_C1 , + .rd_byte =4 , + .rd_msk =B_AX_TX_CTRL_INFO_P0_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_tx_infoh_c1 = { + .sel_addr =R_AX_WMAC_TX_CTRL_DEBUG_C1 , + .sel_byte =1 , + .sel_msk =B_AX_TX_CTRL_DEBUG_SEL , + .srt =0x00 , + .end =0x07 , + .rd_addr =R_AX_WMAC_TX_INFO1_DEBUG_C1 , + .rd_byte =4 , + .rd_msk =B_AX_TX_CTRL_INFO_P1_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_txtf_infol_c0 = { + .sel_addr =R_AX_WMAC_TX_TF_INFO_0 , + .sel_byte =1 , + .sel_msk =B_AX_WMAC_TX_TF_INFO_SEL , + .srt =0x00 , + .end =0x04 , + .rd_addr =R_AX_WMAC_TX_TF_INFO_1 , + .rd_byte =4 , + .rd_msk =B_AX_WMAC_TX_TF_INFO_P0 +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_txtf_infoh_c0 = { + .sel_addr =R_AX_WMAC_TX_TF_INFO_0 , + .sel_byte =1 , + .sel_msk =B_AX_WMAC_TX_TF_INFO_SEL , + .srt =0x00 , + .end =0x04 , + .rd_addr =R_AX_WMAC_TX_TF_INFO_2 , + .rd_byte =4 , + .rd_msk =B_AX_WMAC_TX_TF_INFO_P1 +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_txtf_infol_c1 = { + .sel_addr =R_AX_WMAC_TX_TF_INFO_0_C1 , + .sel_byte =1 , + .sel_msk =B_AX_WMAC_TX_TF_INFO_SEL , + .srt =0x00 , + .end =0x04 , + .rd_addr =R_AX_WMAC_TX_TF_INFO_1_C1 , + .rd_byte =4 , + .rd_msk =B_AX_WMAC_TX_TF_INFO_P0 +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_txtf_infoh_c1 = { + .sel_addr =R_AX_WMAC_TX_TF_INFO_0_C1 , + .sel_byte =1 , + .sel_msk =B_AX_WMAC_TX_TF_INFO_SEL , + .srt =0x00 , + .end =0x04 , + .rd_addr =R_AX_WMAC_TX_TF_INFO_2_C1 , + .rd_byte =4 , + .rd_msk =B_AX_WMAC_TX_TF_INFO_P1 +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_bufmgn_freepg = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80000000 , + .end =0x80000001 , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_bufmgn_quota = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80010000 , + .end =0x80010004 , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_bufmgn_pagellt = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80020000 , + .end =0x80020FFF , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_bufmgn_pktinfo = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80030000 , + .end =0x80030FFF , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_quemgn_prepkt = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80040000 , + .end =0x80040FFF , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_quemgn_nxtpkt = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80050000 , + .end =0x80050FFF , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_quemgn_qlnktbl = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80060000 , + .end =0x80060453 , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_wde_quemgn_qempty = { + .sel_addr =R_AX_WDE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_WDE_DFI_DATA_MSK , + .srt =0x80070000 , + .end =0x80070011 , + .rd_addr =R_AX_WDE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_WDE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_bufmgn_freepg = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80000000 , + .end =0x80000001 , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_bufmgn_quota = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80010000 , + .end =0x8001000A , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_bufmgn_pagellt = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80020000 , + .end =0x80020DBF , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_bufmgn_pktinfo = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80030000 , + .end =0x80030DBF , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_quemgn_prepkt = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80040000 , + .end =0x80040DBF , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_quemgn_nxtpkt = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80050000 , + .end =0x80050DBF , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_quemgn_qlnktbl = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80060000 , + .end =0x80060041 , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_ple_quemgn_qempty = { + .sel_addr =R_AX_PLE_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_PLE_DFI_DATA_MSK , + .srt =0x80070000 , + .end =0x80070001 , + .rd_addr =R_AX_PLE_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_PLE_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pktinfo = { + .sel_addr =R_AX_DBG_FUN_INTF_CTL , + .sel_byte =4 , + .sel_msk =B_AX_DFI_DATA_MSK , + .srt =0x80000000 , + .end =0x8000017f , + .rd_addr =R_AX_DBG_FUN_INTF_DATA , + .rd_byte =4 , + .rd_msk =B_AX_DFI_DATA_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_txdma = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x03 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_rxdma = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x04 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_cvt = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x01 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_cxpl = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x05 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_io = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x05 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_misc = { + .sel_addr =R_AX_PCIE_DBG_CTRL , + .sel_byte =2 , + .sel_msk =B_AX_LOOPBACK_DBG_SEL , + .srt =0x00 , + .end =0x06 , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info dbg_port_pcie_misc2 = { + .sel_addr =R_AX_DBG_CTRL , + .sel_byte =1 , + .sel_msk =B_AX_DBG_SEL0 , + .srt =0x34 , + .end =0x3C , + .rd_addr =R_AX_DBG_PORT_SEL , + .rd_byte =4 , + .rd_msk =B_AX_DEBUG_ST_MSK +}; + +static const struct rtw89_mac_dbg_port_info * +rtw89_debug_mac_dbg_port_sel (struct seq_file *m, +struct rtw89_dev *rtwdev,u32 sel) +{ +const struct rtw89_mac_dbg_port_info *info; +u32 val32; +u16 val16; +u8 val8; + +switch (sel) { +case RTW89_DBG_PORT_SEL_PTCL_C0 : + info = &dbg_port_ptcl_c0; + val16 =rtw89_read16 (rtwdev,R_AX_PTCL_DBG ); + val16 |=B_AX_PTCL_DBG_EN ; +rtw89_write16 (rtwdev,R_AX_PTCL_DBG , val16); +seq_puts (m,"Enable PTCL C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PTCL_C1 : + info = &dbg_port_ptcl_c1; + val16 =rtw89_read16 (rtwdev,R_AX_PTCL_DBG_C1 ); + val16 |=B_AX_PTCL_DBG_EN ; +rtw89_write16 (rtwdev,R_AX_PTCL_DBG_C1 , val16); +seq_puts (m,"Enable PTCL C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_SCH_C0 : + info = &dbg_port_sch_c0; + val32 =rtw89_read32 (rtwdev,R_AX_SCH_DBG_SEL ); + val32 |=B_AX_SCH_DBG_EN ; +rtw89_write32 (rtwdev,R_AX_SCH_DBG_SEL , val32); +seq_puts (m,"Enable SCH C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_SCH_C1 : + info = &dbg_port_sch_c1; + val32 =rtw89_read32 (rtwdev,R_AX_SCH_DBG_SEL_C1 ); + val32 |=B_AX_SCH_DBG_EN ; +rtw89_write32 (rtwdev,R_AX_SCH_DBG_SEL_C1 , val32); +seq_puts (m,"Enable SCH C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TMAC_C0 : + info = &dbg_port_tmac_c0; + val32 =rtw89_read32 (rtwdev,R_AX_DBGSEL_TRXPTCL ); + val32 =u32_replace_bits (val32,TRXPTRL_DBG_SEL_TMAC , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write32 (rtwdev,R_AX_DBGSEL_TRXPTCL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,TMAC_DBG_SEL_C0 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,TMAC_DBG_SEL_C0 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); +seq_puts (m,"Enable TMAC C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TMAC_C1 : + info = &dbg_port_tmac_c1; + val32 =rtw89_read32 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 ); + val32 =u32_replace_bits (val32,TRXPTRL_DBG_SEL_TMAC , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write32 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,TMAC_DBG_SEL_C1 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,TMAC_DBG_SEL_C1 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); +seq_puts (m,"Enable TMAC C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMAC_C0 : + info = &dbg_port_rmac_c0; + val32 =rtw89_read32 (rtwdev,R_AX_DBGSEL_TRXPTCL ); + val32 =u32_replace_bits (val32,TRXPTRL_DBG_SEL_RMAC , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write32 (rtwdev,R_AX_DBGSEL_TRXPTCL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,RMAC_DBG_SEL_C0 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,RMAC_DBG_SEL_C0 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); + + val8 =rtw89_read8 (rtwdev,R_AX_DBGSEL_TRXPTCL ); + val8 =u8_replace_bits (val8,RMAC_CMAC_DBG_SEL , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write8 (rtwdev,R_AX_DBGSEL_TRXPTCL , val8); +seq_puts (m,"Enable RMAC C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMAC_C1 : + info = &dbg_port_rmac_c1; + val32 =rtw89_read32 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 ); + val32 =u32_replace_bits (val32,TRXPTRL_DBG_SEL_RMAC , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write32 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,RMAC_DBG_SEL_C1 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,RMAC_DBG_SEL_C1 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); + + val8 =rtw89_read8 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 ); + val8 =u8_replace_bits (val8,RMAC_CMAC_DBG_SEL , +B_AX_DBGSEL_TRXPTCL_MSK ); +rtw89_write8 (rtwdev,R_AX_DBGSEL_TRXPTCL_C1 , val8); +seq_puts (m,"Enable RMAC C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMACST_C0 : + info = &dbg_port_rmacst_c0; +seq_puts (m,"Enable RMAC state C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMACST_C1 : + info = &dbg_port_rmacst_c1; +seq_puts (m,"Enable RMAC state C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMAC_PLCP_C0 : + info = &dbg_port_rmac_plcp_c0; +seq_puts (m,"Enable RMAC PLCP C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_RMAC_PLCP_C1 : + info = &dbg_port_rmac_plcp_c1; +seq_puts (m,"Enable RMAC PLCP C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TRXPTCL_C0 : + info = &dbg_port_trxptcl_c0; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,TRXPTCL_DBG_SEL_C0 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,TRXPTCL_DBG_SEL_C0 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); +seq_puts (m,"Enable TRXPTCL C0 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TRXPTCL_C1 : + info = &dbg_port_trxptcl_c1; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,TRXPTCL_DBG_SEL_C1 ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,TRXPTCL_DBG_SEL_C1 ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); + + val32 =rtw89_read32 (rtwdev,R_AX_SYS_STATUS1 ); + val32 =u32_replace_bits (val32,MAC_DBG_SEL ,B_AX_SEL_0XC0 ); +rtw89_write32 (rtwdev,R_AX_SYS_STATUS1 , val32); +seq_puts (m,"Enable TRXPTCL C1 dbgport.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TX_INFOL_C0 : + info = &dbg_port_tx_infol_c0; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1 , val32); +seq_puts (m,"Enable tx infol dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TX_INFOH_C0 : + info = &dbg_port_tx_infoh_c0; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1 , val32); +seq_puts (m,"Enable tx infoh dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TX_INFOL_C1 : + info = &dbg_port_tx_infol_c1; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1_C1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1_C1 , val32); +seq_puts (m,"Enable tx infol dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TX_INFOH_C1 : + info = &dbg_port_tx_infoh_c1; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1_C1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1_C1 , val32); +seq_puts (m,"Enable tx infoh dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TXTF_INFOL_C0 : + info = &dbg_port_txtf_infol_c0; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1 , val32); +seq_puts (m,"Enable tx tf infol dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TXTF_INFOH_C0 : + info = &dbg_port_txtf_infoh_c0; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1 , val32); +seq_puts (m,"Enable tx tf infoh dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TXTF_INFOL_C1 : + info = &dbg_port_txtf_infol_c1; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1_C1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1_C1 , val32); +seq_puts (m,"Enable tx tf infol dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_TXTF_INFOH_C1 : + info = &dbg_port_txtf_infoh_c1; + val32 =rtw89_read32 (rtwdev,R_AX_TCR1_C1 ); + val32 |=B_AX_TCR_FORCE_READ_TXDFIFO ; +rtw89_write32 (rtwdev,R_AX_TCR1_C1 , val32); +seq_puts (m,"Enable tx tf infoh dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_BUFMGN_FREEPG : + info = &dbg_port_wde_bufmgn_freepg; +seq_puts (m,"Enable wde bufmgn freepg dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_BUFMGN_QUOTA : + info = &dbg_port_wde_bufmgn_quota; +seq_puts (m,"Enable wde bufmgn quota dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_BUFMGN_PAGELLT : + info = &dbg_port_wde_bufmgn_pagellt; +seq_puts (m,"Enable wde bufmgn pagellt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_BUFMGN_PKTINFO : + info = &dbg_port_wde_bufmgn_pktinfo; +seq_puts (m,"Enable wde bufmgn pktinfo dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_QUEMGN_PREPKT : + info = &dbg_port_wde_quemgn_prepkt; +seq_puts (m,"Enable wde quemgn prepkt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_QUEMGN_NXTPKT : + info = &dbg_port_wde_quemgn_nxtpkt; +seq_puts (m,"Enable wde quemgn nxtpkt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_QUEMGN_QLNKTBL : + info = &dbg_port_wde_quemgn_qlnktbl; +seq_puts (m,"Enable wde quemgn qlnktbl dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_WDE_QUEMGN_QEMPTY : + info = &dbg_port_wde_quemgn_qempty; +seq_puts (m,"Enable wde quemgn qempty dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_BUFMGN_FREEPG : + info = &dbg_port_ple_bufmgn_freepg; +seq_puts (m,"Enable ple bufmgn freepg dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_BUFMGN_QUOTA : + info = &dbg_port_ple_bufmgn_quota; +seq_puts (m,"Enable ple bufmgn quota dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_BUFMGN_PAGELLT : + info = &dbg_port_ple_bufmgn_pagellt; +seq_puts (m,"Enable ple bufmgn pagellt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_BUFMGN_PKTINFO : + info = &dbg_port_ple_bufmgn_pktinfo; +seq_puts (m,"Enable ple bufmgn pktinfo dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_QUEMGN_PREPKT : + info = &dbg_port_ple_quemgn_prepkt; +seq_puts (m,"Enable ple quemgn prepkt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_QUEMGN_NXTPKT : + info = &dbg_port_ple_quemgn_nxtpkt; +seq_puts (m,"Enable ple quemgn nxtpkt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_QUEMGN_QLNKTBL : + info = &dbg_port_ple_quemgn_qlnktbl; +seq_puts (m,"Enable ple quemgn qlnktbl dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PLE_QUEMGN_QEMPTY : + info = &dbg_port_ple_quemgn_qempty; +seq_puts (m,"Enable ple quemgn qempty dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PKTINFO : + info = &dbg_port_pktinfo; +seq_puts (m,"Enable pktinfo dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_TXDMA : + info = &dbg_port_pcie_txdma; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_TXDMA_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_TXDMA_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie txdma dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_RXDMA : + info = &dbg_port_pcie_rxdma; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_RXDMA_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_RXDMA_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie rxdma dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_CVT : + info = &dbg_port_pcie_cvt; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_CVT_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_CVT_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie cvt dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_CXPL : + info = &dbg_port_pcie_cxpl; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_CXPL_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_CXPL_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie cxpl dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_IO : + info = &dbg_port_pcie_io; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_IO_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_IO_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie io dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_MISC : + info = &dbg_port_pcie_misc; + val32 =rtw89_read32 (rtwdev,R_AX_DBG_CTRL ); + val32 =u32_replace_bits (val32,PCIE_MISC_DBG_SEL ,B_AX_DBG_SEL0 ); + val32 =u32_replace_bits (val32,PCIE_MISC_DBG_SEL ,B_AX_DBG_SEL1 ); +rtw89_write32 (rtwdev,R_AX_DBG_CTRL , val32); +seq_puts (m,"Enable pcie misc dump.\n" ); +break ; +case RTW89_DBG_PORT_SEL_PCIE_MISC2 : + info = &dbg_port_pcie_misc2; + val16 =rtw89_read16 (rtwdev,R_AX_PCIE_DBG_CTRL ); + val16 =u16_replace_bits (val16,PCIE_MISC2_DBG_SEL , +B_AX_LOOPBACK_DBG_SEL ); +rtw89_write16 (rtwdev,R_AX_PCIE_DBG_CTRL , val16); +seq_puts (m,"Enable pcie misc2 dump.\n" ); +break ; +default : +seq_puts (m,"Dbg port select err\n" ); +return NULL ; + } + +return info; +} + +static bool is_dbg_port_valid (struct rtw89_dev *rtwdev,u32 sel) +{ +if (rtwdev->hci.type !=RTW89_HCI_TYPE_PCIE && + sel >=RTW89_DBG_PORT_SEL_PCIE_TXDMA && + sel <=RTW89_DBG_PORT_SEL_PCIE_MISC2 ) +return false; +if (rtwdev->chip->chip_id ==RTL8852B && + sel >=RTW89_DBG_PORT_SEL_PTCL_C1 && + sel <=RTW89_DBG_PORT_SEL_TXTF_INFOH_C1 ) +return false; +if (rtw89_mac_check_mac_en (rtwdev,0 ,RTW89_DMAC_SEL ) && + sel >=RTW89_DBG_PORT_SEL_WDE_BUFMGN_FREEPG && + sel <=RTW89_DBG_PORT_SEL_PKTINFO ) +return false; +if (rtw89_mac_check_mac_en (rtwdev,0 ,RTW89_CMAC_SEL ) && + sel >=RTW89_DBG_PORT_SEL_PTCL_C0 && + sel <=RTW89_DBG_PORT_SEL_TXTF_INFOH_C0 ) +return false; +if (rtw89_mac_check_mac_en (rtwdev,1 ,RTW89_CMAC_SEL ) && + sel >=RTW89_DBG_PORT_SEL_PTCL_C1 && + sel <=RTW89_DBG_PORT_SEL_TXTF_INFOH_C1 ) +return false; + +return true; +} + +static int rtw89_debug_mac_dbg_port_dump (struct rtw89_dev *rtwdev, +struct seq_file *m,u32 sel) +{ +const struct rtw89_mac_dbg_port_info *info; +u8 val8; +u16 val16; +u32 val32; +u32 i; + + info =rtw89_debug_mac_dbg_port_sel (m, rtwdev, sel); +if (!info) { +rtw89_err (rtwdev,"failed to select debug port %d\n" , sel); +return -EINVAL ; + } + +#define case_DBG_SEL (__sel) \ + case RTW89_DBG_PORT_SEL_##__sel: \ + seq_puts(m, "Dump debug port " #__sel ":\n"); \ + break + +switch (sel) { +case_DBG_SEL (PTCL_C0 ); +case_DBG_SEL (PTCL_C1 ); +case_DBG_SEL (SCH_C0 ); +case_DBG_SEL (SCH_C1 ); +case_DBG_SEL (TMAC_C0 ); +case_DBG_SEL (TMAC_C1 ); +case_DBG_SEL (RMAC_C0 ); +case_DBG_SEL (RMAC_C1 ); +case_DBG_SEL (RMACST_C0 ); +case_DBG_SEL (RMACST_C1 ); +case_DBG_SEL (TRXPTCL_C0 ); +case_DBG_SEL (TRXPTCL_C1 ); +case_DBG_SEL (TX_INFOL_C0 ); +case_DBG_SEL (TX_INFOH_C0 ); +case_DBG_SEL (TX_INFOL_C1 ); +case_DBG_SEL (TX_INFOH_C1 ); +case_DBG_SEL (TXTF_INFOL_C0 ); +case_DBG_SEL (TXTF_INFOH_C0 ); +case_DBG_SEL (TXTF_INFOL_C1 ); +case_DBG_SEL (TXTF_INFOH_C1 ); +case_DBG_SEL (WDE_BUFMGN_FREEPG ); +case_DBG_SEL (WDE_BUFMGN_QUOTA ); +case_DBG_SEL (WDE_BUFMGN_PAGELLT ); +case_DBG_SEL (WDE_BUFMGN_PKTINFO ); +case_DBG_SEL (WDE_QUEMGN_PREPKT ); +case_DBG_SEL (WDE_QUEMGN_NXTPKT ); +case_DBG_SEL (WDE_QUEMGN_QLNKTBL ); +case_DBG_SEL (WDE_QUEMGN_QEMPTY ); +case_DBG_SEL (PLE_BUFMGN_FREEPG ); +case_DBG_SEL (PLE_BUFMGN_QUOTA ); +case_DBG_SEL (PLE_BUFMGN_PAGELLT ); +case_DBG_SEL (PLE_BUFMGN_PKTINFO ); +case_DBG_SEL (PLE_QUEMGN_PREPKT ); +case_DBG_SEL (PLE_QUEMGN_NXTPKT ); +case_DBG_SEL (PLE_QUEMGN_QLNKTBL ); +case_DBG_SEL (PLE_QUEMGN_QEMPTY ); +case_DBG_SEL (PKTINFO ); +case_DBG_SEL (PCIE_TXDMA ); +case_DBG_SEL (PCIE_RXDMA ); +case_DBG_SEL (PCIE_CVT ); +case_DBG_SEL (PCIE_CXPL ); +case_DBG_SEL (PCIE_IO ); +case_DBG_SEL (PCIE_MISC ); +case_DBG_SEL (PCIE_MISC2 ); + } + +#undef case_DBG_SEL + +seq_printf (m,"Sel addr = 0x%X\n" , info->sel_addr); +seq_printf (m,"Read addr = 0x%X\n" , info->rd_addr); + +for (i = info->srt; i <= info->end; i++) { +switch (info->sel_byte) { +case 1 : +default : +rtw89_write8_mask (rtwdev, info->sel_addr, + info->sel_msk, i); +seq_printf (m,"0x%02X: " , i); +break ; +case 2 : +rtw89_write16_mask (rtwdev, info->sel_addr, + info->sel_msk, i); +seq_printf (m,"0x%04X: " , i); +break ; +case 4 : +rtw89_write32_mask (rtwdev, info->sel_addr, + info->sel_msk, i); +seq_printf (m,"0x%04X: " , i); +break ; + } + +udelay (10 ); + +switch (info->rd_byte) { +case 1 : +default : + val8 =rtw89_read8_mask (rtwdev, + info->rd_addr, info->rd_msk); +seq_printf (m,"0x%02X\n" , val8); +break ; +case 2 : + val16 =rtw89_read16_mask (rtwdev, + info->rd_addr, info->rd_msk); +seq_printf (m,"0x%04X\n" , val16); +break ; +case 4 : + val32 =rtw89_read32_mask (rtwdev, + info->rd_addr, info->rd_msk); +seq_printf (m,"0x%08X\n" , val32); +break ; + } + } + +return 0 ; +} + +static int rtw89_debug_mac_dump_dbg_port (struct rtw89_dev *rtwdev, +struct seq_file *m) +{ +u32 sel; +int ret =0 ; + +for (sel =RTW89_DBG_PORT_SEL_PTCL_C0 ; + sel <RTW89_DBG_PORT_SEL_LAST ; sel++) { +if (!is_dbg_port_valid (rtwdev, sel)) +continue ; + ret =rtw89_debug_mac_dbg_port_dump (rtwdev, m, sel); +if (ret) { +rtw89_err (rtwdev, +"failed to dump debug port %d\n" , sel); +break ; + } + } + +return ret; +} + +static int +rtw89_debug_priv_mac_dbg_port_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; + +if (debugfs_priv->dbgpkg_en.ss_dbg) +rtw89_debug_mac_dump_ss_dbg (rtwdev, m); +if (debugfs_priv->dbgpkg_en.dle_dbg) +rtw89_debug_mac_dump_dle_dbg (rtwdev, m); +if (debugfs_priv->dbgpkg_en.dmac_dbg) +rtw89_debug_mac_dump_dmac_dbg (rtwdev, m); +if (debugfs_priv->dbgpkg_en.cmac_dbg) +rtw89_debug_mac_dump_cmac_dbg (rtwdev, m); +if (debugfs_priv->dbgpkg_en.dbg_port) +rtw89_debug_mac_dump_dbg_port (rtwdev, m); + +return 0 ; +}; + +static ssize_t rtw89_debug_priv_send_h2c_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[256 ]; +size_t buf_size; +u8 h2c[128 ]; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + num = buf_size /2 ; +if (hex2bin (h2c, buf, num)) { +rtw89_info (rtwdev,"invalid format: H1H2H3...\n" ); +return -EINVAL ; + } + +rtw89_fw_h2c_raw (rtwdev, h2c, num); + +return count; +} + +static int rtw89_debug_priv_btc_info_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; + +rtw89_btc_dump_info (rtwdev, m); + +return 0 ; +} + +static ssize_t rtw89_debug_priv_btc_manual_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +struct rtw89_btc *btc = &rtwdev->btc; +bool btc_manual; + +if (kstrtobool_from_user (user_buf, count, &btc_manual)) + goto out; + + btc->ctrl.manual = btc_manual; +out: +return count; +} + +static ssize_t rtw89_debug_fw_log_btc_manual_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +struct rtw89_fw_info *fw_info = &rtwdev->fw; +bool fw_log_manual; + +if (kstrtobool_from_user (user_buf, count, &fw_log_manual)) + goto out; + +mutex_lock (&rtwdev->mutex); + fw_info->fw_log_enable = fw_log_manual; +rtw89_fw_h2c_fw_log (rtwdev, fw_log_manual); +mutex_unlock (&rtwdev->mutex); +out: +return count; +} + +static void rtw89_sta_info_get_iter (void *data,struct ieee80211_sta *sta) +{ +static const char *const he_gi_str[] = { + [NL80211_RATE_INFO_HE_GI_0_8 ] ="0.8" , + [NL80211_RATE_INFO_HE_GI_1_6 ] ="1.6" , + [NL80211_RATE_INFO_HE_GI_3_2 ] ="3.2" , + }; +struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv; +struct rate_info *rate = &rtwsta->ra_report.txrate; +struct ieee80211_rx_status *status = &rtwsta->rx_status; +struct seq_file *m = (struct seq_file *)data; +u8 rssi; + +seq_printf (m,"TX rate [%d]: " , rtwsta->mac_id); + +if (rate->flags &RATE_INFO_FLAGS_MCS ) +seq_printf (m,"HT MCS-%d%s" , rate->mcs, + rate->flags &RATE_INFO_FLAGS_SHORT_GI ?" SGI" :"" ); +else if (rate->flags &RATE_INFO_FLAGS_VHT_MCS ) +seq_printf (m,"VHT %dSS MCS-%d%s" , rate->nss, rate->mcs, + rate->flags &RATE_INFO_FLAGS_SHORT_GI ?" SGI" :"" ); +else if (rate->flags &RATE_INFO_FLAGS_HE_MCS ) +seq_printf (m,"HE %dSS MCS-%d GI:%s" , rate->nss, rate->mcs, + rate->he_gi <=NL80211_RATE_INFO_HE_GI_3_2 ? + he_gi_str[rate->he_gi] :"N/A" ); +else +seq_printf (m,"Legacy %d" , rate->legacy); +seq_printf (m,"\t(hw_rate=0x%x)" , rtwsta->ra_report.hw_rate); +seq_printf (m,"\t==> agg_wait=%d (%d)\n" , rtwsta->max_agg_wait, + sta->max_rc_amsdu_len); + +seq_printf (m,"RX rate [%d]: " , rtwsta->mac_id); + +switch (status->encoding) { +case RX_ENC_LEGACY : +seq_printf (m,"Legacy %d" , status->rate_idx + + (status->band ==NL80211_BAND_5GHZ ?4 :0 )); +break ; +case RX_ENC_HT : +seq_printf (m,"HT MCS-%d%s" , status->rate_idx, + status->enc_flags &RX_ENC_FLAG_SHORT_GI ?" SGI" :"" ); +break ; +case RX_ENC_VHT : +seq_printf (m,"VHT %dSS MCS-%d%s" , status->nss, status->rate_idx, + status->enc_flags &RX_ENC_FLAG_SHORT_GI ?" SGI" :"" ); +break ; +case RX_ENC_HE : +seq_printf (m,"HE %dSS MCS-%d GI:%s" , status->nss, status->rate_idx, + status->he_gi <=NL80211_RATE_INFO_HE_GI_3_2 ? + he_gi_str[rate->he_gi] :"N/A" ); +break ; + } +seq_printf (m,"\t(hw_rate=0x%x)\n" , rtwsta->rx_hw_rate); + + rssi =ewma_rssi_read (&rtwsta->avg_rssi); +seq_printf (m,"RSSI: %d dBm (raw=%d, prev=%d)\n" , +RTW89_RSSI_RAW_TO_DBM (rssi), rssi, rtwsta->prev_rssi); +} + +static void +rtw89_debug_append_rx_rate (struct seq_file *m,struct rtw89_pkt_stat *pkt_stat, +enum rtw89_hw_rate first_rate,int len) +{ +int i; + +for (i =0 ; i < len; i++) +seq_printf (m,"%s%u" , i ==0 ?"" :", " , + pkt_stat->rx_rate_cnt[first_rate + i]); +} + +static const struct rtw89_rx_rate_cnt_info { +enum rtw89_hw_rate first_rate; +int len; +const char *rate_mode; +} rtw89_rx_rate_cnt_infos[] = { + {RTW89_HW_RATE_CCK1 ,4 ,"Legacy:" }, + {RTW89_HW_RATE_OFDM6 ,8 ,"OFDM:" }, + {RTW89_HW_RATE_MCS0 ,8 ,"HT 0:" }, + {RTW89_HW_RATE_MCS8 ,8 ,"HT 1:" }, + {RTW89_HW_RATE_VHT_NSS1_MCS0 ,10 ,"VHT 1SS:" }, + {RTW89_HW_RATE_VHT_NSS2_MCS0 ,10 ,"VHT 2SS:" }, + {RTW89_HW_RATE_HE_NSS1_MCS0 ,12 ,"HE 1SS:" }, + {RTW89_HW_RATE_HE_NSS2_MCS0 ,12 ,"HE 2ss:" }, +}; + +static int rtw89_debug_priv_phy_info_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +struct rtw89_traffic_stats *stats = &rtwdev->stats; +struct rtw89_pkt_stat *pkt_stat = &rtwdev->phystat.last_pkt_stat; +const struct rtw89_rx_rate_cnt_info *info; +int i; + +seq_printf (m,"TP TX: %u [%u] Mbps (lv: %d), RX: %u [%u] Mbps (lv: %d)\n" , + stats->tx_throughput, stats->tx_throughput_raw, stats->tx_tfc_lv, + stats->rx_throughput, stats->rx_throughput_raw, stats->rx_tfc_lv); +seq_printf (m,"Beacon: %u\n" , pkt_stat->beacon_nr); +seq_printf (m,"Avg packet length: TX=%u, RX=%u\n" , stats->tx_avg_len, + stats->rx_avg_len); + +seq_puts (m,"RX count:\n" ); +for (i =0 ; i <ARRAY_SIZE (rtw89_rx_rate_cnt_infos); i++) { + info = &rtw89_rx_rate_cnt_infos[i]; +seq_printf (m,"%10s [" , info->rate_mode); +rtw89_debug_append_rx_rate (m, pkt_stat, + info->first_rate, info->len); +seq_puts (m,"]\n" ); + } + +ieee80211_iterate_stations_atomic (rtwdev->hw, rtw89_sta_info_get_iter, m); + +return 0 ; +} + +static struct rtw89_debugfs_priv rtw89_debug_priv_read_reg = { + .cb_read = rtw89_debug_priv_read_reg_get, + .cb_write = rtw89_debug_priv_read_reg_select, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_write_reg = { + .cb_write = rtw89_debug_priv_write_reg_set, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_read_rf = { + .cb_read = rtw89_debug_priv_read_rf_get, + .cb_write = rtw89_debug_priv_read_rf_select, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_write_rf = { + .cb_write = rtw89_debug_priv_write_rf_set, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_rf_reg_dump = { + .cb_read = rtw89_debug_priv_rf_reg_dump_get, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_txpwr_table = { + .cb_read = rtw89_debug_priv_txpwr_table_get, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_mac_reg_dump = { + .cb_read = rtw89_debug_priv_mac_reg_dump_get, + .cb_write = rtw89_debug_priv_mac_reg_dump_select, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_mac_mem_dump = { + .cb_read = rtw89_debug_priv_mac_mem_dump_get, + .cb_write = rtw89_debug_priv_mac_mem_dump_select, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_mac_dbg_port_dump = { + .cb_read = rtw89_debug_priv_mac_dbg_port_dump_get, + .cb_write = rtw89_debug_priv_mac_dbg_port_dump_select, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_send_h2c = { + .cb_write = rtw89_debug_priv_send_h2c_set, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_btc_info = { + .cb_read = rtw89_debug_priv_btc_info_get, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_btc_manual = { + .cb_write = rtw89_debug_priv_btc_manual_set, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_fw_log_manual = { + .cb_write = rtw89_debug_fw_log_btc_manual_set, +}; + +static struct rtw89_debugfs_priv rtw89_debug_priv_phy_info = { + .cb_read = rtw89_debug_priv_phy_info_get, +}; + +#define rtw89_debugfs_add (name, mode, fopname, parent) \ + do { \ + rtw89_debug_priv_ ##name.rtwdev = rtwdev; \ + if (!debugfs_create_file(#name, mode, \ + parent, &rtw89_debug_priv_ ##name, \ + &file_ops_ ##fopname)) \ + pr_debug("Unable to initialize debugfs:%s\n", #name); \ + } while (0) + +#define rtw89_debugfs_add_w (name) \ + rtw89_debugfs_add(name, S_IFREG | 0222, single_w, debugfs_topdir) +#define rtw89_debugfs_add_rw (name) \ + rtw89_debugfs_add(name, S_IFREG | 0666, common_rw, debugfs_topdir) +#define rtw89_debugfs_add_r (name) \ + rtw89_debugfs_add(name, S_IFREG | 0444, single_r, debugfs_topdir) + +void rtw89_debugfs_init (struct rtw89_dev *rtwdev) +{ +struct dentry *debugfs_topdir; + + debugfs_topdir =debugfs_create_dir ("rtw89" , + rtwdev->hw->wiphy->debugfsdir); + +rtw89_debugfs_add_rw (read_reg); +rtw89_debugfs_add_w (write_reg); +rtw89_debugfs_add_rw (read_rf); +rtw89_debugfs_add_w (write_rf); +rtw89_debugfs_add_r (rf_reg_dump); +rtw89_debugfs_add_r (txpwr_table); +rtw89_debugfs_add_rw (mac_reg_dump); +rtw89_debugfs_add_rw (mac_mem_dump); +rtw89_debugfs_add_rw (mac_dbg_port_dump); +rtw89_debugfs_add_w (send_h2c); +rtw89_debugfs_add_r (btc_info); +rtw89_debugfs_add_w (btc_manual); +rtw89_debugfs_add_w (fw_log_manual); +rtw89_debugfs_add_r (phy_info); +} +#endif + +#ifdef CONFIG_RTW89_DEBUGMSG +void __rtw89_debug (struct rtw89_dev *rtwdev, +enum rtw89_debug_mask mask, +const char *fmt, ...) +{ +struct va_format vaf = { + .fmt = fmt, + }; + +va_list args; + +va_start (args, fmt); + vaf.va = &args; + +if (rtw89_debug_mask & mask) +dev_printk (KERN_DEBUG , rtwdev->dev,"%pV" , &vaf); + +va_end (args); +} +EXPORT_SYMBOL (__rtw89_debug); +#endif
drivers/net/wireless/realtek/rtw89/debug.h new file +77 -0
77 lines not on this page · raw message
Signature · 1 line
2.25.1
Re: [PATCH 04/24] rtw89: add debug files
Quoted 30 lines · Ping-Ke Shih
To recognize issues happened in field, two debug methods, debug message and debugfs, are added.
The debug messages are written to kernel log, and four levels can be chosen according to the cases -- debug, info, warn and err.
Debugfs is used to read and write registers and driver status.
Signed-off-by Ping-Ke Shih <[email protected]>--- drivers/net/wireless/realtek/rtw89/debug.c | 2404 ++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/debug.h | 77 + 2 files changed, 2481 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/debug.c create mode 100644 drivers/net/wireless/realtek/rtw89/debug.hdrivers/net/wireless/realtek/rtw89/debug.c new file +8
-0@@ -0,0 +1,2404 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "coex.h" +#include "debug.h" +#include "fw.h" +#include "mac.h"
drivers/net/wireless/realtek/rtw89/debug.c line 18
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/debug.c new file +10
-0+#include "ps.h" +#include "reg.h" +#include "sar.h" + +#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif
For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to netif_ counterparts
Quoted 302 lines
drivers/net/wireless/realtek/rtw89/debug.c new file +302
-0+#ifdef CONFIG_RTW89_DEBUGFS +struct rtw89_debugfs_priv { +struct rtw89_dev *rtwdev; +int (*cb_read)(struct seq_file *m,void *v); +ssize_t (*cb_write)(struct file *filp,const char __user *buffer, +size_t count,loff_t *loff); +union { +u32 cb_data; +struct { +u32 addr; +u8 len; + } read_reg; +struct { +u32 addr; +u32 mask; +u8 path; + } read_rf; +struct { +u8 ss_dbg:1 ; +u8 dle_dbg:1 ; +u8 dmac_dbg:1 ; +u8 cmac_dbg:1 ; +u8 dbg_port:1 ; + } dbgpkg_en; +struct { +u32 start; +u32 len; +u8 sel; + } mac_mem; + }; +}; + +static int rtw89_debugfs_single_show (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; + +return debugfs_priv->cb_read (m, v); +} + +static ssize_t rtw89_debugfs_single_write (struct file *filp, +const char __user *buffer, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; + +return debugfs_priv->cb_write (filp, buffer, count, loff); +} + +static ssize_t rtw89_debugfs_seq_file_write (struct file *filp, +const char __user *buffer, +size_t count,loff_t *loff) +{ +struct seq_file *seqpriv = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = seqpriv->private; + +return debugfs_priv->cb_write (filp, buffer, count, loff); +} + +static int rtw89_debugfs_single_open (struct inode *inode,struct file *filp) +{ +return single_open (filp, rtw89_debugfs_single_show, inode->i_private); +} + +static int rtw89_debugfs_close (struct inode *inode,struct file *filp) +{ +return 0 ; +} + +static const struct file_operations file_ops_single_r = { + .owner =THIS_MODULE , + .open = rtw89_debugfs_single_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static const struct file_operations file_ops_common_rw = { + .owner =THIS_MODULE , + .open = rtw89_debugfs_single_open, + .release = single_release, + .read = seq_read, + .llseek = seq_lseek, + .write = rtw89_debugfs_seq_file_write, +}; + +static const struct file_operations file_ops_single_w = { + .owner =THIS_MODULE , + .write = rtw89_debugfs_single_write, + .open = simple_open, + .release = rtw89_debugfs_close, +}; + +static ssize_t +rtw89_debug_priv_read_reg_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, len; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%x %x" , &addr, &len); +if (num !=2 ) { +rtw89_info (rtwdev,"invalid format: <addr> <len>\n" ); +return -EINVAL ; + } + + debugfs_priv->read_reg.addr = addr; + debugfs_priv->read_reg.len = len; + +rtw89_info (rtwdev,"select read %d bytes from 0x%08x\n" , len, addr); + +return count; +} + +static int rtw89_debug_priv_read_reg_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +u32 addr, data; +u8 len; + + len = debugfs_priv->read_reg.len; + addr = debugfs_priv->read_reg.addr; + +switch (len) { +case 1 : + data =rtw89_read8 (rtwdev, addr); +break ; +case 2 : + data =rtw89_read16 (rtwdev, addr); +break ; +case 4 : + data =rtw89_read32 (rtwdev, addr); +break ; +default : +rtw89_info (rtwdev,"invalid read reg len %d\n" , len); +return -EINVAL ; + } + +seq_printf (m,"get %d bytes at 0x%08x=0x%08x\n" , len, addr, data); + +return 0 ; +} + +static ssize_t rtw89_debug_priv_write_reg_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, val, len; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%x %x %x" , &addr, &val, &len); +if (num !=3 ) { +rtw89_info (rtwdev,"invalid format: <addr> <val> <len>\n" ); +return -EINVAL ; + } + +switch (len) { +case 1 : +rtw89_info (rtwdev,"reg write8 0x%08x: 0x%02x\n" , addr, val); +rtw89_write8 (rtwdev, addr, (u8 )val); +break ; +case 2 : +rtw89_info (rtwdev,"reg write16 0x%08x: 0x%04x\n" , addr, val); +rtw89_write16 (rtwdev, addr, (u16 )val); +break ; +case 4 : +rtw89_info (rtwdev,"reg write32 0x%08x: 0x%08x\n" , addr, val); +rtw89_write32 (rtwdev, addr, (u32 )val); +break ; +default : +rtw89_info (rtwdev,"invalid read write len %d\n" , len); +break ; + } + +return count; +} + +static ssize_t +rtw89_debug_priv_read_rf_select (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct seq_file *m = (struct seq_file *)filp->private_data; +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, mask; +u8 path; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%hhd %x %x" , &path, &addr, &mask); +if (num !=3 ) { +rtw89_info (rtwdev,"invalid format: <path> <addr> <mask>\n" ); +return -EINVAL ; + } + +if (path >= rtwdev->chip->rf_path_num) { +rtw89_info (rtwdev,"wrong rf path\n" ); +return -EINVAL ; + } + debugfs_priv->read_rf.addr = addr; + debugfs_priv->read_rf.mask = mask; + debugfs_priv->read_rf.path = path; + +rtw89_info (rtwdev,"select read rf path %d from 0x%08x\n" , path, addr); + +return count; +} + +static int rtw89_debug_priv_read_rf_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +u32 addr, data, mask; +u8 path; + + addr = debugfs_priv->read_rf.addr; + mask = debugfs_priv->read_rf.mask; + path = debugfs_priv->read_rf.path; + + data =rtw89_read_rf (rtwdev, path, addr, mask); + +seq_printf (m,"path %d, rf register 0x%08x=0x%08x\n" , path, addr, data); + +return 0 ; +} + +static ssize_t rtw89_debug_priv_write_rf_set (struct file *filp, +const char __user *user_buf, +size_t count,loff_t *loff) +{ +struct rtw89_debugfs_priv *debugfs_priv = filp->private_data; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +char buf[32 ]; +size_t buf_size; +u32 addr, val, mask; +u8 path; +int num; + + buf_size =min (count,sizeof (buf) -1 ); +if (copy_from_user (buf, user_buf, buf_size)) +return -EFAULT ; + + buf[buf_size] ='\0' ; + num =sscanf (buf,"%hhd %x %x %x" , &path, &addr, &mask, &val); +if (num !=4 ) { +rtw89_info (rtwdev,"invalid format: <path> <addr> <mask> <val>\n" ); +return -EINVAL ; + } + +if (path >= rtwdev->chip->rf_path_num) { +rtw89_info (rtwdev,"wrong rf path\n" ); +return -EINVAL ; + } + +rtw89_info (rtwdev,"path %d, rf register write 0x%08x=0x%08x (mask = 0x%08x)\n" , + path, addr, val, mask); +rtw89_write_rf (rtwdev, path, addr, mask, val); + +return count; +} + +static int rtw89_debug_priv_rf_reg_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +const struct rtw89_chip_info *chip = rtwdev->chip; +u32 addr, offset, data; +u8 path; + +for (path =0 ; path < chip->rf_path_num; path++) { +seq_printf (m,"RF path %d:\n\n" , path); +for (addr =0 ; addr <0x100 ; addr +=4 ) { +seq_printf (m,"0x%08x: " , addr); +for (offset =0 ; offset <4 ; offset++) { + data = rtw89_read_rf(rtwdev, path,
drivers/net/wireless/realtek/rtw89/debug.c line 331
Quoted 10 lines
drivers/net/wireless/realtek/rtw89/debug.c new file +10
-0+ addr + offset, RFREG_MASK); +seq_printf (m,"0x%05x " , data); + } +seq_puts (m,"\n" ); + } +seq_puts (m,"\n" ); + } + +return 0 ; +}
Based on this and other part of this driver I would recommend to use regmap. It will provide to additional interface for the register access. And typically for the network devices we have an ethtool interface for that.
Please, do not reinvent the wheel and use existing frameworks.
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Re: [PATCH 04/24] rtw89: add debug files
Quoted 11 lines · Oleksij Rempel
drivers/net/wireless/realtek/rtw89/debug.c line 18
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/debug.c new file +6
-0+#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterparts
Have you ever looked at a WiFi driver? I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every single one has a similar module parameter or debugfs knob for enabling different types of debug messages.
As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Brian
Re: [PATCH 04/24] rtw89: add debug files
Quoted 13 lines · Brian Norris
Quoted 11 lines · Oleksij Rempel
drivers/net/wireless/realtek/rtw89/debug.c line 18
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/debug.c new file +6
-0+#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterparts
Quoted 1 line
Have you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Even dynamic printk provide even more granularity. So module parameter looks like stone age against all existing possibilities.
Regards,
Oleksij
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Re: [PATCH 04/24] rtw89: add debug files
Quoted 8 lines · Oleksij Rempel
Quoted 5 lines · Brian Norris
Quoted 2 lines · Oleksij Rempel
For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterpartsHave you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
OK! So I see you've touched a lot of ath9k, >3 years ago. You might notice that it is one such example -- it supports exactly the same kind of debugfs file, with a set of ath_dbg() log types. Why doesn't it use this netif debug logging?
Quoted 11 lines
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions. If such a change was Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily. Otherwise, the bar for new contributions gets exceedingly high -- this one has already sat for more than 6 months with depressingly little useful feedback.
I also know very little about this netif log level feature, but if it really depends on ethtool (seems like it does?) -- I don't even bother installing ethtool on most of my systems. It's much easier to poke at debugfs, sysfs, etc., than to construct the relevant ethtool ioctl()s or netlink messages. It also seems that these debug knobs can't be set before the driver finishes coming up, so one would still need a module parameter to mirror some of the same features. Additionally, a WiFi driver doesn't even have a netdev to speak of until after a lot of the interesting stuff comes up (much of the mac80211 framework focuses on a |struct ieee80211_hw| and a |struct wiphy|), so I'm not sure your suggestion really fits these sorts of drivers (and the things they might like to support debug-logging for) at all.
Anyway, if Ping-Ke wants to paint this bikeshed for you, I won't stop him.
Quoted 2 lines
Even dynamic printk provide even more granularity. So module parameter looks like stone age against all existing possibilities.
Dynamic printk seems a bit beside the point (it's pretty different than either of the methods we're talking about), but I'll bite: many distributors disable it. It's easier to get targeted debugging for a few modules you care about, than the entire dynamic debug feature for ~every print in the kernel.
Brian
Re: [PATCH 04/24] rtw89: add debug files
Quoted 6 lines · Brian Norris
Quoted 5 lines · Oleksij Rempel
Quoted 4 lines · Brian Norris
Quoted 2 lines · Oleksij Rempel
For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterparts
Quoted 8 lines
Quoted 3 lines
Quoted 1 line
Have you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
OK! So I see you've touched a lot of ath9k, >3 years ago. You might notice that it is one such example -- it supports exactly the same kind of debugfs file, with a set of
ath_dbg()log types. Why doesn't it use this netif debug logging?
Ok, you right, ath mask would will set netif msg level on limit.
Quoted 9 lines
Quoted 9 lines
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Quoted 5 lines
Quoted 2 lines
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions.
It is technical discussion. There is no reason to get personal.
Quoted 4 lines
If such a change was
Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily.
Hm, my experience as patch submitter is rather different, but who knows, every subsystem has diffent rules. Good to know, wireless is different.
Quoted 3 lines
Otherwise, the bar for new contributions gets exceedingly high -- this one has already sat for more than 6 months with depressingly little useful feedback.
Ok, I compared this driver with different realtek drivers. Most of them have own DHCP detection code? It is not hardware specific operation. There is no need to review code duplicates just again. Is it so hard to share this code at least for realtek drivers? Do reviewers have a lot of free time to re-read code duplicates?
Quoted 4 lines
I also know very little about this netif log level feature, but if it really depends on ethtool (seems like it does?) -- I don't even bother installing ethtool on most of my systems. It's much easier to poke at debugfs, sysfs, etc., than to construct the relevant ethtool ioctl()s
Quoted 8 lines
or netlink messages. It also seems that these debug knobs can't be set before the driver finishes coming up, so one would still need a module parameter to mirror some of the same features. Additionally, a WiFi driver doesn't even have a netdev to speak of until after a lot of the interesting stuff comes up (much of the mac80211 framework focuses on a |struct ieee80211_hw| and a |struct wiphy|), so I'm not sure your suggestion really fits these sorts of drivers (and the things they might like to support debug-logging for) at all.
Ok, i have nothing against unified realtek specif debugging code, as common athers code do.
Quoted 1 line
Anyway, if Ping-Ke wants to paint this bikeshed for you, I won't stop him.
Well, i can provide a lot of "bikeshed". For example PCI related error detection in this code. What level of review it will be?
Quoted 8 lines
Quoted 2 lines
Even dynamic printk provide even more granularity. So module parameter looks like stone age against all existing possibilities.
Dynamic printk seems a bit beside the point (it's pretty different than either of the methods we're talking about), but I'll bite: many distributors disable it. It's easier to get targeted debugging for a few modules you care about, than the entire dynamic debug feature for ~every print in the kernel.
There are two side of each patch: reviewer and submitter. Both side have limited time budget. If reviewer is not allowed to request improve things to save submitters timer, why is it OK to waste reviewers time by applying code dups?
Regards,
Oleksij
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | iAmtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Re: [PATCH 04/24] rtw89: add debug files
Quoted 5 lines · Oleksij Rempel
Quoted 2 lines · Brian Norris
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions.
It is technical discussion. There is no reason to get personal.
I'm not really intending to make this personal, so apologies if it appeared that way.
What I'm trying to get at is that
(a) no other wireless driver does this, so why should this one? and
(b) the feature you claim this driver can use does not appear suited to the task.
It's easier to make suggestions than to make them a reality.
Quoted 7 lines
Quoted 4 lines
If such a change was
Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily.Hm, my experience as patch submitter is rather different, but who knows, every subsystem has diffent rules. Good to know, wireless is different.
I'm not an arbiter for "wireless" -- so my thoughts are purely my own opinion. But I have noted some technical reasons why wireless drivers may be different than ethernet drivers, and the suggested (again, purely my own opinion) exercise might show you that your suggestion won't really work out in practice.
Brian
Re: [PATCH 04/24] rtw89: add debug files
Quoted 22 lines · Brian Norris
Quoted 5 lines · Oleksij Rempel
Quoted 2 lines · Brian Norris
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions.
It is technical discussion. There is no reason to get personal.
I'm not really intending to make this personal, so apologies if it appeared that way.
What I'm trying to get at is that
(a) no other wireless driver does this, so why should this one? and
(b) the feature you claim this driver can use does not appear suited to the task.It's easier to make suggestions than to make them a reality.
Quoted 5 lines
Quoted 4 lines
If such a change was
Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily.
Quoted 8 lines
Quoted 2 lines
Hm, my experience as patch submitter is rather different, but who knows, every subsystem has diffent rules. Good to know, wireless is different.
I'm not an arbiter for "wireless" -- so my thoughts are purely my own opinion. But I have noted some technical reasons why wireless drivers may be different than ethernet drivers, and the suggested (again, purely my own opinion) exercise might show you that your suggestion won't really work out in practice.
Ok, so we still need to find the way to go.
For example drivers/net/wireless/realtek/rtw89/debug.c is 2404 of potentially removable code. Some one should review it or outoptimize it by using existing frameworks.
As you noticed, not many people are willing to review this driver. IMO, it is related to the RealTek reputation of making code drops with lots of not not usable or duplicated code. So to say - offloading the dirty work to the community. For example this patch set:
https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git/log/drivers/staging/rts5139?h=v5.13&qt=author&q=rempel
This new rtw89 driver seems to confirm this reputation, but I cani't say it for sure without spending a week on reverse engineering it.
Regards,
Oleksij
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Re: [PATCH 04/24] rtw89: add debug files
Quoted 3 lines · Oleksij Rempel
For example
drivers/net/wireless/realtek/rtw89/debug.cis 2404 of potentially removable code. Some one should review it or outoptimize it by using existing frameworks.
Only ~28 of those lines are for the debug logging you point out. (There's a few more in the .h file, but still.) Most of that is unrelated code for dumping other debug info about the Realtek chip/firmware/driver state, or performing other debugging operations.
Quoted 5 lines
As you noticed, not many people are willing to review this driver. IMO, it is related to the RealTek reputation of making code drops with lots of not not usable or duplicated code. So to say - offloading the dirty work to the community. For example this patch set:
https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git/log/drivers/staging/rts5139?h=v5.13&qt=author&q=rempel
FWIW, that driver was introduced into mainline (staging) by somebody @ Realsil, not Realtek:
https://git.kernel.org/linus/1dac4186bcc663cb8c2bcc59481aea8fe9124a6c
Sure, Realtek previously developed plenty of copy/paste/modify Linux drivers, and it's likely most of that code was based off their downstream drivers (which suffered from duplication), but they rarely (never?) tried to get them merged upstream. Can you really blame them for having non-upstream-friendly code in their not-intended-for-upstream drivers? Now they've been nudged into doing the upstream work themselves (*cough* *cough*) with rtw88 and now rtw89, and IMO, they aren't suffering nearly of the same kinds of duplication problems you note. But agreed, the reputational problems might still be lingering.
If we're opining on lack of review: I haven't watched so many other wireless drivers' review and inclusion in mainline (I tend to bother with them once they're already mostly upstream, and I mostly just need to fix bugs), but my impression is that the biggest impediment is Kalle's limited resources. Most other successful drivers have dedicated submaintainers who do the review or else append their name on submissions and do pull requests, whether or not they got much mailing list review. Everyone else who isn't so lucky has to wait in line for Kalle, often for quite some time. This is getting a bit off topic though.
Quoted 2 lines
This new rtw89 driver seems to confirm this reputation, but I cani't say it for sure without spending a week on reverse engineering it.
FWIW, I've looked through it lightly (and I looked through rtw88 quite a bit), and I don't see much (or any, really) of those same kinds of problems. It's not perfect code of course, but I don't think duplication is the biggest sort of problem.
Anyway, thanks for reviewing, and thanks for any issues you do point out!
Brian
Pkshih
maintainerRE: [PATCH 04/24] rtw89: add debug files
In reply to Brian NorrisQuoted 57 lines
-----Original Message-----
From: Brian Norris [mailto:[email protected]]
Sent: Saturday, July 03, 2021 2:38 AM
To: Oleksij Rempel
Cc: Pkshih; Kalle Valo; linux-wireless; <[email protected]>; Sascha Hauer
Subject: Re: [PATCH 04/24] rtw89: add debug filesQuoted 8 lines · Oleksij Rempel
Quoted 5 lines · Brian Norris
Quoted 2 lines · Oleksij Rempel
For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterpartsHave you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
OK! So I see you've touched a lot of ath9k, >3 years ago. You might notice that it is one such example -- it supports exactly the same kind of debugfs file, with a set of
ath_dbg()log types. Why doesn't it use this netif debug logging?Quoted 11 lines
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions. If such a change was Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily. Otherwise, the bar for new contributions gets exceedingly high -- this one has already sat for more than 6 months with depressingly little useful feedback.
I also know very little about this netif log level feature, but if it really depends on ethtool (seems like it does?) -- I don't even bother installing ethtool on most of my systems. It's much easier to poke at debugfs, sysfs, etc., than to construct the relevant ethtool ioctl()s or netlink messages. It also seems that these debug knobs can't be set before the driver finishes coming up, so one would still need a module parameter to mirror some of the same features. Additionally, a WiFi driver doesn't even have a netdev to speak of until after a lot of the interesting stuff comes up (much of the mac80211 framework focuses on a |struct ieee80211_hw| and a |struct wiphy|), so I'm not sure your suggestion really fits these sorts of drivers (and the things they might like to support debug-logging for) at all.
Quoted 1 line
Anyway, if Ping-Ke wants to paint this bikeshed for you, I won't stop him.
I encounter the problems you mentioned mostly:
1. no netdev to be the parameter 'dev' of 'netif_dbg(priv, type, dev, format, args...)'
2. predefined 'type' isn't enough for wifi application. There're many wifi- or vendor- specific components, such as RF calibration, BT coexistence, DIG, CFO and so on.
So, I don't plan to change them for now.
--
Ping-Ke
Re: [PATCH 04/24] rtw89: add debug files
Quoted 57 lines · Pkshih
Quoted 57 lines
-----Original Message-----
From: Brian Norris [mailto:[email protected]]
Sent: Saturday, July 03, 2021 2:38 AM
To: Oleksij Rempel
Cc: Pkshih; Kalle Valo; linux-wireless; <[email protected]>; Sascha Hauer
Subject: Re: [PATCH 04/24] rtw89: add debug filesQuoted 8 lines · Oleksij Rempel
Quoted 5 lines · Brian Norris
Quoted 2 lines · Oleksij Rempel
For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterpartsHave you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
OK! So I see you've touched a lot of ath9k, >3 years ago. You might notice that it is one such example -- it supports exactly the same kind of debugfs file, with a set of
ath_dbg()log types. Why doesn't it use this netif debug logging?Quoted 11 lines
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Well mainly, I don't really like people dreaming up arbitrary rules and enforcing them only on new submissions. If such a change was Recommended, it seems like a better first step would be to prove that existing drivers (where there are numerous examples) can be converted nicely, instead of pushing the work to new contributors arbitrarily. Otherwise, the bar for new contributions gets exceedingly high -- this one has already sat for more than 6 months with depressingly little useful feedback.
I also know very little about this netif log level feature, but if it really depends on ethtool (seems like it does?) -- I don't even bother installing ethtool on most of my systems. It's much easier to poke at debugfs, sysfs, etc., than to construct the relevant ethtool ioctl()s or netlink messages. It also seems that these debug knobs can't be set before the driver finishes coming up, so one would still need a module parameter to mirror some of the same features. Additionally, a WiFi driver doesn't even have a netdev to speak of until after a lot of the interesting stuff comes up (much of the mac80211 framework focuses on a |struct ieee80211_hw| and a |struct wiphy|), so I'm not sure your suggestion really fits these sorts of drivers (and the things they might like to support debug-logging for) at all.
Quoted 8 lines
Quoted 1 line
Anyway, if Ping-Ke wants to paint this bikeshed for you, I won't stop him.
I encounter the problems you mentioned mostly:
1. no netdev to be the parameter 'dev' of 'netif_dbg(priv, type, dev, format, args...)'
2. predefined 'type' isn't enough for wifi application. There're many wifi- or vendor- specific components, such as RF calibration, BT coexistence, DIG, CFO and so on.So, I don't plan to change them for now.
OK, understand.
Regards,
Oleksij
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Re: [PATCH 04/24] rtw89: add debug files
In reply to Oleksij RempelQuoted 27 lines · Oleksij Rempel
Quoted 13 lines · Brian Norris
Quoted 11 lines · Oleksij Rempel
drivers/net/wireless/realtek/rtw89/debug.c line 18
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/debug.c new file +6
-0+#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterpartsQuoted 1 line
Have you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Quoted 5 lines
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Even dynamic printk provide even more granularity. So module parameter looks like stone age against all existing possibilities.
I'm all for improving wireless driver debugging features, but let's please keep that as a separate thread from reviewing new drivers. I think there are 4-5 new drivers in the queue at the moment so to keep all this manageable let's have the review process as simple as possible, please.
Using a module parameter for setting the debug mask is a standard feature in wireless drivers so it shouldn't block rtw89. If we want a generic debug framework for wireless drivers, an rfc patch for an existing upstream wireless driver is a good way to get that discussion forward.
Signature · 3 lines
https://patchwork.kernel.org/project/linux-wireless/list/ https://wireless.wiki.kernel.org/en/developers/documentation/submittingpatches
Re: [PATCH 04/24] rtw89: add debug files
Quoted 32 lines · Kalle Valo
Quoted 30 lines · Oleksij Rempel
Quoted 13 lines · Brian Norris
Quoted 11 lines · Oleksij Rempel
drivers/net/wireless/realtek/rtw89/debug.c line 18
Quoted 6 lines · Ping-Ke Shih
drivers/net/wireless/realtek/rtw89/debug.c new file +6
-0+#ifdef CONFIG_RTW89_DEBUGMSG +unsigned int rtw89_debug_mask; +EXPORT_SYMBOL (rtw89_debug_mask); +module_param_named (debug_mask, rtw89_debug_mask, uint,0644 ); +MODULE_PARM_DESC (debug_mask,"Debugging mask" ); +#endif For dynamic debugging we usually use ethtool msglvl. Please, convert all dev_err/warn/inf.... to
netif_counterpartsQuoted 1 line
Have you ever looked at a WiFi driver?
Yes. You can parse the kernel log for my commits.
Quoted 8 lines
I haven't seen a single one that uses netif_*() for logging. On the other hand, almost every
single one has a similar module parameter or debugfs knob for enabling different types of debug messages.As it stands, the NETIF_* categories don't really align at all with the kinds of message categories most WiFi drivers support. Do you propose adding a bunch of new options to the netif debug feature?
Why not? It make no sense or it is just "it is tradition, we never do it!" ?
Quoted 8 lines
Quoted 2 lines
Even dynamic printk provide even more granularity. So module parameter looks like stone age against all existing possibilities.
I'm all for improving wireless driver debugging features, but let's please keep that as a separate thread from reviewing new drivers. I think there are 4-5 new drivers in the queue at the moment so to keep all this manageable let's have the review process as simple as possible, please.
Ok, there is enough work to do.
Quoted 5 lines
Using a module parameter for setting the debug mask is a standard feature in wireless drivers so it shouldn't block rtw89. If we want a generic debug framework for wireless drivers, an rfc patch for an existing upstream wireless driver is a good way to get that discussion forward.
Ok, sounds good.
Regards,
Oleksij
Signature · 4 lines
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Pkshih
maintainerRE: [PATCH 04/24] rtw89: add debug files
In reply to Oleksij RempelQuoted 32 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]
Sent: Friday, July 02, 2021 3:23 PM
To: Pkshih
Cc: [email protected]; [email protected]
Subject: Re: [PATCH 04/24] rtw89: add debug filesQuoted 9 lines · Ping-Ke Shih
To recognize issues happened in field, two debug methods, debug message and debugfs, are added.
The debug messages are written to kernel log, and four levels can be chosen according to the cases -- debug, info, warn and err.
Debugfs is used to read and write registers and driver status.
Signed-off-by Ping-Ke Shih <[email protected]>Review
Quoted 8 lines
--- drivers/net/wireless/realtek/rtw89/debug.c | 2404 ++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/debug.h | 77 + 2 files changed, 2481 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/debug.c create mode 100644 drivers/net/wireless/realtek/rtw89/debug.h(quoted diff) +0
-0
b/drivers/net/wireless/realtek/rtw89/debug.cQuoted 4 lines
new file mode 100644
index 000000000000..03d2d2eb813ddrivers/net/wireless/realtek/rtw89/debug.c new file +0
-0
[...]
Quoted 21 lines
Quoted 21 lines
drivers/net/wireless/realtek/rtw89/debug.c new file +21
-0+static int rtw89_debug_priv_rf_reg_dump_get (struct seq_file *m,void *v) +{ +struct rtw89_debugfs_priv *debugfs_priv = m->private; +struct rtw89_dev *rtwdev = debugfs_priv->rtwdev; +const struct rtw89_chip_info *chip = rtwdev->chip; +u32 addr, offset, data; +u8 path; + +for (path =0 ; path < chip->rf_path_num; path++) { +seq_printf (m,"RF path %d:\n\n" , path); +for (addr =0 ; addr <0x100 ; addr +=4 ) { +seq_printf (m,"0x%08x: " , addr); +for (offset =0 ; offset <4 ; offset++) { + data =rtw89_read_rf (rtwdev, path, + addr + offset,RFREG_MASK ); +seq_printf (m,"0x%05x " , data); + } +seq_puts (m,"\n" ); + } +seq_puts (m,"\n" ); + }
Quoted 9 lines
drivers/net/wireless/realtek/rtw89/debug.c line 86
Quoted 3 lines
drivers/net/wireless/realtek/rtw89/debug.c new file +3
-0+ +return 0 ; +}Based on this and other part of this driver I would recommend to use regmap. It will provide to additional interface for the register access. And typically for the network devices we have an ethtool interface for that.
Could I know the 'regmap' you mentioned?
I study interfaces of ethtool. It sets/gets dump via struct ethtool_dump. I face problems: this chip has many register domains, but there's no way to specify the domain type. The amount of registers is large, so I need to specify the range I want to dump, but no offset/length can be used by ETHTOOL_SET_DUMP. Another reason I can't dump all registers is that some domains are indirect access with two registers (one is control register, and the other is data register), I can't access them arbitrarily because firmware can use them simultaneously. Instead, they are only used in fatal cases.
So, I can't use interfaces of ethtool, but I'll try to merge duplicate to reduce code size.
--
Ping-Ke
Re: [PATCH 04/24] rtw89: add debug files
Quoted 10 lines · Pkshih
Quoted 8 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]Based on this and other part of this driver I would recommend to use regmap. It will provide to additional interface for the register access. And typically for the network devices we have an ethtool interface for that.
Could I know the 'regmap' you mentioned?
include/linux/regmap.hdrivers/base/regmap/
It's a driver framework and API for abstracting register accesses, whether they are accessed directly via MMIO, or behind some kind of indirect bus (I2C, SPI, etc.). It also happens to have its own debugfs operators for doing various kinds of register get/set/dump. So if you can successfully teach your driver to use it, then you don't need to implement your own debugfs files for it.
I've only ever used regmap with Device Tree systems (which can more easily specify syscon nodes, etc. -- see Documentation/devicetree/bindings/regmap/regmap.txt). I'm totally unfamiliar how to use this with ACPI (which I'm sure you want to support). I'm sure it's possible somehow.
FWIW, search engines turn up a few basic articles about it, if you find its documentation or code examples too sparse:
https://www.collabora.com/news-and-blog/blog/2020/05/27/using-regmaps-to-make-linux-drivers-more-generic/
Brian
Re: [PATCH 04/24] rtw89: add debug files
Quoted 28 lines · Brian Norris
Quoted 10 lines · Pkshih
Quoted 8 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]Based on this and other part of this driver I would recommend to use regmap. It will provide to additional interface for the register access. And typically for the network devices we have an ethtool interface for that.
Could I know the 'regmap' you mentioned?
include/linux/regmap.hdrivers/base/regmap/It's a driver framework and API for abstracting register accesses, whether they are accessed directly via MMIO, or behind some kind of indirect bus (I2C, SPI, etc.). It also happens to have its own debugfs operators for doing various kinds of register get/set/dump. So if you can successfully teach your driver to use it, then you don't need to implement your own debugfs files for it.
I've only ever used regmap with Device Tree systems (which can more easily specify syscon nodes, etc. -- see
Documentation/devicetree/bindings/regmap/regmap.txt). I'm totally unfamiliar how to use this with ACPI (which I'm sure you want to support). I'm sure it's possible somehow.
Quoted 3 lines
FWIW, search engines turn up a few basic articles about it, if you find its documentation or code examples too sparse:
https://www.collabora.com/news-and-blog/blog/2020/05/27/using-regmaps-to-make-linux-drivers-more-generic/
There are not ACPI specific register accesses in this driver. It is using simple readl/writel for the PCI accesses.
This driver would need to use devm_regmap_init() and register own regmap_bus. I motivate to use it not only to cover debugfs use case:
1. Current driver implements only PCI access, but potentially wont to support SDIO and USB buses:
drivers/net/wireless/realtek/rtw89/core.h
enum rtw89_hci_type {
RTW89_HCI_TYPE_PCIE,
RTW89_HCI_TYPE_USB,
RTW89_HCI_TYPE_SDIO,
};SDIO and USB buses may return error on any access. So, driver should test if return value is error on every access. regmap read/write functions separate error value from actual register read value and motivate to handle errors in the driver. Suddenly not every mainline driver is doing it.
2. Current driver implements patter based error detection for the PCI bus:
static u32 rtw89_pci_ops_read32_cmac(struct rtw89_dev *rtwdev, u32 addr)
{
struct rtw89_pci *rtwpci = (struct rtw89_pci *)rtwdev->priv;
u32 val = readl(rtwpci->mmap + addr);
int count;
for (count = 0; ; count++) {
if (val != RTW89_R32_DEAD)
return val;
if (count >= MAC_REG_POOL_COUNT) {
rtw89_warn(rtwdev, "addr %#x = %#x\n", addr, val);
return RTW89_R32_DEAD;
}
rtw89_pci_ops_write32(rtwdev, R_AX_CK_EN, B_AX_CMAC_ALLCKEN);
val = readl(rtwpci->mmap + addr);
}
return val;
}and handle this patter only in one place:
....
int rtw89_mac_check_mac_en(struct rtw89_dev *rtwdev, u8 mac_idx,
enum rtw89_mac_hwmod_sel sel)
{
....
r_val = rtw89_read32(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND);
....
if (r_val == RTW89_R32_EA || r_val == RTW89_R32_DEAD ||
(val & r_val) != val)
return -EFAULT;
return 0;
}potentially this should be done on every read attempt for the PCI, and on every read/write for SDIO and USB buses.
3. This driver has traces of watchdog support on the firmware side, so potentially, firmware can return error on any access if it was reset by the watchdog.
4. regmap provide a way to define support register ranges and will warn if calculated register offset goes outside of this range.
5. regamp is endianness aware and will help to make this driver work properly on big-endian systems.
Regards,
Oleksij
--
Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
Pkshih
maintainerRE: [PATCH 04/24] rtw89: add debug files
Quoted 31 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]
Sent: Tuesday, July 13, 2021 12:50 PM
To: Brian Norris
Cc: Pkshih; [email protected]; [email protected]
Subject: Re: [PATCH 04/24] rtw89: add debug filesQuoted 21 lines · Brian Norris
Quoted 10 lines · Pkshih
Quoted 8 lines
-----Original Message-----
From: Oleksij Rempel [mailto:[email protected]]Based on this and other part of this driver I would recommend to use regmap. It will provide to additional interface for the register access. And typically for the network devices we have an ethtool interface for that.
Could I know the 'regmap' you mentioned?
include/linux/regmap.hdrivers/base/regmap/It's a driver framework and API for abstracting register accesses, whether they are accessed directly via MMIO, or behind some kind of indirect bus (I2C, SPI, etc.). It also happens to have its own debugfs operators for doing various kinds of register get/set/dump. So if you can successfully teach your driver to use it, then you don't need to implement your own debugfs files for it.
Thanks for the information. I'll study to see if it is possible to use regmap.
Quoted 29 lines
Quoted 10 lines
I've only ever used regmap with Device Tree systems (which can more easily specify syscon nodes, etc. -- see
Documentation/devicetree/bindings/regmap/regmap.txt). I'm totally unfamiliar how to use this with ACPI (which I'm sure you want to support). I'm sure it's possible somehow.FWIW, search engines turn up a few basic articles about it, if you find its documentation or code examples too sparse:
https://www.collabora.com/news-and-blog/blog/2020/05/27/using-regmaps-to-make-linux-drivers-more-g
eneric/There are not ACPI specific register accesses in this driver. It is using simple readl/writel for the PCI accesses.
This driver would need to use
devm_regmap_init()and register ownregmap_bus. I motivate to use it not only to cover debugfs use case:1. Current driver implements only PCI access, but potentially wont to support SDIO and USB buses:
drivers/net/wireless/realtek/rtw89/core.h enum rtw89_hci_type { RTW89_HCI_TYPE_PCIE, RTW89_HCI_TYPE_USB, RTW89_HCI_TYPE_SDIO, };
Quoted 5 lines
SDIO and USB buses may return error on any access. So, driver should test if return value is error on every access. regmap read/write functions separate error value from actual register read value and motivate to handle errors in the driver. Suddenly not every mainline driver is doing it.
I know there are many changes if this driver supports SDIO and USB; not only IO error but also running context. However, it is hard to me to imagine how to solve these problems before starting to implement.
I'll prepare my knowledge of regmap in advance.
Quoted 15 lines
2. Current driver implements patter based error detection for the PCI bus:
static u32 rtw89_pci_ops_read32_cmac(struct rtw89_dev *rtwdev, u32 addr) { struct rtw89_pci *rtwpci = (struct rtw89_pci *)rtwdev->priv; u32 val = readl(rtwpci->mmap + addr); int count; for (count = 0; ; count++) { if (val != RTW89_R32_DEAD) return val; if (count >= MAC_REG_POOL_COUNT) { rtw89_warn(rtwdev, "addr %#x = %#x\n", addr, val);
Quoted 9 lines
return RTW89_R32_DEAD; } rtw89_pci_ops_write32(rtwdev, R_AX_CK_EN, B_AX_CMAC_ALLCKEN); val = readl(rtwpci->mmap + addr); } return val; }
This isn't due to PCI bus error. Instead, this is because driver and firmware can read the same register simultaneously, so we retry to get correct value.
Quoted 17 lines
and handle this patter only in one place:
.... int rtw89_mac_check_mac_en(struct rtw89_dev *rtwdev, u8 mac_idx, enum rtw89_mac_hwmod_sel sel) { .... r_val = rtw89_read32(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND); .... if (r_val == RTW89_R32_EA || r_val == RTW89_R32_DEAD || (val & r_val) != val) return -EFAULT; return 0; }
Quoted 2 lines
potentially this should be done on every read attempt for the PCI, and on every read/write for SDIO and USB buses.
The checking statement is not to check if reading error, but check if a certain MAC function block is power-on or not.
Quoted 4 lines
3. This driver has traces of watchdog support on the firmware side, so potentially, firmware can return error on any access if it was reset by the watchdog.
Firmware can't know if driver access error. It only detects hardware abnormal, and send error code to driver to reset hardware, even do reconnection.
This depends on the frequency it happens. The user experience would be better if we do softly reset, like we retry reading mentioned in 2.
Quoted 3 lines
4. regmap provide a way to define support register ranges and will warn if calculated register offset goes outside of this range.
Got it.
Quoted 4 lines
5. regamp is endianness aware and will help to make this driver work properly on big-endian systems.
As I know, the result of register access is CPU order; there's no endian issue.
In this driver, we must consider the endian of exchange between driver/firmware, and we write these codes carefully with le32 type and le_xxx API, like le32_set_bits(). I think this driver can run on big-endian machines.
--
Ping-Ke
Ping-Ke Shih
maintainerPATCH 5/24 rtw89: add efuse files
In reply to Ping-Ke ShihEfuse is divided into several parts, in which physical map and PHY cap parts are read and parsed by driver.
Storing main data, physical map is translated into logic map, and then use chip specific map to explain the logic map. Then, we can have MAC address, country code, thermal tracking calibration values, and so on.
PHY cap part is used to store PHY data. We don't need to translate it, because it's a direct map, like logic map.
--- drivers/net/wireless/realtek/rtw89/efuse.c | 188 +++++++++++++++++++++ drivers/net/wireless/realtek/rtw89/efuse.h | 13 ++ 2 files changed, 201 insertions(+) create mode 100644 drivers/net/wireless/realtek/rtw89/efuse.c create mode 100644 drivers/net/wireless/realtek/rtw89/efuse.h
drivers/net/wireless/realtek/rtw89/efuse.c new file +188 -0
@@ -0,0 +1,188 @@ +// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#include "debug.h" +#include "efuse.h" +#include "reg.h" + +enum rtw89_efuse_bank { +RTW89_EFUSE_BANK_WIFI , +RTW89_EFUSE_BANK_BT , +}; + +static int rtw89_switch_efuse_bank (struct rtw89_dev *rtwdev, +enum rtw89_efuse_bank bank) +{ +u8 val; + + val =rtw89_read32_mask (rtwdev,R_AX_EFUSE_CTRL_1 , +B_AX_EF_CELL_SEL_MASK ); +if (bank == val) +return 0 ; + +rtw89_write32_mask (rtwdev,R_AX_EFUSE_CTRL_1 ,B_AX_EF_CELL_SEL_MASK , + bank); + + val =rtw89_read32_mask (rtwdev,R_AX_EFUSE_CTRL_1 , +B_AX_EF_CELL_SEL_MASK ); +if (bank == val) +return 0 ; + +return -EBUSY ; +} + +static int rtw89_dump_physical_efuse_map (struct rtw89_dev *rtwdev,u8 *map, +u32 dump_addr,u32 dump_size) +{ +u32 efuse_ctl; +u32 addr; +int ret; + +rtw89_switch_efuse_bank (rtwdev,RTW89_EFUSE_BANK_WIFI ); + +for (addr = dump_addr; addr < dump_addr + dump_size; addr++) { + efuse_ctl =u32_encode_bits (addr,B_AX_EF_ADDR_MASK ); +rtw89_write32 (rtwdev,R_AX_EFUSE_CTRL , efuse_ctl & ~B_AX_EF_RDY ); + + ret =read_poll_timeout_atomic (rtw89_read32, efuse_ctl, + efuse_ctl &B_AX_EF_RDY ,1 ,1000000 , + true, rtwdev,R_AX_EFUSE_CTRL ); +if (ret) +return -EBUSY ; + + *map++ = (u8)(efuse_ctl &0xff ); + } + +return 0 ; +} + +#define invalid_efuse_header (hdr1, hdr2) \ + ((hdr1) == 0xff || (hdr2) == 0xff) +#define invalid_efuse_content (word_en, i) \ + (((word_en) & BIT(i)) != 0x0) +#define get_efuse_blk_idx (hdr1, hdr2) \ + ((((hdr2) & 0xf0) >> 4) | (((hdr1) & 0x0f) << 4)) +#define block_idx_to_logical_idx (blk_idx, i) \ + (((blk_idx) << 3) + ((i) << 1)) +static int rtw89_dump_logical_efuse_map (struct rtw89_dev *rtwdev,u8 *phy_map, +u8 *log_map) +{ +u32 physical_size = rtwdev->chip->physical_efuse_size; +u32 logical_size = rtwdev->chip->logical_efuse_size; +u8 sec_ctrl_size = rtwdev->chip->sec_ctrl_efuse_size; +u32 phy_idx = sec_ctrl_size; +u32 log_idx; +u8 hdr1, hdr2; +u8 blk_idx; +u8 word_en; +int i; + +while (phy_idx < physical_size - sec_ctrl_size) { + hdr1 = phy_map[phy_idx]; + hdr2 = phy_map[phy_idx +1 ]; +if (invalid_efuse_header (hdr1, hdr2)) +break ; + + blk_idx =get_efuse_blk_idx (hdr1, hdr2); + word_en = hdr2 &0xf ; + phy_idx +=2 ; + +for (i =0 ; i <4 ; i++) { +if (invalid_efuse_content (word_en, i)) +continue ; + + log_idx =block_idx_to_logical_idx (blk_idx, i); +if (phy_idx +1 > physical_size - sec_ctrl_size -1 || + log_idx +1 > logical_size) +return -EINVAL ; + + log_map[log_idx] = phy_map[phy_idx]; + log_map[log_idx +1 ] = phy_map[phy_idx +1 ]; + phy_idx +=2 ; + } + } +return 0 ; +} + +int rtw89_parse_efuse_map (struct rtw89_dev *rtwdev) +{ +u32 phy_size = rtwdev->chip->physical_efuse_size; +u32 log_size = rtwdev->chip->logical_efuse_size; +u8 *phy_map =NULL ; +u8 *log_map =NULL ; +int ret; + +if (rtw89_read16 (rtwdev,R_AX_SYS_EEPROM_CTRL ) &B_AX_AUTOLOAD_SUS ) + rtwdev->efuse.valid = true; +else +rtw89_warn (rtwdev,"failed to check efuse autoload\n" ); + + phy_map =kmalloc (phy_size,GFP_KERNEL ); + log_map =kmalloc (log_size,GFP_KERNEL ); + +if (!phy_map || !log_map) { + ret = -ENOMEM ; + goto out_free; + } + + ret =rtw89_dump_physical_efuse_map (rtwdev, phy_map,0 , phy_size); +if (ret) { +rtw89_warn (rtwdev,"failed to dump efuse physical map\n" ); + goto out_free; + } + +memset (log_map,0xff , log_size); + ret =rtw89_dump_logical_efuse_map (rtwdev, phy_map, log_map); +if (ret) { +rtw89_warn (rtwdev,"failed to dump efuse logical map\n" ); + goto out_free; + } + +rtw89_hex_dump (rtwdev,RTW89_DBG_FW ,"log_map: " , log_map, log_size); + + ret = rtwdev->chip->ops->read_efuse (rtwdev, log_map); +if (ret) { +rtw89_warn (rtwdev,"failed to read efuse map\n" ); + goto out_free; + } + +out_free: +kfree (log_map); +kfree (phy_map); + +return ret; +} + +int rtw89_parse_phycap_map (struct rtw89_dev *rtwdev) +{ +u32 phycap_addr = rtwdev->chip->phycap_addr; +u32 phycap_size = rtwdev->chip->phycap_size; +u8 *phycap_map =NULL ; +int ret =0 ; + +if (!phycap_size) +return 0 ; + + phycap_map =kmalloc (phycap_size,GFP_KERNEL ); +if (!phycap_map) +return -ENOMEM ; + + ret =rtw89_dump_physical_efuse_map (rtwdev, phycap_map, + phycap_addr, phycap_size); +if (ret) { +rtw89_warn (rtwdev,"failed to dump phycap map\n" ); + goto out_free; + } + + ret = rtwdev->chip->ops->read_phycap (rtwdev, phycap_map); +if (ret) { +rtw89_warn (rtwdev,"failed to read phycap map\n" ); + goto out_free; + } + +out_free: +kfree (phycap_map); + +return ret; +}
drivers/net/wireless/realtek/rtw89/efuse.h new file +13 -0
@@ -0,0 +1,13 @@ +/* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause */ +/* Copyright(c) 2019-2020 Realtek Corporation +*/ + +#ifndef __RTW89_EFUSE_H__ +#define __RTW89_EFUSE_H__ + +#include "core.h" + +int rtw89_parse_efuse_map (struct rtw89_dev *rtwdev); +int rtw89_parse_phycap_map (struct rtw89_dev *rtwdev); + +#endif
Signature · 1 line
2.25.1