Commit a2c0ce5d authored by Ching-Te Ku's avatar Ching-Te Ku Committed by Kalle Valo

wifi: rtw89: coex: Add traffic TX/RX info and its H2C

There is a new mechanism which can do some real time performance
tuning for WiFi and BT. This TX/RX info is a condition provide to
firmware to do traffic analysis.
Signed-off-by: default avatarChing-Te Ku <ku920601@realtek.com>
Signed-off-by: default avatarPing-Ke Shih <pkshih@realtek.com>
Signed-off-by: default avatarKalle Valo <kvalo@kernel.org>
Link: https://lore.kernel.org/r/20230308053225.24377-4-pkshih@realtek.com
parent 5049964c
......@@ -1809,6 +1809,9 @@ static void _fw_set_drv_info(struct rtw89_dev *rtwdev, u8 type)
{
struct rtw89_btc *btc = &rtwdev->btc;
const struct rtw89_btc_ver *ver = btc->ver;
struct rtw89_btc_dm *dm = &btc->dm;
struct rtw89_btc_wl_info *wl = &btc->cx.wl;
struct rtw89_btc_rf_trx_para rf_para = dm->rf_trx_para;
switch (type) {
case CXDRVINFO_INIT:
......@@ -1825,6 +1828,19 @@ static void _fw_set_drv_info(struct rtw89_dev *rtwdev, u8 type)
case CXDRVINFO_CTRL:
rtw89_fw_h2c_cxdrv_ctrl(rtwdev);
break;
case CXDRVINFO_TRX:
dm->trx_info.tx_power = u32_get_bits(rf_para.wl_tx_power,
RTW89_BTC_WL_DEF_TX_PWR);
dm->trx_info.rx_gain = u32_get_bits(rf_para.wl_rx_gain,
RTW89_BTC_WL_DEF_TX_PWR);
dm->trx_info.bt_tx_power = u32_get_bits(rf_para.bt_tx_power,
RTW89_BTC_WL_DEF_TX_PWR);
dm->trx_info.bt_rx_gain = u32_get_bits(rf_para.bt_rx_gain,
RTW89_BTC_WL_DEF_TX_PWR);
dm->trx_info.cn = wl->cn_report;
dm->trx_info.nhm = wl->nhm.pwr;
rtw89_fw_h2c_cxdrv_trx(rtwdev);
break;
case CXDRVINFO_RFK:
rtw89_fw_h2c_cxdrv_rfk(rtwdev);
break;
......@@ -5361,6 +5377,8 @@ void rtw89_btc_ntfy_icmp_packet_work(struct work_struct *work)
mutex_unlock(&rtwdev->mutex);
}
#define BT_PROFILE_PROTOCOL_MASK GENMASK(7, 4)
static void _update_bt_info(struct rtw89_dev *rtwdev, u8 *buf, u32 len)
{
const struct rtw89_chip_info *chip = rtwdev->chip;
......@@ -5417,6 +5435,7 @@ static void _update_bt_info(struct rtw89_dev *rtwdev, u8 *buf, u32 len)
a2dp->exist = btinfo.lb2.a2dp;
b->profile_cnt.now += (u8)a2dp->exist;
pan->active = btinfo.lb2.pan;
btc->dm.trx_info.bt_profile = u32_get_bits(btinfo.val, BT_PROFILE_PROTOCOL_MASK);
/* parse raw info low-Byte3 */
btinfo.val = bt->raw_info[BTC_BTINFO_L3];
......@@ -5433,6 +5452,7 @@ static void _update_bt_info(struct rtw89_dev *rtwdev, u8 *buf, u32 len)
btinfo.val = bt->raw_info[BTC_BTINFO_H0];
/* raw val is dBm unit, translate from -100~ 0dBm to 0~100%*/
b->rssi = chip->ops->btc_get_bt_rssi(rtwdev, btinfo.hb0.rssi);
btc->dm.trx_info.bt_rssi = b->rssi;
/* parse raw info high-Byte1 */
btinfo.val = bt->raw_info[BTC_BTINFO_H1];
......@@ -5766,6 +5786,8 @@ static void rtw89_btc_ntfy_wl_sta_iter(void *data, struct ieee80211_sta *sta)
(struct rtw89_btc_wl_sta_iter_data *)data;
struct rtw89_dev *rtwdev = iter_data->rtwdev;
struct rtw89_btc *btc = &rtwdev->btc;
struct rtw89_btc_dm *dm = &btc->dm;
const struct rtw89_btc_ver *ver = btc->ver;
struct rtw89_btc_wl_info *wl = &btc->cx.wl;
struct rtw89_btc_wl_link_info *link_info = NULL;
struct rtw89_sta *rtwsta = (struct rtw89_sta *)sta->drv_priv;
......@@ -5773,6 +5795,8 @@ static void rtw89_btc_ntfy_wl_sta_iter(void *data, struct ieee80211_sta *sta)
struct rtw89_vif *rtwvif = rtwsta->rtwvif;
struct rtw89_traffic_stats *stats = &rtwvif->stats;
const struct rtw89_chip_info *chip = rtwdev->chip;
struct rtw89_btc_wl_role_info *r;
struct rtw89_btc_wl_role_info_v1 *r1;
u32 last_tx_rate, last_rx_rate;
u16 last_tx_lvl, last_rx_lvl;
u8 port = rtwvif->port;
......@@ -5849,10 +5873,33 @@ static void rtw89_btc_ntfy_wl_sta_iter(void *data, struct ieee80211_sta *sta)
link_info_t->tx_rate = rtwsta->ra_report.hw_rate;
link_info_t->rx_rate = rtwsta->rx_hw_rate;
wl->role_info.active_role[port].tx_lvl = (u16)stats->tx_tfc_lv;
wl->role_info.active_role[port].rx_lvl = (u16)stats->rx_tfc_lv;
wl->role_info.active_role[port].tx_rate = rtwsta->ra_report.hw_rate;
wl->role_info.active_role[port].rx_rate = rtwsta->rx_hw_rate;
if (link_info->role == RTW89_WIFI_ROLE_STATION ||
link_info->role == RTW89_WIFI_ROLE_P2P_CLIENT) {
dm->trx_info.tx_rate = link_info_t->tx_rate;
dm->trx_info.rx_rate = link_info_t->rx_rate;
}
if (ver->fwlrole == 0) {
r = &wl->role_info;
r->active_role[port].tx_lvl = stats->tx_tfc_lv;
r->active_role[port].rx_lvl = stats->rx_tfc_lv;
r->active_role[port].tx_rate = rtwsta->ra_report.hw_rate;
r->active_role[port].rx_rate = rtwsta->rx_hw_rate;
} else if (ver->fwlrole == 1) {
r1 = &wl->role_info_v1;
r1->active_role_v1[port].tx_lvl = stats->tx_tfc_lv;
r1->active_role_v1[port].rx_lvl = stats->rx_tfc_lv;
r1->active_role_v1[port].tx_rate = rtwsta->ra_report.hw_rate;
r1->active_role_v1[port].rx_rate = rtwsta->rx_hw_rate;
} else if (ver->fwlrole == 2) {
dm->trx_info.tx_lvl = stats->tx_tfc_lv;
dm->trx_info.rx_lvl = stats->rx_tfc_lv;
dm->trx_info.tx_rate = rtwsta->ra_report.hw_rate;
dm->trx_info.rx_rate = rtwsta->rx_hw_rate;
}
dm->trx_info.tx_tp = link_info_t->tx_throughput;
dm->trx_info.rx_tp = link_info_t->rx_throughput;
if (is_sta_change)
iter_data->is_sta_change = true;
......@@ -5866,6 +5913,7 @@ static void rtw89_btc_ntfy_wl_sta_iter(void *data, struct ieee80211_sta *sta)
void rtw89_btc_ntfy_wl_sta(struct rtw89_dev *rtwdev)
{
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_wl_sta_iter_data data = {.rtwdev = rtwdev};
u8 i;
......@@ -5884,6 +5932,9 @@ void rtw89_btc_ntfy_wl_sta(struct rtw89_dev *rtwdev)
}
}
if (dm->trx_info.wl_rssi != wl->rssi_level)
dm->trx_info.wl_rssi = wl->rssi_level;
rtw89_debug(rtwdev, RTW89_DBG_BTC, "[BTC], %s(): busy=%d\n",
__func__, !!wl->status.map.busy);
......
......@@ -1367,6 +1367,22 @@ struct rtw89_btc_rf_para {
u32 rx_gain_perpkt;
};
struct rtw89_btc_wl_nhm {
u8 instant_wl_nhm_dbm;
u8 instant_wl_nhm_per_mhz;
u16 valid_record_times;
s8 record_pwr[16];
u8 record_ratio[16];
s8 pwr; /* dbm_per_MHz */
u8 ratio;
u8 current_status;
u8 refresh;
bool start_flag;
u8 last_ccx_rpt_stamp;
s8 pwr_max;
s8 pwr_min;
};
struct rtw89_btc_wl_info {
struct rtw89_btc_wl_link_info link_info[RTW89_PORT_NUM];
struct rtw89_btc_wl_rfk_info rfk_info;
......@@ -1378,10 +1394,12 @@ struct rtw89_btc_wl_info {
struct rtw89_btc_wl_scan_info scan_info;
struct rtw89_btc_wl_dbcc_info dbcc_info;
struct rtw89_btc_rf_para rf_para;
struct rtw89_btc_wl_nhm nhm;
union rtw89_btc_wl_state_map status;
u8 port_id[RTW89_WIFI_ROLE_MLME_MAX];
u8 rssi_level;
u8 cn_report;
bool scbd_change;
u32 scbd;
......@@ -2019,6 +2037,30 @@ struct rtw89_btc_rf_trx_para {
u8 bt_rx_gain; /* LNA constrain level */
};
struct rtw89_btc_trx_info {
u8 tx_lvl;
u8 rx_lvl;
u8 wl_rssi;
u8 bt_rssi;
s8 tx_power; /* absolute Tx power (dBm), 0xff-> no BTC control */
s8 rx_gain; /* rx gain table index (TBD.) */
s8 bt_tx_power; /* decrease Tx power (dB) */
s8 bt_rx_gain; /* LNA constrain level */
u8 cn; /* condition_num */
s8 nhm;
u8 bt_profile;
u8 rsvd2;
u16 tx_rate;
u16 rx_rate;
u32 tx_tp;
u32 rx_tp;
u32 rx_err_ratio;
};
struct rtw89_btc_dm {
struct rtw89_btc_fbtc_slot slot[CXST_MAX];
struct rtw89_btc_fbtc_slot slot_now[CXST_MAX];
......@@ -2030,6 +2072,7 @@ struct rtw89_btc_dm {
struct rtw89_btc_wl_tx_limit_para wl_tx_limit;
struct rtw89_btc_dm_step dm_step;
struct rtw89_btc_wl_scc_ctrl wl_scc;
struct rtw89_btc_trx_info trx_info;
union rtw89_btc_dm_error_map error;
u32 cnt_dm[BTC_DCNT_NUM];
u32 cnt_notify[BTC_NCNT_NUM];
......
......@@ -2169,6 +2169,62 @@ int rtw89_fw_h2c_cxdrv_ctrl(struct rtw89_dev *rtwdev)
return ret;
}
#define H2C_LEN_CXDRVINFO_TRX (28 + H2C_LEN_CXDRVHDR)
int rtw89_fw_h2c_cxdrv_trx(struct rtw89_dev *rtwdev)
{
struct rtw89_btc *btc = &rtwdev->btc;
struct rtw89_btc_trx_info *trx = &btc->dm.trx_info;
struct sk_buff *skb;
u8 *cmd;
int ret;
skb = rtw89_fw_h2c_alloc_skb_with_hdr(rtwdev, H2C_LEN_CXDRVINFO_TRX);
if (!skb) {
rtw89_err(rtwdev, "failed to alloc skb for h2c cxdrv_trx\n");
return -ENOMEM;
}
skb_put(skb, H2C_LEN_CXDRVINFO_TRX);
cmd = skb->data;
RTW89_SET_FWCMD_CXHDR_TYPE(cmd, CXDRVINFO_TRX);
RTW89_SET_FWCMD_CXHDR_LEN(cmd, H2C_LEN_CXDRVINFO_TRX - H2C_LEN_CXDRVHDR);
RTW89_SET_FWCMD_CXTRX_TXLV(cmd, trx->tx_lvl);
RTW89_SET_FWCMD_CXTRX_RXLV(cmd, trx->rx_lvl);
RTW89_SET_FWCMD_CXTRX_WLRSSI(cmd, trx->wl_rssi);
RTW89_SET_FWCMD_CXTRX_BTRSSI(cmd, trx->bt_rssi);
RTW89_SET_FWCMD_CXTRX_TXPWR(cmd, trx->tx_power);
RTW89_SET_FWCMD_CXTRX_RXGAIN(cmd, trx->rx_gain);
RTW89_SET_FWCMD_CXTRX_BTTXPWR(cmd, trx->bt_tx_power);
RTW89_SET_FWCMD_CXTRX_BTRXGAIN(cmd, trx->bt_rx_gain);
RTW89_SET_FWCMD_CXTRX_CN(cmd, trx->cn);
RTW89_SET_FWCMD_CXTRX_NHM(cmd, trx->nhm);
RTW89_SET_FWCMD_CXTRX_BTPROFILE(cmd, trx->bt_profile);
RTW89_SET_FWCMD_CXTRX_RSVD2(cmd, trx->rsvd2);
RTW89_SET_FWCMD_CXTRX_TXRATE(cmd, trx->tx_rate);
RTW89_SET_FWCMD_CXTRX_RXRATE(cmd, trx->rx_rate);
RTW89_SET_FWCMD_CXTRX_TXTP(cmd, trx->tx_tp);
RTW89_SET_FWCMD_CXTRX_RXTP(cmd, trx->rx_tp);
RTW89_SET_FWCMD_CXTRX_RXERRRA(cmd, trx->rx_err_ratio);
rtw89_h2c_pkt_set_hdr(rtwdev, skb, FWCMD_TYPE_H2C,
H2C_CAT_OUTSRC, BTFC_SET,
SET_DRV_INFO, 0, 0,
H2C_LEN_CXDRVINFO_TRX);
ret = rtw89_h2c_tx(rtwdev, skb, false);
if (ret) {
rtw89_err(rtwdev, "failed to send h2c\n");
goto fail;
}
return 0;
fail:
dev_kfree_skb_any(skb);
return ret;
}
#define H2C_LEN_CXDRVINFO_RFK (4 + H2C_LEN_CXDRVHDR)
int rtw89_fw_h2c_cxdrv_rfk(struct rtw89_dev *rtwdev)
{
......
......@@ -2152,6 +2152,7 @@ enum rtw89_btc_cxdrvinfo {
CXDRVINFO_RUN,
CXDRVINFO_CTRL,
CXDRVINFO_SCAN,
CXDRVINFO_TRX, /* WL traffic to WL fw */
CXDRVINFO_MAX,
};
......@@ -2493,6 +2494,91 @@ static inline void RTW89_SET_FWCMD_CXCTRL_TRACE_STEP(void *cmd, u32 val)
le32p_replace_bits((__le32 *)((u8 *)(cmd) + 2), val, GENMASK(18, 3));
}
static inline void RTW89_SET_FWCMD_CXTRX_TXLV(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 2, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RXLV(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 3, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_WLRSSI(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 4, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_BTRSSI(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 5, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_TXPWR(void *cmd, s8 val)
{
u8p_replace_bits((u8 *)cmd + 6, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RXGAIN(void *cmd, s8 val)
{
u8p_replace_bits((u8 *)cmd + 7, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_BTTXPWR(void *cmd, s8 val)
{
u8p_replace_bits((u8 *)cmd + 8, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_BTRXGAIN(void *cmd, s8 val)
{
u8p_replace_bits((u8 *)cmd + 9, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_CN(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 10, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_NHM(void *cmd, s8 val)
{
u8p_replace_bits((u8 *)cmd + 11, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_BTPROFILE(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 12, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RSVD2(void *cmd, u8 val)
{
u8p_replace_bits((u8 *)cmd + 13, val, GENMASK(7, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_TXRATE(void *cmd, u16 val)
{
le16p_replace_bits((__le16 *)((u8 *)cmd + 14), val, GENMASK(15, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RXRATE(void *cmd, u16 val)
{
le16p_replace_bits((__le16 *)((u8 *)cmd + 16), val, GENMASK(15, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_TXTP(void *cmd, u32 val)
{
le32p_replace_bits((__le32 *)((u8 *)cmd + 18), val, GENMASK(31, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RXTP(void *cmd, u32 val)
{
le32p_replace_bits((__le32 *)((u8 *)cmd + 22), val, GENMASK(31, 0));
}
static inline void RTW89_SET_FWCMD_CXTRX_RXERRRA(void *cmd, u32 val)
{
le32p_replace_bits((__le32 *)((u8 *)cmd + 26), val, GENMASK(31, 0));
}
static inline void RTW89_SET_FWCMD_CXRFK_STATE(void *cmd, u32 val)
{
le32p_replace_bits((__le32 *)((u8 *)(cmd) + 2), val, GENMASK(1, 0));
......@@ -3557,6 +3643,7 @@ int rtw89_fw_h2c_cxdrv_role(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_cxdrv_role_v1(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_cxdrv_role_v2(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_cxdrv_ctrl(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_cxdrv_trx(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_cxdrv_rfk(struct rtw89_dev *rtwdev);
int rtw89_fw_h2c_del_pkt_offload(struct rtw89_dev *rtwdev, u8 id);
int rtw89_fw_h2c_add_pkt_offload(struct rtw89_dev *rtwdev, u8 *id,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment