1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
239192c0bSJohannes Berg /*
339192c0bSJohannes Berg * spectrum management
439192c0bSJohannes Berg *
539192c0bSJohannes Berg * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
639192c0bSJohannes Berg * Copyright 2002-2005, Instant802 Networks, Inc.
739192c0bSJohannes Berg * Copyright 2005-2006, Devicescape Software, Inc.
839192c0bSJohannes Berg * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
939192c0bSJohannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
1039192c0bSJohannes Berg * Copyright 2007-2008, Intel Corporation
1139192c0bSJohannes Berg * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
12*ba323e29SJohannes Berg * Copyright (C) 2018, 2020, 2022 Intel Corporation
1339192c0bSJohannes Berg */
1439192c0bSJohannes Berg
1539192c0bSJohannes Berg #include <linux/ieee80211.h>
16d3236553SJohannes Berg #include <net/cfg80211.h>
1739192c0bSJohannes Berg #include <net/mac80211.h>
1839192c0bSJohannes Berg #include "ieee80211_i.h"
1939192c0bSJohannes Berg #include "sta_info.h"
2039192c0bSJohannes Berg #include "wme.h"
2139192c0bSJohannes Berg
ieee80211_parse_ch_switch_ie(struct ieee80211_sub_if_data * sdata,struct ieee802_11_elems * elems,enum nl80211_band current_band,u32 vht_cap_info,ieee80211_conn_flags_t conn_flags,u8 * bssid,struct ieee80211_csa_ie * csa_ie)22e6b7cde4SSimon Wunderlich int ieee80211_parse_ch_switch_ie(struct ieee80211_sub_if_data *sdata,
2384469a45SLuciano Coelho struct ieee802_11_elems *elems,
2457fbcce3SJohannes Berg enum nl80211_band current_band,
252a333a0dSJohannes Berg u32 vht_cap_info,
26*ba323e29SJohannes Berg ieee80211_conn_flags_t conn_flags, u8 *bssid,
27c0f17eb9SChun-Yeow Yeoh struct ieee80211_csa_ie *csa_ie)
28e6b7cde4SSimon Wunderlich {
29191da271SIlan Peer enum nl80211_band new_band = current_band;
30e6b7cde4SSimon Wunderlich int new_freq;
31e6b7cde4SSimon Wunderlich u8 new_chan_no;
32e6b7cde4SSimon Wunderlich struct ieee80211_channel *new_chan;
33e6b7cde4SSimon Wunderlich struct cfg80211_chan_def new_vht_chandef = {};
34e6b7cde4SSimon Wunderlich const struct ieee80211_sec_chan_offs_ie *sec_chan_offs;
35e6b7cde4SSimon Wunderlich const struct ieee80211_wide_bw_chansw_ie *wide_bw_chansw_ie;
36e6b7cde4SSimon Wunderlich int secondary_channel_offset = -1;
37e6b7cde4SSimon Wunderlich
3861b81b40SJohannes Berg memset(csa_ie, 0, sizeof(*csa_ie));
3961b81b40SJohannes Berg
40e6b7cde4SSimon Wunderlich sec_chan_offs = elems->sec_chan_offs;
41e6b7cde4SSimon Wunderlich wide_bw_chansw_ie = elems->wide_bw_chansw_ie;
42e6b7cde4SSimon Wunderlich
43*ba323e29SJohannes Berg if (conn_flags & (IEEE80211_CONN_DISABLE_HT |
44*ba323e29SJohannes Berg IEEE80211_CONN_DISABLE_40MHZ)) {
45e6b7cde4SSimon Wunderlich sec_chan_offs = NULL;
46e6b7cde4SSimon Wunderlich wide_bw_chansw_ie = NULL;
47e6b7cde4SSimon Wunderlich }
48e6b7cde4SSimon Wunderlich
49*ba323e29SJohannes Berg if (conn_flags & IEEE80211_CONN_DISABLE_VHT)
50e6b7cde4SSimon Wunderlich wide_bw_chansw_ie = NULL;
51e6b7cde4SSimon Wunderlich
52e6b7cde4SSimon Wunderlich if (elems->ext_chansw_ie) {
53e6b7cde4SSimon Wunderlich if (!ieee80211_operating_class_to_band(
54e6b7cde4SSimon Wunderlich elems->ext_chansw_ie->new_operating_class,
55e6b7cde4SSimon Wunderlich &new_band)) {
56e6b7cde4SSimon Wunderlich sdata_info(sdata,
57191da271SIlan Peer "cannot understand ECSA IE operating class, %d, ignoring\n",
58e6b7cde4SSimon Wunderlich elems->ext_chansw_ie->new_operating_class);
59e6b7cde4SSimon Wunderlich }
60e6b7cde4SSimon Wunderlich new_chan_no = elems->ext_chansw_ie->new_ch_num;
61c0f17eb9SChun-Yeow Yeoh csa_ie->count = elems->ext_chansw_ie->count;
62c0f17eb9SChun-Yeow Yeoh csa_ie->mode = elems->ext_chansw_ie->mode;
63e6b7cde4SSimon Wunderlich } else if (elems->ch_switch_ie) {
64e6b7cde4SSimon Wunderlich new_chan_no = elems->ch_switch_ie->new_ch_num;
65c0f17eb9SChun-Yeow Yeoh csa_ie->count = elems->ch_switch_ie->count;
66c0f17eb9SChun-Yeow Yeoh csa_ie->mode = elems->ch_switch_ie->mode;
67e6b7cde4SSimon Wunderlich } else {
68e6b7cde4SSimon Wunderlich /* nothing here we understand */
69e6b7cde4SSimon Wunderlich return 1;
70e6b7cde4SSimon Wunderlich }
71e6b7cde4SSimon Wunderlich
7233a45867SChun-Yeow Yeoh /* Mesh Channel Switch Parameters Element */
7333a45867SChun-Yeow Yeoh if (elems->mesh_chansw_params_ie) {
7433a45867SChun-Yeow Yeoh csa_ie->ttl = elems->mesh_chansw_params_ie->mesh_ttl;
7533a45867SChun-Yeow Yeoh csa_ie->mode = elems->mesh_chansw_params_ie->mesh_flags;
763f718fd8SChun-Yeow Yeoh csa_ie->pre_value = le16_to_cpu(
773f718fd8SChun-Yeow Yeoh elems->mesh_chansw_params_ie->mesh_pre_value);
785d55371bSBenjamin Berg
795d55371bSBenjamin Berg if (elems->mesh_chansw_params_ie->mesh_flags &
805d55371bSBenjamin Berg WLAN_EID_CHAN_SWITCH_PARAM_REASON)
815d55371bSBenjamin Berg csa_ie->reason_code = le16_to_cpu(
825d55371bSBenjamin Berg elems->mesh_chansw_params_ie->mesh_reason);
8333a45867SChun-Yeow Yeoh }
8433a45867SChun-Yeow Yeoh
85e6b7cde4SSimon Wunderlich new_freq = ieee80211_channel_to_frequency(new_chan_no, new_band);
86e6b7cde4SSimon Wunderlich new_chan = ieee80211_get_channel(sdata->local->hw.wiphy, new_freq);
87e6b7cde4SSimon Wunderlich if (!new_chan || new_chan->flags & IEEE80211_CHAN_DISABLED) {
88e6b7cde4SSimon Wunderlich sdata_info(sdata,
89e6b7cde4SSimon Wunderlich "BSS %pM switches to unsupported channel (%d MHz), disconnecting\n",
90e6b7cde4SSimon Wunderlich bssid, new_freq);
91e6b7cde4SSimon Wunderlich return -EINVAL;
92e6b7cde4SSimon Wunderlich }
93e6b7cde4SSimon Wunderlich
9484469a45SLuciano Coelho if (sec_chan_offs) {
95e6b7cde4SSimon Wunderlich secondary_channel_offset = sec_chan_offs->sec_chan_offs;
96*ba323e29SJohannes Berg } else if (!(conn_flags & IEEE80211_CONN_DISABLE_HT)) {
9784469a45SLuciano Coelho /* If the secondary channel offset IE is not present,
9884469a45SLuciano Coelho * we can't know what's the post-CSA offset, so the
9984469a45SLuciano Coelho * best we can do is use 20MHz.
100e6b7cde4SSimon Wunderlich */
101e6b7cde4SSimon Wunderlich secondary_channel_offset = IEEE80211_HT_PARAM_CHA_SEC_NONE;
102e6b7cde4SSimon Wunderlich }
103e6b7cde4SSimon Wunderlich
104e6b7cde4SSimon Wunderlich switch (secondary_channel_offset) {
105e6b7cde4SSimon Wunderlich default:
106e6b7cde4SSimon Wunderlich /* secondary_channel_offset was present but is invalid */
107e6b7cde4SSimon Wunderlich case IEEE80211_HT_PARAM_CHA_SEC_NONE:
108c0f17eb9SChun-Yeow Yeoh cfg80211_chandef_create(&csa_ie->chandef, new_chan,
109e6b7cde4SSimon Wunderlich NL80211_CHAN_HT20);
110e6b7cde4SSimon Wunderlich break;
111e6b7cde4SSimon Wunderlich case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
112c0f17eb9SChun-Yeow Yeoh cfg80211_chandef_create(&csa_ie->chandef, new_chan,
113e6b7cde4SSimon Wunderlich NL80211_CHAN_HT40PLUS);
114e6b7cde4SSimon Wunderlich break;
115e6b7cde4SSimon Wunderlich case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
116c0f17eb9SChun-Yeow Yeoh cfg80211_chandef_create(&csa_ie->chandef, new_chan,
117e6b7cde4SSimon Wunderlich NL80211_CHAN_HT40MINUS);
118e6b7cde4SSimon Wunderlich break;
119e6b7cde4SSimon Wunderlich case -1:
120c0f17eb9SChun-Yeow Yeoh cfg80211_chandef_create(&csa_ie->chandef, new_chan,
121e6b7cde4SSimon Wunderlich NL80211_CHAN_NO_HT);
122e6b7cde4SSimon Wunderlich /* keep width for 5/10 MHz channels */
123e6b7cde4SSimon Wunderlich switch (sdata->vif.bss_conf.chandef.width) {
124e6b7cde4SSimon Wunderlich case NL80211_CHAN_WIDTH_5:
125e6b7cde4SSimon Wunderlich case NL80211_CHAN_WIDTH_10:
126c0f17eb9SChun-Yeow Yeoh csa_ie->chandef.width =
127c0f17eb9SChun-Yeow Yeoh sdata->vif.bss_conf.chandef.width;
128e6b7cde4SSimon Wunderlich break;
129e6b7cde4SSimon Wunderlich default:
130e6b7cde4SSimon Wunderlich break;
131e6b7cde4SSimon Wunderlich }
132e6b7cde4SSimon Wunderlich break;
133e6b7cde4SSimon Wunderlich }
134e6b7cde4SSimon Wunderlich
135e6b7cde4SSimon Wunderlich if (wide_bw_chansw_ie) {
136dcf3c8fbSShay Bar u8 new_seg1 = wide_bw_chansw_ie->new_center_freq_seg1;
13792b3a28aSJohannes Berg struct ieee80211_vht_operation vht_oper = {
13892b3a28aSJohannes Berg .chan_width =
13992b3a28aSJohannes Berg wide_bw_chansw_ie->new_channel_width,
1402fb51c35SJohannes Berg .center_freq_seg0_idx =
141e6b7cde4SSimon Wunderlich wide_bw_chansw_ie->new_center_freq_seg0,
142dcf3c8fbSShay Bar .center_freq_seg1_idx = new_seg1,
14392b3a28aSJohannes Berg /* .basic_mcs_set doesn't matter */
14492b3a28aSJohannes Berg };
145dcf3c8fbSShay Bar struct ieee80211_ht_operation ht_oper = {
146dcf3c8fbSShay Bar .operation_mode =
147dcf3c8fbSShay Bar cpu_to_le16(new_seg1 <<
148dcf3c8fbSShay Bar IEEE80211_HT_OP_MODE_CCFS2_SHIFT),
149dcf3c8fbSShay Bar };
15092b3a28aSJohannes Berg
15192b3a28aSJohannes Berg /* default, for the case of IEEE80211_VHT_CHANWIDTH_USE_HT,
15292b3a28aSJohannes Berg * to the previously parsed chandef
15392b3a28aSJohannes Berg */
15492b3a28aSJohannes Berg new_vht_chandef = csa_ie->chandef;
15592b3a28aSJohannes Berg
15692b3a28aSJohannes Berg /* ignore if parsing fails */
1577eb26df2SJohannes Berg if (!ieee80211_chandef_vht_oper(&sdata->local->hw,
1582a333a0dSJohannes Berg vht_cap_info,
1597eb26df2SJohannes Berg &vht_oper, &ht_oper,
1607eb26df2SJohannes Berg &new_vht_chandef))
16192b3a28aSJohannes Berg new_vht_chandef.chan = NULL;
16292b3a28aSJohannes Berg
163*ba323e29SJohannes Berg if (conn_flags & IEEE80211_CONN_DISABLE_80P80MHZ &&
164e6b7cde4SSimon Wunderlich new_vht_chandef.width == NL80211_CHAN_WIDTH_80P80)
165e6b7cde4SSimon Wunderlich ieee80211_chandef_downgrade(&new_vht_chandef);
166*ba323e29SJohannes Berg if (conn_flags & IEEE80211_CONN_DISABLE_160MHZ &&
167e6b7cde4SSimon Wunderlich new_vht_chandef.width == NL80211_CHAN_WIDTH_160)
168e6b7cde4SSimon Wunderlich ieee80211_chandef_downgrade(&new_vht_chandef);
169e6b7cde4SSimon Wunderlich }
170e6b7cde4SSimon Wunderlich
171e6b7cde4SSimon Wunderlich /* if VHT data is there validate & use it */
172e6b7cde4SSimon Wunderlich if (new_vht_chandef.chan) {
173e6b7cde4SSimon Wunderlich if (!cfg80211_chandef_compatible(&new_vht_chandef,
174c0f17eb9SChun-Yeow Yeoh &csa_ie->chandef)) {
175e6b7cde4SSimon Wunderlich sdata_info(sdata,
176e6b7cde4SSimon Wunderlich "BSS %pM: CSA has inconsistent channel data, disconnecting\n",
177e6b7cde4SSimon Wunderlich bssid);
178e6b7cde4SSimon Wunderlich return -EINVAL;
179e6b7cde4SSimon Wunderlich }
180c0f17eb9SChun-Yeow Yeoh csa_ie->chandef = new_vht_chandef;
181e6b7cde4SSimon Wunderlich }
182e6b7cde4SSimon Wunderlich
183ee145775SSara Sharon if (elems->max_channel_switch_time)
184ee145775SSara Sharon csa_ie->max_switch_time =
185ee145775SSara Sharon (elems->max_channel_switch_time[0] << 0) |
186ee145775SSara Sharon (elems->max_channel_switch_time[1] << 8) |
187ee145775SSara Sharon (elems->max_channel_switch_time[2] << 16);
188ee145775SSara Sharon
189e6b7cde4SSimon Wunderlich return 0;
190e6b7cde4SSimon Wunderlich }
191e6b7cde4SSimon Wunderlich
ieee80211_send_refuse_measurement_request(struct ieee80211_sub_if_data * sdata,struct ieee80211_msrment_ie * request_ie,const u8 * da,const u8 * bssid,u8 dialog_token)19239192c0bSJohannes Berg static void ieee80211_send_refuse_measurement_request(struct ieee80211_sub_if_data *sdata,
19339192c0bSJohannes Berg struct ieee80211_msrment_ie *request_ie,
19439192c0bSJohannes Berg const u8 *da, const u8 *bssid,
19539192c0bSJohannes Berg u8 dialog_token)
19639192c0bSJohannes Berg {
19739192c0bSJohannes Berg struct ieee80211_local *local = sdata->local;
19839192c0bSJohannes Berg struct sk_buff *skb;
19939192c0bSJohannes Berg struct ieee80211_mgmt *msr_report;
20039192c0bSJohannes Berg
20139192c0bSJohannes Berg skb = dev_alloc_skb(sizeof(*msr_report) + local->hw.extra_tx_headroom +
20239192c0bSJohannes Berg sizeof(struct ieee80211_msrment_ie));
203d15b8459SJoe Perches if (!skb)
20439192c0bSJohannes Berg return;
20539192c0bSJohannes Berg
20639192c0bSJohannes Berg skb_reserve(skb, local->hw.extra_tx_headroom);
207b080db58SJohannes Berg msr_report = skb_put_zero(skb, 24);
20839192c0bSJohannes Berg memcpy(msr_report->da, da, ETH_ALEN);
20947846c9bSJohannes Berg memcpy(msr_report->sa, sdata->vif.addr, ETH_ALEN);
21039192c0bSJohannes Berg memcpy(msr_report->bssid, bssid, ETH_ALEN);
21139192c0bSJohannes Berg msr_report->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
21239192c0bSJohannes Berg IEEE80211_STYPE_ACTION);
21339192c0bSJohannes Berg
21439192c0bSJohannes Berg skb_put(skb, 1 + sizeof(msr_report->u.action.u.measurement));
21539192c0bSJohannes Berg msr_report->u.action.category = WLAN_CATEGORY_SPECTRUM_MGMT;
21639192c0bSJohannes Berg msr_report->u.action.u.measurement.action_code =
21739192c0bSJohannes Berg WLAN_ACTION_SPCT_MSR_RPRT;
21839192c0bSJohannes Berg msr_report->u.action.u.measurement.dialog_token = dialog_token;
21939192c0bSJohannes Berg
22039192c0bSJohannes Berg msr_report->u.action.u.measurement.element_id = WLAN_EID_MEASURE_REPORT;
22139192c0bSJohannes Berg msr_report->u.action.u.measurement.length =
22239192c0bSJohannes Berg sizeof(struct ieee80211_msrment_ie);
22339192c0bSJohannes Berg
22439192c0bSJohannes Berg memset(&msr_report->u.action.u.measurement.msr_elem, 0,
22539192c0bSJohannes Berg sizeof(struct ieee80211_msrment_ie));
22639192c0bSJohannes Berg msr_report->u.action.u.measurement.msr_elem.token = request_ie->token;
22739192c0bSJohannes Berg msr_report->u.action.u.measurement.msr_elem.mode |=
22839192c0bSJohannes Berg IEEE80211_SPCT_MSR_RPRT_MODE_REFUSED;
22939192c0bSJohannes Berg msr_report->u.action.u.measurement.msr_elem.type = request_ie->type;
23039192c0bSJohannes Berg
23162ae67beSJohannes Berg ieee80211_tx_skb(sdata, skb);
23239192c0bSJohannes Berg }
23339192c0bSJohannes Berg
ieee80211_process_measurement_req(struct ieee80211_sub_if_data * sdata,struct ieee80211_mgmt * mgmt,size_t len)23439192c0bSJohannes Berg void ieee80211_process_measurement_req(struct ieee80211_sub_if_data *sdata,
23539192c0bSJohannes Berg struct ieee80211_mgmt *mgmt,
23639192c0bSJohannes Berg size_t len)
23739192c0bSJohannes Berg {
23839192c0bSJohannes Berg /*
23939192c0bSJohannes Berg * Ignoring measurement request is spec violation.
24039192c0bSJohannes Berg * Mandatory measurements must be reported optional
24139192c0bSJohannes Berg * measurements might be refused or reported incapable
24239192c0bSJohannes Berg * For now just refuse
24339192c0bSJohannes Berg * TODO: Answer basic measurement as unmeasured
24439192c0bSJohannes Berg */
24539192c0bSJohannes Berg ieee80211_send_refuse_measurement_request(sdata,
24639192c0bSJohannes Berg &mgmt->u.action.u.measurement.msr_elem,
24739192c0bSJohannes Berg mgmt->sa, mgmt->bssid,
24839192c0bSJohannes Berg mgmt->u.action.u.measurement.dialog_token);
24939192c0bSJohannes Berg }
250