2020-03-13 13:07:23 +00:00
|
|
|
--- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/cfg80211.c
|
|
|
|
+++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/cfg80211.c
|
2021-10-09 14:25:30 +00:00
|
|
|
@@ -2913,6 +2913,63 @@ done:
|
2020-01-28 10:28:03 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
+brcmf_cfg80211_dump_survey(struct wiphy *wiphy, struct net_device *ndev,
|
|
|
|
+ int idx, struct survey_info *survey)
|
|
|
|
+{
|
|
|
|
+ struct brcmf_cfg80211_info *cfg = wiphy_to_cfg(wiphy);
|
|
|
|
+ struct brcmf_if *ifp = netdev_priv(ndev);
|
|
|
|
+ struct brcmu_chan ch;
|
|
|
|
+ enum nl80211_band band = 0;
|
|
|
|
+ s32 err = 0;
|
|
|
|
+ int noise;
|
|
|
|
+ u32 freq;
|
|
|
|
+ u32 chanspec;
|
|
|
|
+
|
|
|
|
+ memset(survey, 0, sizeof(struct survey_info));
|
|
|
|
+ if (idx != 0) {
|
|
|
|
+ if (idx >= cfg->pub->num_chan_stats || cfg->pub->chan_stats == NULL)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+ if (cfg->pub->chan_stats[idx].freq == 0)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+ survey->filled = SURVEY_INFO_NOISE_DBM;
|
|
|
|
+ survey->channel = ieee80211_get_channel(wiphy, cfg->pub->chan_stats[idx].freq);
|
|
|
|
+ survey->noise = cfg->pub->chan_stats[idx].noise;
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ err = brcmf_fil_iovar_int_get(ifp, "chanspec", &chanspec);
|
|
|
|
+ if (err) {
|
|
|
|
+ brcmf_err("chanspec failed (%d)\n", err);
|
|
|
|
+ return err;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ch.chspec = chanspec;
|
|
|
|
+ cfg->d11inf.decchspec(&ch);
|
|
|
|
+
|
|
|
|
+ switch (ch.band) {
|
|
|
|
+ case BRCMU_CHAN_BAND_2G:
|
|
|
|
+ band = NL80211_BAND_2GHZ;
|
|
|
|
+ break;
|
|
|
|
+ case BRCMU_CHAN_BAND_5G:
|
|
|
|
+ band = NL80211_BAND_5GHZ;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ freq = ieee80211_channel_to_frequency(ch.control_ch_num, band);
|
|
|
|
+ survey->channel = ieee80211_get_channel(wiphy, freq);
|
|
|
|
+
|
|
|
|
+ err = brcmf_fil_cmd_int_get(ifp, BRCMF_C_GET_PHY_NOISE, &noise);
|
|
|
|
+ if (err) {
|
|
|
|
+ brcmf_err("Could not get noise (%d)\n", err);
|
|
|
|
+ return err;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ survey->filled = SURVEY_INFO_NOISE_DBM | SURVEY_INFO_IN_USE;
|
|
|
|
+ survey->noise = le32_to_cpu(noise);
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int
|
|
|
|
brcmf_cfg80211_dump_station(struct wiphy *wiphy, struct net_device *ndev,
|
|
|
|
int idx, u8 *mac, struct station_info *sinfo)
|
|
|
|
{
|
2021-10-10 19:24:14 +00:00
|
|
|
@@ -3013,6 +3070,7 @@ static s32 brcmf_inform_single_bss(struc
|
2020-01-28 10:28:03 +00:00
|
|
|
struct brcmu_chan ch;
|
|
|
|
u16 channel;
|
|
|
|
u32 freq;
|
|
|
|
+ int i;
|
|
|
|
u16 notify_capability;
|
|
|
|
u16 notify_interval;
|
|
|
|
u8 *notify_ie;
|
2021-10-10 19:24:14 +00:00
|
|
|
@@ -3037,6 +3095,17 @@ static s32 brcmf_inform_single_bss(struc
|
2020-01-28 10:28:03 +00:00
|
|
|
band = NL80211_BAND_5GHZ;
|
|
|
|
|
|
|
|
freq = ieee80211_channel_to_frequency(channel, band);
|
|
|
|
+ for (i = 0;i < cfg->pub->num_chan_stats;i++) {
|
|
|
|
+ if (freq == cfg->pub->chan_stats[i].freq)
|
|
|
|
+ break;
|
|
|
|
+ if (cfg->pub->chan_stats[i].freq == 0)
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ if (i < cfg->pub->num_chan_stats) {
|
|
|
|
+ cfg->pub->chan_stats[i].freq = freq;
|
|
|
|
+ cfg->pub->chan_stats[i].noise = bi->phy_noise;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
bss_data.chan = ieee80211_get_channel(wiphy, freq);
|
|
|
|
bss_data.scan_width = NL80211_BSS_CHAN_WIDTH_20;
|
|
|
|
bss_data.boottime_ns = ktime_to_ns(ktime_get_boottime());
|
2021-10-10 19:24:14 +00:00
|
|
|
@@ -5565,6 +5634,7 @@ static struct cfg80211_ops brcmf_cfg8021
|
2020-01-28 10:28:03 +00:00
|
|
|
.leave_ibss = brcmf_cfg80211_leave_ibss,
|
|
|
|
.get_station = brcmf_cfg80211_get_station,
|
|
|
|
.dump_station = brcmf_cfg80211_dump_station,
|
|
|
|
+ .dump_survey = brcmf_cfg80211_dump_survey,
|
|
|
|
.set_tx_power = brcmf_cfg80211_set_tx_power,
|
|
|
|
.get_tx_power = brcmf_cfg80211_get_tx_power,
|
|
|
|
.add_key = brcmf_cfg80211_add_key,
|
2020-03-13 13:07:23 +00:00
|
|
|
--- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.c
|
|
|
|
+++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.c
|
2021-10-10 19:24:14 +00:00
|
|
|
@@ -1361,6 +1361,8 @@ int brcmf_attach(struct device *dev)
|
2020-01-28 10:28:03 +00:00
|
|
|
|
|
|
|
/* Link to bus module */
|
|
|
|
drvr->hdrlen = 0;
|
|
|
|
+ drvr->chan_stats = vzalloc(256 * sizeof(struct brcmf_chan_stats));
|
|
|
|
+ drvr->num_chan_stats = 256;
|
|
|
|
|
|
|
|
/* Attach and link in the protocol */
|
|
|
|
ret = brcmf_proto_attach(drvr);
|
2021-10-10 19:24:14 +00:00
|
|
|
@@ -1443,6 +1445,12 @@ void brcmf_detach(struct device *dev)
|
2020-01-28 10:28:03 +00:00
|
|
|
if (drvr == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
+ drvr->num_chan_stats = 0;
|
|
|
|
+ if (drvr->chan_stats) {
|
|
|
|
+ vfree(drvr->chan_stats);
|
|
|
|
+ drvr->chan_stats = NULL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
#ifdef CONFIG_INET
|
|
|
|
unregister_inetaddr_notifier(&drvr->inetaddr_notifier);
|
|
|
|
#endif
|
2020-03-13 13:07:23 +00:00
|
|
|
--- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.h
|
|
|
|
+++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.h
|
2020-01-28 10:28:03 +00:00
|
|
|
@@ -91,6 +91,11 @@ struct brcmf_rev_info {
|
|
|
|
u32 nvramrev;
|
|
|
|
};
|
|
|
|
|
|
|
|
+struct brcmf_chan_stats {
|
|
|
|
+ u32 freq;
|
|
|
|
+ int noise;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
/* Common structure for module and instance linkage */
|
|
|
|
struct brcmf_pub {
|
|
|
|
/* Linkage ponters */
|
|
|
|
@@ -100,6 +105,9 @@ struct brcmf_pub {
|
|
|
|
struct cfg80211_ops *ops;
|
|
|
|
struct brcmf_cfg80211_info *config;
|
|
|
|
|
|
|
|
+ int num_chan_stats;
|
|
|
|
+ struct brcmf_chan_stats *chan_stats;
|
|
|
|
+
|
|
|
|
/* Internal brcmf items */
|
|
|
|
uint hdrlen; /* Total BRCMF header length (proto + bus) */
|
|
|
|
|