5 files changed, 98 insertions, 4 deletions

diff --git a/net/mac80211/cfg.c b/net/mac80211/cfg.c
index 16423f94801b..7a7a6c176dc5 100644
--- a/net/mac80211/cfg.c
+++ b/net/mac80211/cfg.c
@@ -1095,6 +1095,18 @@ static int ieee80211_set_txq_params(struct wiphy *wiphy,
         return 0;
 }
 
+static int ieee80211_set_channel(struct wiphy *wiphy,
+                                 struct ieee80211_channel *chan,
+                                 enum nl80211_sec_chan_offset sec_chan_offset)
+{
+        struct ieee80211_local *local = wiphy_priv(wiphy);
+
+        local->oper_channel = chan;
+        local->oper_sec_chan_offset = sec_chan_offset;
+
+        return ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
+}
+
 struct cfg80211_ops mac80211_config_ops = {
         .add_virtual_intf = ieee80211_add_iface,
         .del_virtual_intf = ieee80211_del_iface,
@@ -1122,4 +1134,5 @@ struct cfg80211_ops mac80211_config_ops = {
 #endif
         .change_bss = ieee80211_change_bss,
         .set_txq_params = ieee80211_set_txq_params,
+        .set_channel = ieee80211_set_channel,
 };
diff --git a/net/mac80211/ieee80211_i.h b/net/mac80211/ieee80211_i.h
index 155a20410017..527205f8c1a1 100644
--- a/net/mac80211/ieee80211_i.h
+++ b/net/mac80211/ieee80211_i.h
@@ -626,6 +626,7 @@ struct ieee80211_local {
         struct delayed_work scan_work;
         struct ieee80211_sub_if_data *scan_sdata;
         struct ieee80211_channel *oper_channel, *scan_channel;
+        enum nl80211_sec_chan_offset oper_sec_chan_offset;
         u8 scan_ssid[IEEE80211_MAX_SSID_LEN];
         size_t scan_ssid_len;
         struct list_head bss_list;
diff --git a/net/mac80211/main.c b/net/mac80211/main.c
index cec9b6d3e1ce..29c3ecf7e914 100644
--- a/net/mac80211/main.c
+++ b/net/mac80211/main.c
@@ -195,20 +195,42 @@ int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
         struct ieee80211_channel *chan;
         int ret = 0;
         int power;
+        enum nl80211_sec_chan_offset sec_chan_offset;
 
         might_sleep();
 
-        if (local->sw_scanning)
+        if (local->sw_scanning) {
                 chan = local->scan_channel;
-        else
+                sec_chan_offset = NL80211_SEC_CHAN_NO_HT;
+        } else {
                 chan = local->oper_channel;
+                sec_chan_offset = local->oper_sec_chan_offset;
+        }
 
-        if (chan != local->hw.conf.channel) {
+        if (chan != local->hw.conf.channel ||
+            sec_chan_offset != local->hw.conf.ht.sec_chan_offset) {
                 local->hw.conf.channel = chan;
+                switch (sec_chan_offset) {
+                case NL80211_SEC_CHAN_NO_HT:
+                        local->hw.conf.ht.enabled = false;
+                        local->hw.conf.ht.sec_chan_offset = 0;
+                        break;
+                case NL80211_SEC_CHAN_DISABLED:
+                        local->hw.conf.ht.enabled = true;
+                        local->hw.conf.ht.sec_chan_offset = 0;
+                        break;
+                case NL80211_SEC_CHAN_BELOW:
+                        local->hw.conf.ht.enabled = true;
+                        local->hw.conf.ht.sec_chan_offset = -1;
+                        break;
+                case NL80211_SEC_CHAN_ABOVE:
+                        local->hw.conf.ht.enabled = true;
+                        local->hw.conf.ht.sec_chan_offset = 1;
+                        break;
+                }
                 changed |= IEEE80211_CONF_CHANGE_CHANNEL;
         }
 
-
         if (!local->hw.conf.power_level)
                 power = chan->max_power;
         else
diff --git a/net/mac80211/util.c b/net/mac80211/util.c
index 0f841317c7e9..505d68f344ce 100644
--- a/net/mac80211/util.c
+++ b/net/mac80211/util.c
@@ -641,6 +641,7 @@ int ieee80211_set_freq(struct ieee80211_sub_if_data *sdata, int freqMHz)
                     chan->flags & IEEE80211_CHAN_NO_IBSS)
                         return ret;
                 local->oper_channel = chan;
+                local->oper_sec_chan_offset = NL80211_SEC_CHAN_NO_HT;
 
                 if (local->sw_scanning || local->hw_scanning)
                         ret = 0;
diff --git a/net/wireless/nl80211.c b/net/wireless/nl80211.c
index c9141e3df9ba..9caee6022e3f 100644
--- a/net/wireless/nl80211.c
+++ b/net/wireless/nl80211.c
@@ -59,6 +59,8 @@ static struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] __read_mostly = {
         [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
                                       .len = BUS_ID_SIZE-1 },
         [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
+        [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
+        [NL80211_ATTR_WIPHY_SEC_CHAN_OFFSET] = { .type = NLA_U32 },
 
         [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
         [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
@@ -359,6 +361,61 @@ static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
                 }
         }
 
+        if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
+                enum nl80211_sec_chan_offset sec_chan_offset =
+                        NL80211_SEC_CHAN_NO_HT;
+                struct ieee80211_channel *chan;
+                u32 freq, sec_freq;
+
+                if (!rdev->ops->set_channel) {
+                        result = -EOPNOTSUPP;
+                        goto bad_res;
+                }
+
+                if (info->attrs[NL80211_ATTR_WIPHY_SEC_CHAN_OFFSET]) {
+                        sec_chan_offset = nla_get_u32(
+                                info->attrs[
+                                        NL80211_ATTR_WIPHY_SEC_CHAN_OFFSET]);
+                        if (sec_chan_offset != NL80211_SEC_CHAN_NO_HT &&
+                            sec_chan_offset != NL80211_SEC_CHAN_DISABLED &&
+                            sec_chan_offset != NL80211_SEC_CHAN_BELOW &&
+                            sec_chan_offset != NL80211_SEC_CHAN_ABOVE) {
+                                result = -EINVAL;
+                                goto bad_res;
+                        }
+                }
+
+                freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
+                chan = ieee80211_get_channel(&rdev->wiphy, freq);
+                if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) {
+                        /* Primary channel not allowed */
+                        result = -EINVAL;
+                        goto bad_res;
+                }
+                if (sec_chan_offset == NL80211_SEC_CHAN_BELOW)
+                        sec_freq = freq - 20;
+                else if (sec_chan_offset == NL80211_SEC_CHAN_ABOVE)
+                        sec_freq = freq + 20;
+                else
+                        sec_freq = 0;
+
+                if (sec_freq) {
+                        struct ieee80211_channel *schan;
+                        schan = ieee80211_get_channel(&rdev->wiphy, sec_freq);
+                        if (!schan || schan->flags & IEEE80211_CHAN_DISABLED) {
+                                /* Secondary channel not allowed */
+                                result = -EINVAL;
+                                goto bad_res;
+                        }
+                }
+
+                result = rdev->ops->set_channel(&rdev->wiphy, chan,
+                                                sec_chan_offset);
+                if (result)
+                        goto bad_res;
+        }
+
+
 bad_res:
         cfg80211_put_dev(rdev);
         return result;