Line data Source code
1 : /*
2 : * Common hostapd/wpa_supplicant HW features
3 : * Copyright (c) 2002-2013, Jouni Malinen <j@w1.fi>
4 : * Copyright (c) 2015, Qualcomm Atheros, Inc.
5 : *
6 : * This software may be distributed under the terms of the BSD license.
7 : * See README for more details.
8 : */
9 :
10 : #include "includes.h"
11 :
12 : #include "common.h"
13 : #include "defs.h"
14 : #include "ieee802_11_defs.h"
15 : #include "ieee802_11_common.h"
16 : #include "hw_features_common.h"
17 :
18 :
19 2211 : struct hostapd_channel_data * hw_get_channel_chan(struct hostapd_hw_modes *mode,
20 : int chan, int *freq)
21 : {
22 : int i;
23 :
24 2211 : if (freq)
25 2203 : *freq = 0;
26 :
27 2211 : if (!mode)
28 0 : return NULL;
29 :
30 4184 : for (i = 0; i < mode->num_channels; i++) {
31 4184 : struct hostapd_channel_data *ch = &mode->channels[i];
32 4184 : if (ch->chan == chan) {
33 2211 : if (freq)
34 2203 : *freq = ch->freq;
35 2211 : return ch;
36 : }
37 : }
38 :
39 0 : return NULL;
40 : }
41 :
42 :
43 64 : struct hostapd_channel_data * hw_get_channel_freq(struct hostapd_hw_modes *mode,
44 : int freq, int *chan)
45 : {
46 : int i;
47 :
48 64 : if (chan)
49 64 : *chan = 0;
50 :
51 64 : if (!mode)
52 0 : return NULL;
53 :
54 509 : for (i = 0; i < mode->num_channels; i++) {
55 498 : struct hostapd_channel_data *ch = &mode->channels[i];
56 498 : if (ch->freq == freq) {
57 53 : if (chan)
58 53 : *chan = ch->chan;
59 53 : return ch;
60 : }
61 : }
62 :
63 11 : return NULL;
64 : }
65 :
66 :
67 2203 : int hw_get_freq(struct hostapd_hw_modes *mode, int chan)
68 : {
69 : int freq;
70 :
71 2203 : hw_get_channel_chan(mode, chan, &freq);
72 :
73 2203 : return freq;
74 : }
75 :
76 :
77 64 : int hw_get_chan(struct hostapd_hw_modes *mode, int freq)
78 : {
79 : int chan;
80 :
81 64 : hw_get_channel_freq(mode, freq, &chan);
82 :
83 64 : return chan;
84 : }
85 :
86 :
87 50 : int allowed_ht40_channel_pair(struct hostapd_hw_modes *mode, int pri_chan,
88 : int sec_chan)
89 : {
90 : int ok, j, first;
91 50 : int allowed[] = { 36, 44, 52, 60, 100, 108, 116, 124, 132, 140,
92 : 149, 157, 184, 192 };
93 : size_t k;
94 :
95 50 : if (pri_chan == sec_chan || !sec_chan)
96 0 : return 1; /* HT40 not used */
97 :
98 50 : wpa_printf(MSG_DEBUG,
99 : "HT40: control channel: %d secondary channel: %d",
100 : pri_chan, sec_chan);
101 :
102 : /* Verify that HT40 secondary channel is an allowed 20 MHz
103 : * channel */
104 50 : ok = 0;
105 216 : for (j = 0; j < mode->num_channels; j++) {
106 216 : struct hostapd_channel_data *chan = &mode->channels[j];
107 387 : if (!(chan->flag & HOSTAPD_CHAN_DISABLED) &&
108 171 : chan->chan == sec_chan) {
109 50 : ok = 1;
110 50 : break;
111 : }
112 : }
113 50 : if (!ok) {
114 0 : wpa_printf(MSG_ERROR, "HT40 secondary channel %d not allowed",
115 : sec_chan);
116 0 : return 0;
117 : }
118 :
119 : /*
120 : * Verify that HT40 primary,secondary channel pair is allowed per
121 : * IEEE 802.11n Annex J. This is only needed for 5 GHz band since
122 : * 2.4 GHz rules allow all cases where the secondary channel fits into
123 : * the list of allowed channels (already checked above).
124 : */
125 50 : if (mode->mode != HOSTAPD_MODE_IEEE80211A)
126 18 : return 1;
127 :
128 32 : first = pri_chan < sec_chan ? pri_chan : sec_chan;
129 :
130 32 : ok = 0;
131 90 : for (k = 0; k < ARRAY_SIZE(allowed); k++) {
132 89 : if (first == allowed[k]) {
133 31 : ok = 1;
134 31 : break;
135 : }
136 : }
137 32 : if (!ok) {
138 1 : wpa_printf(MSG_ERROR, "HT40 channel pair (%d, %d) not allowed",
139 : pri_chan, sec_chan);
140 1 : return 0;
141 : }
142 :
143 31 : return 1;
144 : }
145 :
146 :
147 26 : void get_pri_sec_chan(struct wpa_scan_res *bss, int *pri_chan, int *sec_chan)
148 : {
149 : struct ieee80211_ht_operation *oper;
150 : struct ieee802_11_elems elems;
151 :
152 26 : *pri_chan = *sec_chan = 0;
153 :
154 26 : ieee802_11_parse_elems((u8 *) (bss + 1), bss->ie_len, &elems, 0);
155 26 : if (elems.ht_operation) {
156 22 : oper = (struct ieee80211_ht_operation *) elems.ht_operation;
157 22 : *pri_chan = oper->primary_chan;
158 22 : if (oper->ht_param & HT_INFO_HT_PARAM_STA_CHNL_WIDTH) {
159 10 : int sec = oper->ht_param &
160 : HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
161 10 : if (sec == HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
162 6 : *sec_chan = *pri_chan + 4;
163 4 : else if (sec == HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
164 4 : *sec_chan = *pri_chan - 4;
165 : }
166 : }
167 26 : }
168 :
169 :
170 35 : int check_40mhz_5g(struct hostapd_hw_modes *mode,
171 : struct wpa_scan_results *scan_res, int pri_chan,
172 : int sec_chan)
173 : {
174 : int pri_freq, sec_freq, pri_bss, sec_bss;
175 : int bss_pri_chan, bss_sec_chan;
176 : size_t i;
177 : int match;
178 :
179 35 : if (!mode || !scan_res || !pri_chan || !sec_chan ||
180 : pri_chan == sec_chan)
181 0 : return 0;
182 :
183 35 : pri_freq = hw_get_freq(mode, pri_chan);
184 35 : sec_freq = hw_get_freq(mode, sec_chan);
185 :
186 : /*
187 : * Switch PRI/SEC channels if Beacons were detected on selected SEC
188 : * channel, but not on selected PRI channel.
189 : */
190 35 : pri_bss = sec_bss = 0;
191 47 : for (i = 0; i < scan_res->num; i++) {
192 12 : struct wpa_scan_res *bss = scan_res->res[i];
193 12 : if (bss->freq == pri_freq)
194 4 : pri_bss++;
195 8 : else if (bss->freq == sec_freq)
196 3 : sec_bss++;
197 : }
198 35 : if (sec_bss && !pri_bss) {
199 1 : wpa_printf(MSG_INFO,
200 : "Switch own primary and secondary channel to get secondary channel with no Beacons from other BSSes");
201 1 : return 2;
202 : }
203 :
204 : /*
205 : * Match PRI/SEC channel with any existing HT40 BSS on the same
206 : * channels that we are about to use (if already mixed order in
207 : * existing BSSes, use own preference).
208 : */
209 34 : match = 0;
210 43 : for (i = 0; i < scan_res->num; i++) {
211 11 : struct wpa_scan_res *bss = scan_res->res[i];
212 11 : get_pri_sec_chan(bss, &bss_pri_chan, &bss_sec_chan);
213 15 : if (pri_chan == bss_pri_chan &&
214 4 : sec_chan == bss_sec_chan) {
215 2 : match = 1;
216 2 : break;
217 : }
218 : }
219 34 : if (!match) {
220 38 : for (i = 0; i < scan_res->num; i++) {
221 8 : struct wpa_scan_res *bss = scan_res->res[i];
222 8 : get_pri_sec_chan(bss, &bss_pri_chan, &bss_sec_chan);
223 10 : if (pri_chan == bss_sec_chan &&
224 2 : sec_chan == bss_pri_chan) {
225 12 : wpa_printf(MSG_INFO, "Switch own primary and "
226 : "secondary channel due to BSS "
227 : "overlap with " MACSTR,
228 12 : MAC2STR(bss->bssid));
229 2 : return 2;
230 : }
231 : }
232 : }
233 :
234 32 : return 1;
235 : }
236 :
237 :
238 9 : static int check_20mhz_bss(struct wpa_scan_res *bss, int pri_freq, int start,
239 : int end)
240 : {
241 : struct ieee802_11_elems elems;
242 : struct ieee80211_ht_operation *oper;
243 :
244 9 : if (bss->freq < start || bss->freq > end || bss->freq == pri_freq)
245 6 : return 0;
246 :
247 3 : ieee802_11_parse_elems((u8 *) (bss + 1), bss->ie_len, &elems, 0);
248 3 : if (!elems.ht_capabilities) {
249 7 : wpa_printf(MSG_DEBUG, "Found overlapping legacy BSS: "
250 6 : MACSTR " freq=%d", MAC2STR(bss->bssid), bss->freq);
251 1 : return 1;
252 : }
253 :
254 2 : if (elems.ht_operation) {
255 2 : oper = (struct ieee80211_ht_operation *) elems.ht_operation;
256 2 : if (oper->ht_param & HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK)
257 1 : return 0;
258 :
259 7 : wpa_printf(MSG_DEBUG, "Found overlapping 20 MHz HT BSS: "
260 6 : MACSTR " freq=%d", MAC2STR(bss->bssid), bss->freq);
261 1 : return 1;
262 : }
263 0 : return 0;
264 : }
265 :
266 :
267 23 : int check_40mhz_2g4(struct hostapd_hw_modes *mode,
268 : struct wpa_scan_results *scan_res, int pri_chan,
269 : int sec_chan)
270 : {
271 : int pri_freq, sec_freq;
272 : int affected_start, affected_end;
273 : size_t i;
274 :
275 46 : if (!mode || !scan_res || !pri_chan || !sec_chan ||
276 23 : pri_chan == sec_chan)
277 0 : return 0;
278 :
279 23 : pri_freq = hw_get_freq(mode, pri_chan);
280 23 : sec_freq = hw_get_freq(mode, sec_chan);
281 :
282 23 : affected_start = (pri_freq + sec_freq) / 2 - 25;
283 23 : affected_end = (pri_freq + sec_freq) / 2 + 25;
284 23 : wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
285 : affected_start, affected_end);
286 27 : for (i = 0; i < scan_res->num; i++) {
287 9 : struct wpa_scan_res *bss = scan_res->res[i];
288 9 : int pri = bss->freq;
289 9 : int sec = pri;
290 : struct ieee802_11_elems elems;
291 :
292 : /* Check for overlapping 20 MHz BSS */
293 9 : if (check_20mhz_bss(bss, pri_freq, affected_start,
294 : affected_end)) {
295 2 : wpa_printf(MSG_DEBUG,
296 : "Overlapping 20 MHz BSS is found");
297 7 : return 0;
298 : }
299 :
300 7 : get_pri_sec_chan(bss, &pri_chan, &sec_chan);
301 :
302 7 : if (sec_chan) {
303 4 : if (sec_chan < pri_chan)
304 2 : sec = pri - 20;
305 : else
306 2 : sec = pri + 20;
307 : }
308 :
309 7 : if ((pri < affected_start || pri > affected_end) &&
310 3 : (sec < affected_start || sec > affected_end))
311 2 : continue; /* not within affected channel range */
312 :
313 35 : wpa_printf(MSG_DEBUG, "Neighboring BSS: " MACSTR
314 : " freq=%d pri=%d sec=%d",
315 30 : MAC2STR(bss->bssid), bss->freq, pri_chan, sec_chan);
316 :
317 5 : if (sec_chan) {
318 3 : if (pri_freq != pri || sec_freq != sec) {
319 14 : wpa_printf(MSG_DEBUG,
320 : "40 MHz pri/sec mismatch with BSS "
321 : MACSTR
322 : " <%d,%d> (chan=%d%c) vs. <%d,%d>",
323 12 : MAC2STR(bss->bssid),
324 : pri, sec, pri_chan,
325 : sec > pri ? '+' : '-',
326 : pri_freq, sec_freq);
327 2 : return 0;
328 : }
329 : }
330 :
331 3 : ieee802_11_parse_elems((u8 *) (bss + 1), bss->ie_len, &elems,
332 : 0);
333 3 : if (elems.ht_capabilities) {
334 3 : struct ieee80211_ht_capabilities *ht_cap =
335 : (struct ieee80211_ht_capabilities *)
336 : elems.ht_capabilities;
337 :
338 3 : if (le_to_host16(ht_cap->ht_capabilities_info) &
339 : HT_CAP_INFO_40MHZ_INTOLERANT) {
340 6 : wpa_printf(MSG_DEBUG,
341 : "40 MHz Intolerant is set on channel %d in BSS "
342 6 : MACSTR, pri, MAC2STR(bss->bssid));
343 1 : return 0;
344 : }
345 : }
346 : }
347 :
348 18 : return 1;
349 : }
350 :
351 :
352 6424 : int hostapd_set_freq_params(struct hostapd_freq_params *data,
353 : enum hostapd_hw_mode mode,
354 : int freq, int channel, int ht_enabled,
355 : int vht_enabled, int sec_channel_offset,
356 : int vht_oper_chwidth, int center_segment0,
357 : int center_segment1, u32 vht_caps)
358 : {
359 6424 : os_memset(data, 0, sizeof(*data));
360 6424 : data->mode = mode;
361 6424 : data->freq = freq;
362 6424 : data->channel = channel;
363 6424 : data->ht_enabled = ht_enabled;
364 6424 : data->vht_enabled = vht_enabled;
365 6424 : data->sec_channel_offset = sec_channel_offset;
366 6424 : data->center_freq1 = freq + sec_channel_offset * 10;
367 6424 : data->center_freq2 = 0;
368 6424 : data->bandwidth = sec_channel_offset ? 40 : 20;
369 :
370 6424 : if (data->vht_enabled) switch (vht_oper_chwidth) {
371 : case VHT_CHANWIDTH_USE_HT:
372 11 : if (center_segment1 ||
373 2 : (center_segment0 != 0 &&
374 2 : 5000 + center_segment0 * 5 != data->center_freq1 &&
375 0 : 2407 + center_segment0 * 5 != data->center_freq1))
376 0 : return -1;
377 11 : break;
378 : case VHT_CHANWIDTH_80P80MHZ:
379 3 : if (!(vht_caps & VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ)) {
380 0 : wpa_printf(MSG_ERROR,
381 : "80+80 channel width is not supported!");
382 0 : return -1;
383 : }
384 6 : if (center_segment1 == center_segment0 + 4 ||
385 3 : center_segment1 == center_segment0 - 4)
386 0 : return -1;
387 3 : data->center_freq2 = 5000 + center_segment1 * 5;
388 : /* fall through */
389 : case VHT_CHANWIDTH_80MHZ:
390 25 : data->bandwidth = 80;
391 25 : if ((vht_oper_chwidth == 1 && center_segment1) ||
392 3 : (vht_oper_chwidth == 3 && !center_segment1) ||
393 : !sec_channel_offset)
394 0 : return -1;
395 25 : if (!center_segment0) {
396 0 : if (channel <= 48)
397 0 : center_segment0 = 42;
398 0 : else if (channel <= 64)
399 0 : center_segment0 = 58;
400 0 : else if (channel <= 112)
401 0 : center_segment0 = 106;
402 0 : else if (channel <= 128)
403 0 : center_segment0 = 122;
404 0 : else if (channel <= 144)
405 0 : center_segment0 = 138;
406 0 : else if (channel <= 161)
407 0 : center_segment0 = 155;
408 0 : data->center_freq1 = 5000 + center_segment0 * 5;
409 : } else {
410 : /*
411 : * Note: HT/VHT config and params are coupled. Check if
412 : * HT40 channel band is in VHT80 Pri channel band
413 : * configuration.
414 : */
415 33 : if (center_segment0 == channel + 6 ||
416 12 : center_segment0 == channel + 2 ||
417 6 : center_segment0 == channel - 2 ||
418 2 : center_segment0 == channel - 6)
419 25 : data->center_freq1 = 5000 + center_segment0 * 5;
420 : else
421 0 : return -1;
422 : }
423 25 : break;
424 : case VHT_CHANWIDTH_160MHZ:
425 6 : data->bandwidth = 160;
426 6 : if (!(vht_caps & (VHT_CAP_SUPP_CHAN_WIDTH_160MHZ |
427 : VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ))) {
428 0 : wpa_printf(MSG_ERROR,
429 : "160MHZ channel width is not supported!");
430 0 : return -1;
431 : }
432 6 : if (center_segment1)
433 0 : return -1;
434 6 : if (!sec_channel_offset)
435 0 : return -1;
436 : /*
437 : * Note: HT/VHT config and params are coupled. Check if
438 : * HT40 channel band is in VHT160 channel band configuration.
439 : */
440 9 : if (center_segment0 == channel + 14 ||
441 3 : center_segment0 == channel + 10 ||
442 0 : center_segment0 == channel + 6 ||
443 0 : center_segment0 == channel + 2 ||
444 0 : center_segment0 == channel - 2 ||
445 0 : center_segment0 == channel - 6 ||
446 0 : center_segment0 == channel - 10 ||
447 0 : center_segment0 == channel - 14)
448 6 : data->center_freq1 = 5000 + center_segment0 * 5;
449 : else
450 0 : return -1;
451 6 : break;
452 : }
453 :
454 6424 : return 0;
455 : }
|
