mac80211: support HT notify channel width action

Support the HT notify channel width action frame
to update the rate scaling about the bandwidth
the peer can receive in.

Signed-off-by: Johannes Berg <johannes.berg@intel.com>

1 files changed, 30 insertions, 1 deletions

diff --git a/net/mac80211/rx.c b/net/mac80211/rx.c
index 580704eba8b8..a19089565c4b 100644
--- a/net/mac80211/rx.c
+++ b/net/mac80211/rx.c
@@ -2353,7 +2353,7 @@ ieee80211_rx_h_action(struct ieee80211_rx_data *rx)
                     sdata->vif.type != NL80211_IFTYPE_ADHOC)
                         break;
 
-                /* verify action & smps_control are present */
+                /* verify action & smps_control/chanwidth are present */
                 if (len < IEEE80211_MIN_ACTION_SIZE + 2)
                         goto invalid;
 
@@ -2392,6 +2392,35 @@ ieee80211_rx_h_action(struct ieee80211_rx_data *rx)
                                                  IEEE80211_RC_SMPS_CHANGED);
                         goto handled;
                 }
+                case WLAN_HT_ACTION_NOTIFY_CHANWIDTH: {
+                        struct ieee80211_supported_band *sband;
+                        u8 chanwidth = mgmt->u.action.u.ht_notify_cw.chanwidth;
+                        bool old_40mhz, new_40mhz;
+
+                        /* If it doesn't support 40 MHz it can't change ... */
+                        if (!rx->sta->supports_40mhz)
+                                goto handled;
+
+                        old_40mhz = rx->sta->sta.ht_cap.cap &
+                                        IEEE80211_HT_CAP_SUP_WIDTH_20_40;
+                        new_40mhz = chanwidth == IEEE80211_HT_CHANWIDTH_ANY;
+
+                        if (old_40mhz == new_40mhz)
+                                goto handled;
+
+                        if (new_40mhz)
+                                rx->sta->sta.ht_cap.cap |=
+                                        IEEE80211_HT_CAP_SUP_WIDTH_20_40;
+                        else
+                                rx->sta->sta.ht_cap.cap &=
+                                        ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
+
+                        sband = rx->local->hw.wiphy->bands[status->band];
+
+                        rate_control_rate_update(local, sband, rx->sta,
+                                                 IEEE80211_RC_BW_CHANGED);
+                        goto handled;
+                }
                 default:
                         goto invalid;
                 }