mac80211_hwsim: add PMSR report support via virtio
PMSR (a.k.a. peer measurement) is generalized measurement between two devices with Wi-Fi support. And currently FTM (a.k.a. fine time measurement or flight time measurement) is the one and only measurement. Add the necessary functionality to allow mac80211_hwsim to report PMSR result. The result would come from the wmediumd, where other Wi-Fi devices' information are kept. mac80211_hwsim only need to deliver the result to the userspace. In detail, add new mac80211_hwsim attributes HWSIM_CMD_REPORT_PMSR, and HWSIM_ATTR_PMSR_RESULT. When mac80211_hwsim receives the PMSR result with command HWSIM_CMD_REPORT_PMSR and detail with attribute HWSIM_ATTR_PMSR_RESULT, received data is parsed to cfg80211_pmsr_result and resent to the userspace by cfg80211_pmsr_report(). To help receive the details of PMSR result, hwsim_rate_info_attributes is added to receive rate_info without complex bitrate calculation. (i.e. send rate_info without adding inverse of nl80211_put_sta_rate()). Signed-off-by: Jaewan Kim <jaewan@google.com> Link: https://lore.kernel.org/r/20230322131637.2633968-6-jaewan@google.com [fix uninitialized return value when there are no reports] Signed-off-by: Johannes Berg <johannes.berg@intel.com>
This commit is contained in:
parent
8ba1da9505
commit
2af3b2a631
@ -752,6 +752,11 @@ struct hwsim_radiotap_ack_hdr {
|
||||
__le16 rt_chbitmask;
|
||||
} __packed;
|
||||
|
||||
static struct mac80211_hwsim_data *get_hwsim_data_ref_from_addr(const u8 *addr)
|
||||
{
|
||||
return rhashtable_lookup_fast(&hwsim_radios_rht, addr, hwsim_rht_params);
|
||||
}
|
||||
|
||||
/* MAC80211_HWSIM netlink family */
|
||||
static struct genl_family hwsim_genl_family;
|
||||
|
||||
@ -765,6 +770,76 @@ static const struct genl_multicast_group hwsim_mcgrps[] = {
|
||||
|
||||
/* MAC80211_HWSIM netlink policy */
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_rate_info_policy[HWSIM_RATE_INFO_ATTR_MAX + 1] = {
|
||||
[HWSIM_RATE_INFO_ATTR_FLAGS] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_MCS] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_LEGACY] = { .type = NLA_U16 },
|
||||
[HWSIM_RATE_INFO_ATTR_NSS] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_BW] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_HE_GI] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_HE_DCM] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_HE_RU_ALLOC] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_N_BOUNDED_CH] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_EHT_GI] = { .type = NLA_U8 },
|
||||
[HWSIM_RATE_INFO_ATTR_EHT_RU_ALLOC] = { .type = NLA_U8 },
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_ftm_result_policy[NL80211_PMSR_FTM_RESP_ATTR_MAX + 1] = {
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_FAIL_REASON] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_BURST_INDEX] = { .type = NLA_U16 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_ATTEMPTS] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_SUCCESSES] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_BUSY_RETRY_TIME] = { .type = NLA_U8 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_NUM_BURSTS_EXP] = { .type = NLA_U8 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_BURST_DURATION] = { .type = NLA_U8 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RSSI_AVG] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RSSI_SPREAD] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_TX_RATE] = NLA_POLICY_NESTED(hwsim_rate_info_policy),
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RX_RATE] = NLA_POLICY_NESTED(hwsim_rate_info_policy),
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RTT_AVG] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RTT_VARIANCE] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_RTT_SPREAD] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_DIST_AVG] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_DIST_VARIANCE] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_DIST_SPREAD] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_LCI] = { .type = NLA_STRING },
|
||||
[NL80211_PMSR_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_STRING },
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_pmsr_resp_type_policy[NL80211_PMSR_TYPE_MAX + 1] = {
|
||||
[NL80211_PMSR_TYPE_FTM] = NLA_POLICY_NESTED(hwsim_ftm_result_policy),
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_pmsr_resp_policy[NL80211_PMSR_RESP_ATTR_MAX + 1] = {
|
||||
[NL80211_PMSR_RESP_ATTR_STATUS] = { .type = NLA_U32 },
|
||||
[NL80211_PMSR_RESP_ATTR_HOST_TIME] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_RESP_ATTR_AP_TSF] = { .type = NLA_U64 },
|
||||
[NL80211_PMSR_RESP_ATTR_FINAL] = { .type = NLA_FLAG },
|
||||
[NL80211_PMSR_RESP_ATTR_DATA] = NLA_POLICY_NESTED(hwsim_pmsr_resp_type_policy),
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_pmsr_peer_result_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
|
||||
[NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR_COMPAT,
|
||||
[NL80211_PMSR_PEER_ATTR_CHAN] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_PEER_ATTR_REQ] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_PEER_ATTR_RESP] = NLA_POLICY_NESTED(hwsim_pmsr_resp_policy),
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_pmsr_peers_result_policy[NL80211_PMSR_ATTR_MAX + 1] = {
|
||||
[NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
|
||||
[NL80211_PMSR_ATTR_PEERS] = NLA_POLICY_NESTED_ARRAY(hwsim_pmsr_peer_result_policy),
|
||||
};
|
||||
|
||||
static const struct nla_policy
|
||||
hwsim_ftm_capa_policy[NL80211_PMSR_FTM_CAPA_ATTR_MAX + 1] = {
|
||||
[NL80211_PMSR_FTM_CAPA_ATTR_ASAP] = { .type = NLA_FLAG },
|
||||
@ -822,6 +897,7 @@ static const struct nla_policy hwsim_genl_policy[HWSIM_ATTR_MAX + 1] = {
|
||||
[HWSIM_ATTR_CIPHER_SUPPORT] = { .type = NLA_BINARY },
|
||||
[HWSIM_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG },
|
||||
[HWSIM_ATTR_PMSR_SUPPORT] = NLA_POLICY_NESTED(hwsim_pmsr_capa_policy),
|
||||
[HWSIM_ATTR_PMSR_RESULT] = NLA_POLICY_NESTED(hwsim_pmsr_peers_result_policy),
|
||||
};
|
||||
|
||||
#if IS_REACHABLE(CONFIG_VIRTIO)
|
||||
@ -3438,6 +3514,297 @@ out:
|
||||
mutex_unlock(&data->mutex);
|
||||
}
|
||||
|
||||
static int mac80211_hwsim_parse_rate_info(struct nlattr *rateattr,
|
||||
struct rate_info *rate_info,
|
||||
struct genl_info *info)
|
||||
{
|
||||
struct nlattr *tb[HWSIM_RATE_INFO_ATTR_MAX + 1];
|
||||
int ret;
|
||||
|
||||
ret = nla_parse_nested(tb, HWSIM_RATE_INFO_ATTR_MAX,
|
||||
rateattr, hwsim_rate_info_policy, info->extack);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_FLAGS])
|
||||
rate_info->flags = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_FLAGS]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_MCS])
|
||||
rate_info->mcs = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_MCS]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_LEGACY])
|
||||
rate_info->legacy = nla_get_u16(tb[HWSIM_RATE_INFO_ATTR_LEGACY]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_NSS])
|
||||
rate_info->nss = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_NSS]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_BW])
|
||||
rate_info->bw = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_BW]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_HE_GI])
|
||||
rate_info->he_gi = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_HE_GI]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_HE_DCM])
|
||||
rate_info->he_dcm = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_HE_DCM]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_HE_RU_ALLOC])
|
||||
rate_info->he_ru_alloc =
|
||||
nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_HE_RU_ALLOC]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_N_BOUNDED_CH])
|
||||
rate_info->n_bonded_ch = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_N_BOUNDED_CH]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_EHT_GI])
|
||||
rate_info->eht_gi = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_EHT_GI]);
|
||||
|
||||
if (tb[HWSIM_RATE_INFO_ATTR_EHT_RU_ALLOC])
|
||||
rate_info->eht_ru_alloc = nla_get_u8(tb[HWSIM_RATE_INFO_ATTR_EHT_RU_ALLOC]);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mac80211_hwsim_parse_ftm_result(struct nlattr *ftm,
|
||||
struct cfg80211_pmsr_ftm_result *result,
|
||||
struct genl_info *info)
|
||||
{
|
||||
struct nlattr *tb[NL80211_PMSR_FTM_RESP_ATTR_MAX + 1];
|
||||
int ret;
|
||||
|
||||
ret = nla_parse_nested(tb, NL80211_PMSR_FTM_RESP_ATTR_MAX,
|
||||
ftm, hwsim_ftm_result_policy, info->extack);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_FAIL_REASON])
|
||||
result->failure_reason = nla_get_u32(tb[NL80211_PMSR_FTM_RESP_ATTR_FAIL_REASON]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_BURST_INDEX])
|
||||
result->burst_index = nla_get_u16(tb[NL80211_PMSR_FTM_RESP_ATTR_BURST_INDEX]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_ATTEMPTS]) {
|
||||
result->num_ftmr_attempts_valid = 1;
|
||||
result->num_ftmr_attempts =
|
||||
nla_get_u32(tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_ATTEMPTS]);
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_SUCCESSES]) {
|
||||
result->num_ftmr_successes_valid = 1;
|
||||
result->num_ftmr_successes =
|
||||
nla_get_u32(tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_FTMR_SUCCESSES]);
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_BUSY_RETRY_TIME])
|
||||
result->busy_retry_time =
|
||||
nla_get_u8(tb[NL80211_PMSR_FTM_RESP_ATTR_BUSY_RETRY_TIME]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_BURSTS_EXP])
|
||||
result->num_bursts_exp = nla_get_u8(tb[NL80211_PMSR_FTM_RESP_ATTR_NUM_BURSTS_EXP]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_BURST_DURATION])
|
||||
result->burst_duration = nla_get_u8(tb[NL80211_PMSR_FTM_RESP_ATTR_BURST_DURATION]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_FTMS_PER_BURST])
|
||||
result->ftms_per_burst = nla_get_u8(tb[NL80211_PMSR_FTM_RESP_ATTR_FTMS_PER_BURST]);
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RSSI_AVG]) {
|
||||
result->rssi_avg_valid = 1;
|
||||
result->rssi_avg = nla_get_s32(tb[NL80211_PMSR_FTM_RESP_ATTR_RSSI_AVG]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RSSI_SPREAD]) {
|
||||
result->rssi_spread_valid = 1;
|
||||
result->rssi_spread =
|
||||
nla_get_s32(tb[NL80211_PMSR_FTM_RESP_ATTR_RSSI_SPREAD]);
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_TX_RATE]) {
|
||||
result->tx_rate_valid = 1;
|
||||
ret = mac80211_hwsim_parse_rate_info(tb[NL80211_PMSR_FTM_RESP_ATTR_TX_RATE],
|
||||
&result->tx_rate, info);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RX_RATE]) {
|
||||
result->rx_rate_valid = 1;
|
||||
ret = mac80211_hwsim_parse_rate_info(tb[NL80211_PMSR_FTM_RESP_ATTR_RX_RATE],
|
||||
&result->rx_rate, info);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_AVG]) {
|
||||
result->rtt_avg_valid = 1;
|
||||
result->rtt_avg =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_AVG]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_VARIANCE]) {
|
||||
result->rtt_variance_valid = 1;
|
||||
result->rtt_variance =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_VARIANCE]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_SPREAD]) {
|
||||
result->rtt_spread_valid = 1;
|
||||
result->rtt_spread =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_RTT_SPREAD]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_AVG]) {
|
||||
result->dist_avg_valid = 1;
|
||||
result->dist_avg =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_AVG]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_VARIANCE]) {
|
||||
result->dist_variance_valid = 1;
|
||||
result->dist_variance =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_VARIANCE]);
|
||||
}
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_SPREAD]) {
|
||||
result->dist_spread_valid = 1;
|
||||
result->dist_spread =
|
||||
nla_get_u64(tb[NL80211_PMSR_FTM_RESP_ATTR_DIST_SPREAD]);
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_LCI]) {
|
||||
result->lci = nla_data(tb[NL80211_PMSR_FTM_RESP_ATTR_LCI]);
|
||||
result->lci_len = nla_len(tb[NL80211_PMSR_FTM_RESP_ATTR_LCI]);
|
||||
}
|
||||
|
||||
if (tb[NL80211_PMSR_FTM_RESP_ATTR_CIVICLOC]) {
|
||||
result->civicloc = nla_data(tb[NL80211_PMSR_FTM_RESP_ATTR_CIVICLOC]);
|
||||
result->civicloc_len = nla_len(tb[NL80211_PMSR_FTM_RESP_ATTR_CIVICLOC]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mac80211_hwsim_parse_pmsr_resp(struct nlattr *resp,
|
||||
struct cfg80211_pmsr_result *result,
|
||||
struct genl_info *info)
|
||||
{
|
||||
struct nlattr *tb[NL80211_PMSR_RESP_ATTR_MAX + 1];
|
||||
struct nlattr *pmsr;
|
||||
int rem;
|
||||
int ret;
|
||||
|
||||
ret = nla_parse_nested(tb, NL80211_PMSR_RESP_ATTR_MAX, resp, hwsim_pmsr_resp_policy,
|
||||
info->extack);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (tb[NL80211_PMSR_RESP_ATTR_STATUS])
|
||||
result->status = nla_get_u32(tb[NL80211_PMSR_RESP_ATTR_STATUS]);
|
||||
|
||||
if (tb[NL80211_PMSR_RESP_ATTR_HOST_TIME])
|
||||
result->host_time = nla_get_u64(tb[NL80211_PMSR_RESP_ATTR_HOST_TIME]);
|
||||
|
||||
if (tb[NL80211_PMSR_RESP_ATTR_AP_TSF]) {
|
||||
result->ap_tsf_valid = 1;
|
||||
result->ap_tsf = nla_get_u64(tb[NL80211_PMSR_RESP_ATTR_AP_TSF]);
|
||||
}
|
||||
|
||||
result->final = !!tb[NL80211_PMSR_RESP_ATTR_FINAL];
|
||||
|
||||
if (!tb[NL80211_PMSR_RESP_ATTR_DATA])
|
||||
return 0;
|
||||
|
||||
nla_for_each_nested(pmsr, tb[NL80211_PMSR_RESP_ATTR_DATA], rem) {
|
||||
switch (nla_type(pmsr)) {
|
||||
case NL80211_PMSR_TYPE_FTM:
|
||||
result->type = NL80211_PMSR_TYPE_FTM;
|
||||
ret = mac80211_hwsim_parse_ftm_result(pmsr, &result->ftm, info);
|
||||
if (ret)
|
||||
return ret;
|
||||
break;
|
||||
default:
|
||||
NL_SET_ERR_MSG_ATTR(info->extack, pmsr, "Unknown pmsr resp type");
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mac80211_hwsim_parse_pmsr_result(struct nlattr *peer,
|
||||
struct cfg80211_pmsr_result *result,
|
||||
struct genl_info *info)
|
||||
{
|
||||
struct nlattr *tb[NL80211_PMSR_PEER_ATTR_MAX + 1];
|
||||
int ret;
|
||||
|
||||
if (!peer)
|
||||
return -EINVAL;
|
||||
|
||||
ret = nla_parse_nested(tb, NL80211_PMSR_PEER_ATTR_MAX, peer,
|
||||
hwsim_pmsr_peer_result_policy, info->extack);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (tb[NL80211_PMSR_PEER_ATTR_ADDR])
|
||||
memcpy(result->addr, nla_data(tb[NL80211_PMSR_PEER_ATTR_ADDR]),
|
||||
ETH_ALEN);
|
||||
|
||||
if (tb[NL80211_PMSR_PEER_ATTR_RESP]) {
|
||||
ret = mac80211_hwsim_parse_pmsr_resp(tb[NL80211_PMSR_PEER_ATTR_RESP], result, info);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
};
|
||||
|
||||
static int hwsim_pmsr_report_nl(struct sk_buff *msg, struct genl_info *info)
|
||||
{
|
||||
struct mac80211_hwsim_data *data;
|
||||
struct nlattr *peers, *peer;
|
||||
struct nlattr *reqattr;
|
||||
const u8 *src;
|
||||
int err;
|
||||
int rem;
|
||||
|
||||
src = nla_data(info->attrs[HWSIM_ATTR_ADDR_TRANSMITTER]);
|
||||
data = get_hwsim_data_ref_from_addr(src);
|
||||
if (!data)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
if (!data->pmsr_request) {
|
||||
err = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
|
||||
reqattr = info->attrs[HWSIM_ATTR_PMSR_RESULT];
|
||||
if (!reqattr) {
|
||||
err = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
|
||||
peers = nla_find_nested(reqattr, NL80211_PMSR_ATTR_PEERS);
|
||||
if (!peers) {
|
||||
err = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
|
||||
nla_for_each_nested(peer, peers, rem) {
|
||||
struct cfg80211_pmsr_result result;
|
||||
|
||||
err = mac80211_hwsim_parse_pmsr_result(peer, &result, info);
|
||||
if (err)
|
||||
goto out;
|
||||
|
||||
cfg80211_pmsr_report(data->pmsr_request_wdev,
|
||||
data->pmsr_request, &result, GFP_KERNEL);
|
||||
}
|
||||
|
||||
cfg80211_pmsr_complete(data->pmsr_request_wdev, data->pmsr_request, GFP_KERNEL);
|
||||
|
||||
err = 0;
|
||||
out:
|
||||
data->pmsr_request = NULL;
|
||||
data->pmsr_request_wdev = NULL;
|
||||
|
||||
mutex_unlock(&data->mutex);
|
||||
return err;
|
||||
}
|
||||
|
||||
#define HWSIM_COMMON_OPS \
|
||||
.tx = mac80211_hwsim_tx, \
|
||||
.wake_tx_queue = ieee80211_handle_wake_tx_queue, \
|
||||
@ -5113,13 +5480,6 @@ static void hwsim_mon_setup(struct net_device *dev)
|
||||
eth_hw_addr_set(dev, addr);
|
||||
}
|
||||
|
||||
static struct mac80211_hwsim_data *get_hwsim_data_ref_from_addr(const u8 *addr)
|
||||
{
|
||||
return rhashtable_lookup_fast(&hwsim_radios_rht,
|
||||
addr,
|
||||
hwsim_rht_params);
|
||||
}
|
||||
|
||||
static void hwsim_register_wmediumd(struct net *net, u32 portid)
|
||||
{
|
||||
struct mac80211_hwsim_data *data;
|
||||
@ -5790,6 +6150,11 @@ static const struct genl_small_ops hwsim_ops[] = {
|
||||
.doit = hwsim_get_radio_nl,
|
||||
.dumpit = hwsim_dump_radio_nl,
|
||||
},
|
||||
{
|
||||
.cmd = HWSIM_CMD_REPORT_PMSR,
|
||||
.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
|
||||
.doit = hwsim_pmsr_report_nl,
|
||||
},
|
||||
};
|
||||
|
||||
static struct genl_family hwsim_genl_family __ro_after_init = {
|
||||
@ -5801,7 +6166,7 @@ static struct genl_family hwsim_genl_family __ro_after_init = {
|
||||
.module = THIS_MODULE,
|
||||
.small_ops = hwsim_ops,
|
||||
.n_small_ops = ARRAY_SIZE(hwsim_ops),
|
||||
.resv_start_op = HWSIM_CMD_DEL_MAC_ADDR + 1,
|
||||
.resv_start_op = HWSIM_CMD_REPORT_PMSR + 1, // match with __HWSIM_CMD_MAX
|
||||
.mcgrps = hwsim_mcgrps,
|
||||
.n_mcgrps = ARRAY_SIZE(hwsim_mcgrps),
|
||||
};
|
||||
@ -5970,6 +6335,9 @@ static int hwsim_virtio_handle_cmd(struct sk_buff *skb)
|
||||
case HWSIM_CMD_TX_INFO_FRAME:
|
||||
hwsim_tx_info_frame_received_nl(skb, &info);
|
||||
break;
|
||||
case HWSIM_CMD_REPORT_PMSR:
|
||||
hwsim_pmsr_report_nl(skb, &info);
|
||||
break;
|
||||
default:
|
||||
pr_err_ratelimited("hwsim: invalid cmd: %d\n", gnlh->cmd);
|
||||
return -EPROTO;
|
||||
|
@ -82,8 +82,8 @@ enum hwsim_tx_control_flags {
|
||||
* @HWSIM_CMD_DEL_MAC_ADDR: remove the MAC address again, the attributes
|
||||
* are the same as to @HWSIM_CMD_ADD_MAC_ADDR.
|
||||
* @HWSIM_CMD_START_PMSR: request to start peer measurement with the
|
||||
* %HWSIM_ATTR_PMSR_REQUEST.
|
||||
* @HWSIM_CMD_ABORT_PMSR: abort previously sent peer measurement
|
||||
* %HWSIM_ATTR_PMSR_REQUEST. Result will be sent back asynchronously
|
||||
* with %HWSIM_CMD_REPORT_PMSR.
|
||||
* @__HWSIM_CMD_MAX: enum limit
|
||||
*/
|
||||
enum {
|
||||
@ -98,6 +98,7 @@ enum {
|
||||
HWSIM_CMD_DEL_MAC_ADDR,
|
||||
HWSIM_CMD_START_PMSR,
|
||||
HWSIM_CMD_ABORT_PMSR,
|
||||
HWSIM_CMD_REPORT_PMSR,
|
||||
__HWSIM_CMD_MAX,
|
||||
};
|
||||
#define HWSIM_CMD_MAX (_HWSIM_CMD_MAX - 1)
|
||||
@ -151,6 +152,8 @@ enum {
|
||||
* to provide peer measurement capabilities. (nl80211_peer_measurement_attrs)
|
||||
* @HWSIM_ATTR_PMSR_REQUEST: nested attribute used with %HWSIM_CMD_START_PMSR
|
||||
* to provide details about peer measurement request (nl80211_peer_measurement_attrs)
|
||||
* @HWSIM_ATTR_PMSR_RESULT: nested attributed used with %HWSIM_CMD_REPORT_PMSR
|
||||
* to provide peer measurement result (nl80211_peer_measurement_attrs)
|
||||
* @__HWSIM_ATTR_MAX: enum limit
|
||||
*/
|
||||
|
||||
@ -184,6 +187,7 @@ enum {
|
||||
HWSIM_ATTR_MLO_SUPPORT,
|
||||
HWSIM_ATTR_PMSR_SUPPORT,
|
||||
HWSIM_ATTR_PMSR_REQUEST,
|
||||
HWSIM_ATTR_PMSR_RESULT,
|
||||
__HWSIM_ATTR_MAX,
|
||||
};
|
||||
#define HWSIM_ATTR_MAX (__HWSIM_ATTR_MAX - 1)
|
||||
@ -288,4 +292,47 @@ enum {
|
||||
HWSIM_VQ_RX,
|
||||
HWSIM_NUM_VQS,
|
||||
};
|
||||
|
||||
/**
|
||||
* enum hwsim_rate_info -- bitrate information.
|
||||
*
|
||||
* Information about a receiving or transmitting bitrate
|
||||
* that can be mapped to struct rate_info
|
||||
*
|
||||
* @HWSIM_RATE_INFO_ATTR_FLAGS: bitflag of flags from &enum rate_info_flags
|
||||
* @HWSIM_RATE_INFO_ATTR_MCS: mcs index if struct describes an HT/VHT/HE rate
|
||||
* @HWSIM_RATE_INFO_ATTR_LEGACY: bitrate in 100kbit/s for 802.11abg
|
||||
* @HWSIM_RATE_INFO_ATTR_NSS: number of streams (VHT & HE only)
|
||||
* @HWSIM_RATE_INFO_ATTR_BW: bandwidth (from &enum rate_info_bw)
|
||||
* @HWSIM_RATE_INFO_ATTR_HE_GI: HE guard interval (from &enum nl80211_he_gi)
|
||||
* @HWSIM_RATE_INFO_ATTR_HE_DCM: HE DCM value
|
||||
* @HWSIM_RATE_INFO_ATTR_HE_RU_ALLOC: HE RU allocation (from &enum nl80211_he_ru_alloc,
|
||||
* only valid if bw is %RATE_INFO_BW_HE_RU)
|
||||
* @HWSIM_RATE_INFO_ATTR_N_BOUNDED_CH: In case of EDMG the number of bonded channels (1-4)
|
||||
* @HWSIM_RATE_INFO_ATTR_EHT_GI: EHT guard interval (from &enum nl80211_eht_gi)
|
||||
* @HWSIM_RATE_INFO_ATTR_EHT_RU_ALLOC: EHT RU allocation (from &enum nl80211_eht_ru_alloc,
|
||||
* only valid if bw is %RATE_INFO_BW_EHT_RU)
|
||||
* @NUM_HWSIM_RATE_INFO_ATTRS: internal
|
||||
* @HWSIM_RATE_INFO_ATTR_MAX: highest attribute number
|
||||
*/
|
||||
enum hwsim_rate_info_attributes {
|
||||
__HWSIM_RATE_INFO_ATTR_INVALID,
|
||||
|
||||
HWSIM_RATE_INFO_ATTR_FLAGS,
|
||||
HWSIM_RATE_INFO_ATTR_MCS,
|
||||
HWSIM_RATE_INFO_ATTR_LEGACY,
|
||||
HWSIM_RATE_INFO_ATTR_NSS,
|
||||
HWSIM_RATE_INFO_ATTR_BW,
|
||||
HWSIM_RATE_INFO_ATTR_HE_GI,
|
||||
HWSIM_RATE_INFO_ATTR_HE_DCM,
|
||||
HWSIM_RATE_INFO_ATTR_HE_RU_ALLOC,
|
||||
HWSIM_RATE_INFO_ATTR_N_BOUNDED_CH,
|
||||
HWSIM_RATE_INFO_ATTR_EHT_GI,
|
||||
HWSIM_RATE_INFO_ATTR_EHT_RU_ALLOC,
|
||||
|
||||
/* keep last */
|
||||
NUM_HWSIM_RATE_INFO_ATTRS,
|
||||
HWSIM_RATE_INFO_ATTR_MAX = NUM_HWSIM_RATE_INFO_ATTRS - 1
|
||||
};
|
||||
|
||||
#endif /* __MAC80211_HWSIM_H */
|
||||
|
Loading…
x
Reference in New Issue
Block a user