--- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/cfg80211.c +++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/cfg80211.c @@ -2893,6 +2893,63 @@ done: } 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) { @@ -2982,6 +3039,7 @@ static s32 brcmf_inform_single_bss(struc struct brcmu_chan ch; u16 channel; u32 freq; + int i; u16 notify_capability; u16 notify_interval; u8 *notify_ie; @@ -3006,6 +3064,17 @@ static s32 brcmf_inform_single_bss(struc 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()); @@ -5423,6 +5492,7 @@ static struct cfg80211_ops brcmf_cfg8021 .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, --- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.c +++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.c @@ -1352,6 +1352,8 @@ int brcmf_attach(struct device *dev) /* 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); @@ -1434,6 +1436,12 @@ void brcmf_detach(struct device *dev) 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 --- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.h +++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/core.h @@ -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) */