]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - net/wireless/reg.c
cfg80211: cleanup return calls on nl80211_set_reg()
[mirror_ubuntu-zesty-kernel.git] / net / wireless / reg.c
CommitLineData
8318d78a
JB
1/*
2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2007 Johannes Berg <johannes@sipsolutions.net>
b2e1b302 5 * Copyright 2008 Luis R. Rodriguez <lrodriguz@atheros.com>
8318d78a
JB
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
11
b2e1b302
LR
12/**
13 * DOC: Wireless regulatory infrastructure
8318d78a
JB
14 *
15 * The usual implementation is for a driver to read a device EEPROM to
16 * determine which regulatory domain it should be operating under, then
17 * looking up the allowable channels in a driver-local table and finally
18 * registering those channels in the wiphy structure.
19 *
b2e1b302
LR
20 * Another set of compliance enforcement is for drivers to use their
21 * own compliance limits which can be stored on the EEPROM. The host
22 * driver or firmware may ensure these are used.
23 *
24 * In addition to all this we provide an extra layer of regulatory
25 * conformance. For drivers which do not have any regulatory
26 * information CRDA provides the complete regulatory solution.
27 * For others it provides a community effort on further restrictions
28 * to enhance compliance.
29 *
30 * Note: When number of rules --> infinity we will not be able to
31 * index on alpha2 any more, instead we'll probably have to
32 * rely on some SHA1 checksum of the regdomain for example.
33 *
8318d78a
JB
34 */
35#include <linux/kernel.h>
b2e1b302
LR
36#include <linux/list.h>
37#include <linux/random.h>
38#include <linux/nl80211.h>
39#include <linux/platform_device.h>
b2e1b302 40#include <net/cfg80211.h>
8318d78a 41#include "core.h"
b2e1b302 42#include "reg.h"
73d54c9e 43#include "nl80211.h"
8318d78a 44
5166ccd2 45/* Receipt of information from last regulatory request */
f6037d09 46static struct regulatory_request *last_request;
734366de 47
b2e1b302
LR
48/* To trigger userspace events */
49static struct platform_device *reg_pdev;
8318d78a 50
fb1fc7ad
LR
51/*
52 * Central wireless core regulatory domains, we only need two,
734366de 53 * the current one and a world regulatory domain in case we have no
fb1fc7ad
LR
54 * information to give us an alpha2
55 */
f130347c 56const struct ieee80211_regdomain *cfg80211_regdomain;
734366de 57
fb1fc7ad
LR
58/*
59 * We use this as a place for the rd structure built from the
3f2355cb 60 * last parsed country IE to rest until CRDA gets back to us with
fb1fc7ad
LR
61 * what it thinks should apply for the same country
62 */
3f2355cb
LR
63static const struct ieee80211_regdomain *country_ie_regdomain;
64
e38f8a7a 65/* Used to queue up regulatory hints */
fe33eb39
LR
66static LIST_HEAD(reg_requests_list);
67static spinlock_t reg_requests_lock;
68
e38f8a7a
LR
69/* Used to queue up beacon hints for review */
70static LIST_HEAD(reg_pending_beacons);
71static spinlock_t reg_pending_beacons_lock;
72
73/* Used to keep track of processed beacon hints */
74static LIST_HEAD(reg_beacon_list);
75
76struct reg_beacon {
77 struct list_head list;
78 struct ieee80211_channel chan;
79};
80
734366de
JB
81/* We keep a static world regulatory domain in case of the absence of CRDA */
82static const struct ieee80211_regdomain world_regdom = {
611b6a82 83 .n_reg_rules = 5,
734366de
JB
84 .alpha2 = "00",
85 .reg_rules = {
68798a62
LR
86 /* IEEE 802.11b/g, channels 1..11 */
87 REG_RULE(2412-10, 2462+10, 40, 6, 20, 0),
611b6a82
LR
88 /* IEEE 802.11b/g, channels 12..13. No HT40
89 * channel fits here. */
90 REG_RULE(2467-10, 2472+10, 20, 6, 20,
3fc71f77
LR
91 NL80211_RRF_PASSIVE_SCAN |
92 NL80211_RRF_NO_IBSS),
611b6a82
LR
93 /* IEEE 802.11 channel 14 - Only JP enables
94 * this and for 802.11b only */
95 REG_RULE(2484-10, 2484+10, 20, 6, 20,
96 NL80211_RRF_PASSIVE_SCAN |
97 NL80211_RRF_NO_IBSS |
98 NL80211_RRF_NO_OFDM),
99 /* IEEE 802.11a, channel 36..48 */
ec329ace 100 REG_RULE(5180-10, 5240+10, 40, 6, 20,
611b6a82
LR
101 NL80211_RRF_PASSIVE_SCAN |
102 NL80211_RRF_NO_IBSS),
3fc71f77
LR
103
104 /* NB: 5260 MHz - 5700 MHz requies DFS */
105
106 /* IEEE 802.11a, channel 149..165 */
ec329ace 107 REG_RULE(5745-10, 5825+10, 40, 6, 20,
3fc71f77
LR
108 NL80211_RRF_PASSIVE_SCAN |
109 NL80211_RRF_NO_IBSS),
734366de
JB
110 }
111};
112
a3d2eaf0
JB
113static const struct ieee80211_regdomain *cfg80211_world_regdom =
114 &world_regdom;
734366de
JB
115
116#ifdef CONFIG_WIRELESS_OLD_REGULATORY
117static char *ieee80211_regdom = "US";
6ee7d330
LR
118#else
119static char *ieee80211_regdom = "00";
120#endif
121
734366de
JB
122module_param(ieee80211_regdom, charp, 0444);
123MODULE_PARM_DESC(ieee80211_regdom, "IEEE 802.11 regulatory domain code");
124
6ee7d330 125#ifdef CONFIG_WIRELESS_OLD_REGULATORY
fb1fc7ad
LR
126/*
127 * We assume 40 MHz bandwidth for the old regulatory work.
734366de 128 * We make emphasis we are using the exact same frequencies
fb1fc7ad
LR
129 * as before
130 */
734366de
JB
131
132static const struct ieee80211_regdomain us_regdom = {
133 .n_reg_rules = 6,
134 .alpha2 = "US",
135 .reg_rules = {
136 /* IEEE 802.11b/g, channels 1..11 */
137 REG_RULE(2412-10, 2462+10, 40, 6, 27, 0),
138 /* IEEE 802.11a, channel 36 */
139 REG_RULE(5180-10, 5180+10, 40, 6, 23, 0),
140 /* IEEE 802.11a, channel 40 */
141 REG_RULE(5200-10, 5200+10, 40, 6, 23, 0),
142 /* IEEE 802.11a, channel 44 */
143 REG_RULE(5220-10, 5220+10, 40, 6, 23, 0),
144 /* IEEE 802.11a, channels 48..64 */
145 REG_RULE(5240-10, 5320+10, 40, 6, 23, 0),
146 /* IEEE 802.11a, channels 149..165, outdoor */
147 REG_RULE(5745-10, 5825+10, 40, 6, 30, 0),
148 }
149};
150
151static const struct ieee80211_regdomain jp_regdom = {
152 .n_reg_rules = 3,
153 .alpha2 = "JP",
154 .reg_rules = {
155 /* IEEE 802.11b/g, channels 1..14 */
156 REG_RULE(2412-10, 2484+10, 40, 6, 20, 0),
157 /* IEEE 802.11a, channels 34..48 */
158 REG_RULE(5170-10, 5240+10, 40, 6, 20,
159 NL80211_RRF_PASSIVE_SCAN),
160 /* IEEE 802.11a, channels 52..64 */
161 REG_RULE(5260-10, 5320+10, 40, 6, 20,
162 NL80211_RRF_NO_IBSS |
163 NL80211_RRF_DFS),
164 }
165};
166
167static const struct ieee80211_regdomain eu_regdom = {
168 .n_reg_rules = 6,
fb1fc7ad
LR
169 /*
170 * This alpha2 is bogus, we leave it here just for stupid
171 * backward compatibility
172 */
734366de
JB
173 .alpha2 = "EU",
174 .reg_rules = {
175 /* IEEE 802.11b/g, channels 1..13 */
176 REG_RULE(2412-10, 2472+10, 40, 6, 20, 0),
177 /* IEEE 802.11a, channel 36 */
178 REG_RULE(5180-10, 5180+10, 40, 6, 23,
179 NL80211_RRF_PASSIVE_SCAN),
180 /* IEEE 802.11a, channel 40 */
181 REG_RULE(5200-10, 5200+10, 40, 6, 23,
182 NL80211_RRF_PASSIVE_SCAN),
183 /* IEEE 802.11a, channel 44 */
184 REG_RULE(5220-10, 5220+10, 40, 6, 23,
185 NL80211_RRF_PASSIVE_SCAN),
186 /* IEEE 802.11a, channels 48..64 */
187 REG_RULE(5240-10, 5320+10, 40, 6, 20,
188 NL80211_RRF_NO_IBSS |
189 NL80211_RRF_DFS),
190 /* IEEE 802.11a, channels 100..140 */
191 REG_RULE(5500-10, 5700+10, 40, 6, 30,
192 NL80211_RRF_NO_IBSS |
193 NL80211_RRF_DFS),
194 }
195};
196
197static const struct ieee80211_regdomain *static_regdom(char *alpha2)
198{
199 if (alpha2[0] == 'U' && alpha2[1] == 'S')
200 return &us_regdom;
201 if (alpha2[0] == 'J' && alpha2[1] == 'P')
202 return &jp_regdom;
203 if (alpha2[0] == 'E' && alpha2[1] == 'U')
204 return &eu_regdom;
205 /* Default, as per the old rules */
206 return &us_regdom;
207}
208
a3d2eaf0 209static bool is_old_static_regdom(const struct ieee80211_regdomain *rd)
734366de
JB
210{
211 if (rd == &us_regdom || rd == &jp_regdom || rd == &eu_regdom)
212 return true;
213 return false;
214}
942b25cf
JB
215#else
216static inline bool is_old_static_regdom(const struct ieee80211_regdomain *rd)
734366de 217{
942b25cf 218 return false;
734366de 219}
942b25cf
JB
220#endif
221
734366de
JB
222static void reset_regdomains(void)
223{
942b25cf
JB
224 /* avoid freeing static information or freeing something twice */
225 if (cfg80211_regdomain == cfg80211_world_regdom)
226 cfg80211_regdomain = NULL;
227 if (cfg80211_world_regdom == &world_regdom)
228 cfg80211_world_regdom = NULL;
229 if (cfg80211_regdomain == &world_regdom)
230 cfg80211_regdomain = NULL;
231 if (is_old_static_regdom(cfg80211_regdomain))
232 cfg80211_regdomain = NULL;
233
234 kfree(cfg80211_regdomain);
235 kfree(cfg80211_world_regdom);
734366de 236
a3d2eaf0 237 cfg80211_world_regdom = &world_regdom;
734366de
JB
238 cfg80211_regdomain = NULL;
239}
240
fb1fc7ad
LR
241/*
242 * Dynamic world regulatory domain requested by the wireless
243 * core upon initialization
244 */
a3d2eaf0 245static void update_world_regdomain(const struct ieee80211_regdomain *rd)
734366de 246{
f6037d09 247 BUG_ON(!last_request);
734366de
JB
248
249 reset_regdomains();
250
251 cfg80211_world_regdom = rd;
252 cfg80211_regdomain = rd;
253}
734366de 254
a3d2eaf0 255bool is_world_regdom(const char *alpha2)
b2e1b302
LR
256{
257 if (!alpha2)
258 return false;
259 if (alpha2[0] == '0' && alpha2[1] == '0')
260 return true;
261 return false;
262}
8318d78a 263
a3d2eaf0 264static bool is_alpha2_set(const char *alpha2)
b2e1b302
LR
265{
266 if (!alpha2)
267 return false;
268 if (alpha2[0] != 0 && alpha2[1] != 0)
269 return true;
270 return false;
271}
8318d78a 272
b2e1b302
LR
273static bool is_alpha_upper(char letter)
274{
275 /* ASCII A - Z */
276 if (letter >= 65 && letter <= 90)
277 return true;
278 return false;
279}
8318d78a 280
a3d2eaf0 281static bool is_unknown_alpha2(const char *alpha2)
b2e1b302
LR
282{
283 if (!alpha2)
284 return false;
fb1fc7ad
LR
285 /*
286 * Special case where regulatory domain was built by driver
287 * but a specific alpha2 cannot be determined
288 */
b2e1b302
LR
289 if (alpha2[0] == '9' && alpha2[1] == '9')
290 return true;
291 return false;
292}
8318d78a 293
3f2355cb
LR
294static bool is_intersected_alpha2(const char *alpha2)
295{
296 if (!alpha2)
297 return false;
fb1fc7ad
LR
298 /*
299 * Special case where regulatory domain is the
3f2355cb 300 * result of an intersection between two regulatory domain
fb1fc7ad
LR
301 * structures
302 */
3f2355cb
LR
303 if (alpha2[0] == '9' && alpha2[1] == '8')
304 return true;
305 return false;
306}
307
a3d2eaf0 308static bool is_an_alpha2(const char *alpha2)
b2e1b302
LR
309{
310 if (!alpha2)
311 return false;
312 if (is_alpha_upper(alpha2[0]) && is_alpha_upper(alpha2[1]))
313 return true;
314 return false;
315}
8318d78a 316
a3d2eaf0 317static bool alpha2_equal(const char *alpha2_x, const char *alpha2_y)
b2e1b302
LR
318{
319 if (!alpha2_x || !alpha2_y)
320 return false;
321 if (alpha2_x[0] == alpha2_y[0] &&
322 alpha2_x[1] == alpha2_y[1])
323 return true;
324 return false;
325}
326
69b1572b 327static bool regdom_changes(const char *alpha2)
b2e1b302 328{
761cf7ec
LR
329 assert_cfg80211_lock();
330
b2e1b302
LR
331 if (!cfg80211_regdomain)
332 return true;
333 if (alpha2_equal(cfg80211_regdomain->alpha2, alpha2))
334 return false;
335 return true;
336}
337
3f2355cb
LR
338/**
339 * country_ie_integrity_changes - tells us if the country IE has changed
340 * @checksum: checksum of country IE of fields we are interested in
341 *
342 * If the country IE has not changed you can ignore it safely. This is
343 * useful to determine if two devices are seeing two different country IEs
344 * even on the same alpha2. Note that this will return false if no IE has
345 * been set on the wireless core yet.
346 */
347static bool country_ie_integrity_changes(u32 checksum)
348{
349 /* If no IE has been set then the checksum doesn't change */
350 if (unlikely(!last_request->country_ie_checksum))
351 return false;
352 if (unlikely(last_request->country_ie_checksum != checksum))
353 return true;
354 return false;
355}
356
fb1fc7ad
LR
357/*
358 * This lets us keep regulatory code which is updated on a regulatory
359 * basis in userspace.
360 */
b2e1b302
LR
361static int call_crda(const char *alpha2)
362{
363 char country_env[9 + 2] = "COUNTRY=";
364 char *envp[] = {
365 country_env,
366 NULL
367 };
368
369 if (!is_world_regdom((char *) alpha2))
370 printk(KERN_INFO "cfg80211: Calling CRDA for country: %c%c\n",
371 alpha2[0], alpha2[1]);
372 else
b2e1b302
LR
373 printk(KERN_INFO "cfg80211: Calling CRDA to update world "
374 "regulatory domain\n");
b2e1b302
LR
375
376 country_env[8] = alpha2[0];
377 country_env[9] = alpha2[1];
378
379 return kobject_uevent_env(&reg_pdev->dev.kobj, KOBJ_CHANGE, envp);
380}
381
b2e1b302 382/* Used by nl80211 before kmalloc'ing our regulatory domain */
a3d2eaf0 383bool reg_is_valid_request(const char *alpha2)
b2e1b302 384{
f6037d09
JB
385 if (!last_request)
386 return false;
387
388 return alpha2_equal(last_request->alpha2, alpha2);
b2e1b302 389}
8318d78a 390
b2e1b302 391/* Sanity check on a regulatory rule */
a3d2eaf0 392static bool is_valid_reg_rule(const struct ieee80211_reg_rule *rule)
8318d78a 393{
a3d2eaf0 394 const struct ieee80211_freq_range *freq_range = &rule->freq_range;
b2e1b302
LR
395 u32 freq_diff;
396
91e99004 397 if (freq_range->start_freq_khz <= 0 || freq_range->end_freq_khz <= 0)
b2e1b302
LR
398 return false;
399
400 if (freq_range->start_freq_khz > freq_range->end_freq_khz)
401 return false;
402
403 freq_diff = freq_range->end_freq_khz - freq_range->start_freq_khz;
404
bd05f28e
RK
405 if (freq_range->end_freq_khz <= freq_range->start_freq_khz ||
406 freq_range->max_bandwidth_khz > freq_diff)
b2e1b302
LR
407 return false;
408
409 return true;
410}
411
a3d2eaf0 412static bool is_valid_rd(const struct ieee80211_regdomain *rd)
b2e1b302 413{
a3d2eaf0 414 const struct ieee80211_reg_rule *reg_rule = NULL;
b2e1b302 415 unsigned int i;
8318d78a 416
b2e1b302
LR
417 if (!rd->n_reg_rules)
418 return false;
8318d78a 419
88dc1c3f
LR
420 if (WARN_ON(rd->n_reg_rules > NL80211_MAX_SUPP_REG_RULES))
421 return false;
422
b2e1b302
LR
423 for (i = 0; i < rd->n_reg_rules; i++) {
424 reg_rule = &rd->reg_rules[i];
425 if (!is_valid_reg_rule(reg_rule))
426 return false;
427 }
428
429 return true;
8318d78a
JB
430}
431
038659e7
LR
432static bool reg_does_bw_fit(const struct ieee80211_freq_range *freq_range,
433 u32 center_freq_khz,
434 u32 bw_khz)
b2e1b302 435{
038659e7
LR
436 u32 start_freq_khz, end_freq_khz;
437
438 start_freq_khz = center_freq_khz - (bw_khz/2);
439 end_freq_khz = center_freq_khz + (bw_khz/2);
440
441 if (start_freq_khz >= freq_range->start_freq_khz &&
442 end_freq_khz <= freq_range->end_freq_khz)
443 return true;
444
445 return false;
b2e1b302 446}
8318d78a 447
0c7dc45d
LR
448/**
449 * freq_in_rule_band - tells us if a frequency is in a frequency band
450 * @freq_range: frequency rule we want to query
451 * @freq_khz: frequency we are inquiring about
452 *
453 * This lets us know if a specific frequency rule is or is not relevant to
454 * a specific frequency's band. Bands are device specific and artificial
455 * definitions (the "2.4 GHz band" and the "5 GHz band"), however it is
456 * safe for now to assume that a frequency rule should not be part of a
457 * frequency's band if the start freq or end freq are off by more than 2 GHz.
458 * This resolution can be lowered and should be considered as we add
459 * regulatory rule support for other "bands".
460 **/
461static bool freq_in_rule_band(const struct ieee80211_freq_range *freq_range,
462 u32 freq_khz)
463{
464#define ONE_GHZ_IN_KHZ 1000000
465 if (abs(freq_khz - freq_range->start_freq_khz) <= (2 * ONE_GHZ_IN_KHZ))
466 return true;
467 if (abs(freq_khz - freq_range->end_freq_khz) <= (2 * ONE_GHZ_IN_KHZ))
468 return true;
469 return false;
470#undef ONE_GHZ_IN_KHZ
471}
472
fb1fc7ad
LR
473/*
474 * Converts a country IE to a regulatory domain. A regulatory domain
3f2355cb
LR
475 * structure has a lot of information which the IE doesn't yet have,
476 * so for the other values we use upper max values as we will intersect
fb1fc7ad
LR
477 * with our userspace regulatory agent to get lower bounds.
478 */
3f2355cb
LR
479static struct ieee80211_regdomain *country_ie_2_rd(
480 u8 *country_ie,
481 u8 country_ie_len,
482 u32 *checksum)
483{
484 struct ieee80211_regdomain *rd = NULL;
485 unsigned int i = 0;
486 char alpha2[2];
487 u32 flags = 0;
488 u32 num_rules = 0, size_of_regd = 0;
489 u8 *triplets_start = NULL;
490 u8 len_at_triplet = 0;
491 /* the last channel we have registered in a subband (triplet) */
492 int last_sub_max_channel = 0;
493
494 *checksum = 0xDEADBEEF;
495
496 /* Country IE requirements */
497 BUG_ON(country_ie_len < IEEE80211_COUNTRY_IE_MIN_LEN ||
498 country_ie_len & 0x01);
499
500 alpha2[0] = country_ie[0];
501 alpha2[1] = country_ie[1];
502
503 /*
504 * Third octet can be:
505 * 'I' - Indoor
506 * 'O' - Outdoor
507 *
508 * anything else we assume is no restrictions
509 */
510 if (country_ie[2] == 'I')
511 flags = NL80211_RRF_NO_OUTDOOR;
512 else if (country_ie[2] == 'O')
513 flags = NL80211_RRF_NO_INDOOR;
514
515 country_ie += 3;
516 country_ie_len -= 3;
517
518 triplets_start = country_ie;
519 len_at_triplet = country_ie_len;
520
521 *checksum ^= ((flags ^ alpha2[0] ^ alpha2[1]) << 8);
522
fb1fc7ad
LR
523 /*
524 * We need to build a reg rule for each triplet, but first we must
3f2355cb 525 * calculate the number of reg rules we will need. We will need one
fb1fc7ad
LR
526 * for each channel subband
527 */
3f2355cb 528 while (country_ie_len >= 3) {
615aab4b 529 int end_channel = 0;
3f2355cb
LR
530 struct ieee80211_country_ie_triplet *triplet =
531 (struct ieee80211_country_ie_triplet *) country_ie;
532 int cur_sub_max_channel = 0, cur_channel = 0;
533
534 if (triplet->ext.reg_extension_id >=
535 IEEE80211_COUNTRY_EXTENSION_ID) {
536 country_ie += 3;
537 country_ie_len -= 3;
538 continue;
539 }
540
615aab4b
LR
541 /* 2 GHz */
542 if (triplet->chans.first_channel <= 14)
543 end_channel = triplet->chans.first_channel +
544 triplet->chans.num_channels;
545 else
546 /*
547 * 5 GHz -- For example in country IEs if the first
548 * channel given is 36 and the number of channels is 4
549 * then the individual channel numbers defined for the
550 * 5 GHz PHY by these parameters are: 36, 40, 44, and 48
551 * and not 36, 37, 38, 39.
552 *
553 * See: http://tinyurl.com/11d-clarification
554 */
555 end_channel = triplet->chans.first_channel +
556 (4 * (triplet->chans.num_channels - 1));
557
3f2355cb 558 cur_channel = triplet->chans.first_channel;
615aab4b 559 cur_sub_max_channel = end_channel;
3f2355cb
LR
560
561 /* Basic sanity check */
562 if (cur_sub_max_channel < cur_channel)
563 return NULL;
564
fb1fc7ad
LR
565 /*
566 * Do not allow overlapping channels. Also channels
3f2355cb 567 * passed in each subband must be monotonically
fb1fc7ad
LR
568 * increasing
569 */
3f2355cb
LR
570 if (last_sub_max_channel) {
571 if (cur_channel <= last_sub_max_channel)
572 return NULL;
573 if (cur_sub_max_channel <= last_sub_max_channel)
574 return NULL;
575 }
576
fb1fc7ad
LR
577 /*
578 * When dot11RegulatoryClassesRequired is supported
3f2355cb
LR
579 * we can throw ext triplets as part of this soup,
580 * for now we don't care when those change as we
fb1fc7ad
LR
581 * don't support them
582 */
3f2355cb
LR
583 *checksum ^= ((cur_channel ^ cur_sub_max_channel) << 8) |
584 ((cur_sub_max_channel ^ cur_sub_max_channel) << 16) |
585 ((triplet->chans.max_power ^ cur_sub_max_channel) << 24);
586
587 last_sub_max_channel = cur_sub_max_channel;
588
589 country_ie += 3;
590 country_ie_len -= 3;
591 num_rules++;
592
fb1fc7ad
LR
593 /*
594 * Note: this is not a IEEE requirement but
595 * simply a memory requirement
596 */
3f2355cb
LR
597 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
598 return NULL;
599 }
600
601 country_ie = triplets_start;
602 country_ie_len = len_at_triplet;
603
604 size_of_regd = sizeof(struct ieee80211_regdomain) +
605 (num_rules * sizeof(struct ieee80211_reg_rule));
606
607 rd = kzalloc(size_of_regd, GFP_KERNEL);
608 if (!rd)
609 return NULL;
610
611 rd->n_reg_rules = num_rules;
612 rd->alpha2[0] = alpha2[0];
613 rd->alpha2[1] = alpha2[1];
614
615 /* This time around we fill in the rd */
616 while (country_ie_len >= 3) {
02e68a3d 617 int end_channel = 0;
3f2355cb
LR
618 struct ieee80211_country_ie_triplet *triplet =
619 (struct ieee80211_country_ie_triplet *) country_ie;
620 struct ieee80211_reg_rule *reg_rule = NULL;
621 struct ieee80211_freq_range *freq_range = NULL;
622 struct ieee80211_power_rule *power_rule = NULL;
623
fb1fc7ad
LR
624 /*
625 * Must parse if dot11RegulatoryClassesRequired is true,
626 * we don't support this yet
627 */
3f2355cb
LR
628 if (triplet->ext.reg_extension_id >=
629 IEEE80211_COUNTRY_EXTENSION_ID) {
630 country_ie += 3;
631 country_ie_len -= 3;
632 continue;
633 }
634
635 reg_rule = &rd->reg_rules[i];
636 freq_range = &reg_rule->freq_range;
637 power_rule = &reg_rule->power_rule;
638
639 reg_rule->flags = flags;
640
02e68a3d
LR
641 /* 2 GHz */
642 if (triplet->chans.first_channel <= 14)
643 end_channel = triplet->chans.first_channel +
644 triplet->chans.num_channels;
645 else
02e68a3d
LR
646 end_channel = triplet->chans.first_channel +
647 (4 * (triplet->chans.num_channels - 1));
648
fb1fc7ad
LR
649 /*
650 * The +10 is since the regulatory domain expects
3f2355cb
LR
651 * the actual band edge, not the center of freq for
652 * its start and end freqs, assuming 20 MHz bandwidth on
fb1fc7ad
LR
653 * the channels passed
654 */
3f2355cb
LR
655 freq_range->start_freq_khz =
656 MHZ_TO_KHZ(ieee80211_channel_to_frequency(
657 triplet->chans.first_channel) - 10);
658 freq_range->end_freq_khz =
659 MHZ_TO_KHZ(ieee80211_channel_to_frequency(
02e68a3d 660 end_channel) + 10);
3f2355cb 661
fb1fc7ad
LR
662 /*
663 * These are large arbitrary values we use to intersect later.
664 * Increment this if we ever support >= 40 MHz channels
665 * in IEEE 802.11
666 */
3f2355cb
LR
667 freq_range->max_bandwidth_khz = MHZ_TO_KHZ(40);
668 power_rule->max_antenna_gain = DBI_TO_MBI(100);
669 power_rule->max_eirp = DBM_TO_MBM(100);
670
671 country_ie += 3;
672 country_ie_len -= 3;
673 i++;
674
675 BUG_ON(i > NL80211_MAX_SUPP_REG_RULES);
676 }
677
678 return rd;
679}
680
681
fb1fc7ad
LR
682/*
683 * Helper for regdom_intersect(), this does the real
684 * mathematical intersection fun
685 */
9c96477d
LR
686static int reg_rules_intersect(
687 const struct ieee80211_reg_rule *rule1,
688 const struct ieee80211_reg_rule *rule2,
689 struct ieee80211_reg_rule *intersected_rule)
690{
691 const struct ieee80211_freq_range *freq_range1, *freq_range2;
692 struct ieee80211_freq_range *freq_range;
693 const struct ieee80211_power_rule *power_rule1, *power_rule2;
694 struct ieee80211_power_rule *power_rule;
695 u32 freq_diff;
696
697 freq_range1 = &rule1->freq_range;
698 freq_range2 = &rule2->freq_range;
699 freq_range = &intersected_rule->freq_range;
700
701 power_rule1 = &rule1->power_rule;
702 power_rule2 = &rule2->power_rule;
703 power_rule = &intersected_rule->power_rule;
704
705 freq_range->start_freq_khz = max(freq_range1->start_freq_khz,
706 freq_range2->start_freq_khz);
707 freq_range->end_freq_khz = min(freq_range1->end_freq_khz,
708 freq_range2->end_freq_khz);
709 freq_range->max_bandwidth_khz = min(freq_range1->max_bandwidth_khz,
710 freq_range2->max_bandwidth_khz);
711
712 freq_diff = freq_range->end_freq_khz - freq_range->start_freq_khz;
713 if (freq_range->max_bandwidth_khz > freq_diff)
714 freq_range->max_bandwidth_khz = freq_diff;
715
716 power_rule->max_eirp = min(power_rule1->max_eirp,
717 power_rule2->max_eirp);
718 power_rule->max_antenna_gain = min(power_rule1->max_antenna_gain,
719 power_rule2->max_antenna_gain);
720
721 intersected_rule->flags = (rule1->flags | rule2->flags);
722
723 if (!is_valid_reg_rule(intersected_rule))
724 return -EINVAL;
725
726 return 0;
727}
728
729/**
730 * regdom_intersect - do the intersection between two regulatory domains
731 * @rd1: first regulatory domain
732 * @rd2: second regulatory domain
733 *
734 * Use this function to get the intersection between two regulatory domains.
735 * Once completed we will mark the alpha2 for the rd as intersected, "98",
736 * as no one single alpha2 can represent this regulatory domain.
737 *
738 * Returns a pointer to the regulatory domain structure which will hold the
739 * resulting intersection of rules between rd1 and rd2. We will
740 * kzalloc() this structure for you.
741 */
742static struct ieee80211_regdomain *regdom_intersect(
743 const struct ieee80211_regdomain *rd1,
744 const struct ieee80211_regdomain *rd2)
745{
746 int r, size_of_regd;
747 unsigned int x, y;
748 unsigned int num_rules = 0, rule_idx = 0;
749 const struct ieee80211_reg_rule *rule1, *rule2;
750 struct ieee80211_reg_rule *intersected_rule;
751 struct ieee80211_regdomain *rd;
752 /* This is just a dummy holder to help us count */
753 struct ieee80211_reg_rule irule;
754
755 /* Uses the stack temporarily for counter arithmetic */
756 intersected_rule = &irule;
757
758 memset(intersected_rule, 0, sizeof(struct ieee80211_reg_rule));
759
760 if (!rd1 || !rd2)
761 return NULL;
762
fb1fc7ad
LR
763 /*
764 * First we get a count of the rules we'll need, then we actually
9c96477d
LR
765 * build them. This is to so we can malloc() and free() a
766 * regdomain once. The reason we use reg_rules_intersect() here
767 * is it will return -EINVAL if the rule computed makes no sense.
fb1fc7ad
LR
768 * All rules that do check out OK are valid.
769 */
9c96477d
LR
770
771 for (x = 0; x < rd1->n_reg_rules; x++) {
772 rule1 = &rd1->reg_rules[x];
773 for (y = 0; y < rd2->n_reg_rules; y++) {
774 rule2 = &rd2->reg_rules[y];
775 if (!reg_rules_intersect(rule1, rule2,
776 intersected_rule))
777 num_rules++;
778 memset(intersected_rule, 0,
779 sizeof(struct ieee80211_reg_rule));
780 }
781 }
782
783 if (!num_rules)
784 return NULL;
785
786 size_of_regd = sizeof(struct ieee80211_regdomain) +
787 ((num_rules + 1) * sizeof(struct ieee80211_reg_rule));
788
789 rd = kzalloc(size_of_regd, GFP_KERNEL);
790 if (!rd)
791 return NULL;
792
793 for (x = 0; x < rd1->n_reg_rules; x++) {
794 rule1 = &rd1->reg_rules[x];
795 for (y = 0; y < rd2->n_reg_rules; y++) {
796 rule2 = &rd2->reg_rules[y];
fb1fc7ad
LR
797 /*
798 * This time around instead of using the stack lets
9c96477d 799 * write to the target rule directly saving ourselves
fb1fc7ad
LR
800 * a memcpy()
801 */
9c96477d
LR
802 intersected_rule = &rd->reg_rules[rule_idx];
803 r = reg_rules_intersect(rule1, rule2,
804 intersected_rule);
fb1fc7ad
LR
805 /*
806 * No need to memset here the intersected rule here as
807 * we're not using the stack anymore
808 */
9c96477d
LR
809 if (r)
810 continue;
811 rule_idx++;
812 }
813 }
814
815 if (rule_idx != num_rules) {
816 kfree(rd);
817 return NULL;
818 }
819
820 rd->n_reg_rules = num_rules;
821 rd->alpha2[0] = '9';
822 rd->alpha2[1] = '8';
823
824 return rd;
825}
826
fb1fc7ad
LR
827/*
828 * XXX: add support for the rest of enum nl80211_reg_rule_flags, we may
829 * want to just have the channel structure use these
830 */
b2e1b302
LR
831static u32 map_regdom_flags(u32 rd_flags)
832{
833 u32 channel_flags = 0;
834 if (rd_flags & NL80211_RRF_PASSIVE_SCAN)
835 channel_flags |= IEEE80211_CHAN_PASSIVE_SCAN;
836 if (rd_flags & NL80211_RRF_NO_IBSS)
837 channel_flags |= IEEE80211_CHAN_NO_IBSS;
838 if (rd_flags & NL80211_RRF_DFS)
839 channel_flags |= IEEE80211_CHAN_RADAR;
840 return channel_flags;
841}
842
1fa25e41
LR
843static int freq_reg_info_regd(struct wiphy *wiphy,
844 u32 center_freq,
038659e7 845 u32 desired_bw_khz,
1fa25e41
LR
846 const struct ieee80211_reg_rule **reg_rule,
847 const struct ieee80211_regdomain *custom_regd)
8318d78a
JB
848{
849 int i;
0c7dc45d 850 bool band_rule_found = false;
3e0c3ff3 851 const struct ieee80211_regdomain *regd;
038659e7
LR
852 bool bw_fits = false;
853
854 if (!desired_bw_khz)
855 desired_bw_khz = MHZ_TO_KHZ(20);
8318d78a 856
1fa25e41 857 regd = custom_regd ? custom_regd : cfg80211_regdomain;
3e0c3ff3 858
fb1fc7ad
LR
859 /*
860 * Follow the driver's regulatory domain, if present, unless a country
861 * IE has been processed or a user wants to help complaince further
862 */
7db90f4a
LR
863 if (last_request->initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE &&
864 last_request->initiator != NL80211_REGDOM_SET_BY_USER &&
3e0c3ff3
LR
865 wiphy->regd)
866 regd = wiphy->regd;
867
868 if (!regd)
b2e1b302
LR
869 return -EINVAL;
870
3e0c3ff3 871 for (i = 0; i < regd->n_reg_rules; i++) {
b2e1b302
LR
872 const struct ieee80211_reg_rule *rr;
873 const struct ieee80211_freq_range *fr = NULL;
874 const struct ieee80211_power_rule *pr = NULL;
875
3e0c3ff3 876 rr = &regd->reg_rules[i];
b2e1b302
LR
877 fr = &rr->freq_range;
878 pr = &rr->power_rule;
0c7dc45d 879
fb1fc7ad
LR
880 /*
881 * We only need to know if one frequency rule was
0c7dc45d 882 * was in center_freq's band, that's enough, so lets
fb1fc7ad
LR
883 * not overwrite it once found
884 */
0c7dc45d
LR
885 if (!band_rule_found)
886 band_rule_found = freq_in_rule_band(fr, center_freq);
887
038659e7
LR
888 bw_fits = reg_does_bw_fit(fr,
889 center_freq,
890 desired_bw_khz);
0c7dc45d 891
038659e7 892 if (band_rule_found && bw_fits) {
b2e1b302 893 *reg_rule = rr;
038659e7 894 return 0;
8318d78a
JB
895 }
896 }
897
0c7dc45d
LR
898 if (!band_rule_found)
899 return -ERANGE;
900
038659e7 901 return -EINVAL;
b2e1b302 902}
34f57347 903EXPORT_SYMBOL(freq_reg_info);
b2e1b302 904
038659e7
LR
905int freq_reg_info(struct wiphy *wiphy,
906 u32 center_freq,
907 u32 desired_bw_khz,
908 const struct ieee80211_reg_rule **reg_rule)
1fa25e41 909{
ac46d48e 910 assert_cfg80211_lock();
038659e7
LR
911 return freq_reg_info_regd(wiphy,
912 center_freq,
913 desired_bw_khz,
914 reg_rule,
915 NULL);
1fa25e41 916}
b2e1b302 917
038659e7
LR
918/*
919 * Note that right now we assume the desired channel bandwidth
920 * is always 20 MHz for each individual channel (HT40 uses 20 MHz
921 * per channel, the primary and the extension channel). To support
922 * smaller custom bandwidths such as 5 MHz or 10 MHz we'll need a
923 * new ieee80211_channel.target_bw and re run the regulatory check
924 * on the wiphy with the target_bw specified. Then we can simply use
925 * that below for the desired_bw_khz below.
926 */
a92a3ce7
LR
927static void handle_channel(struct wiphy *wiphy, enum ieee80211_band band,
928 unsigned int chan_idx)
b2e1b302
LR
929{
930 int r;
038659e7
LR
931 u32 flags, bw_flags = 0;
932 u32 desired_bw_khz = MHZ_TO_KHZ(20);
b2e1b302
LR
933 const struct ieee80211_reg_rule *reg_rule = NULL;
934 const struct ieee80211_power_rule *power_rule = NULL;
038659e7 935 const struct ieee80211_freq_range *freq_range = NULL;
a92a3ce7
LR
936 struct ieee80211_supported_band *sband;
937 struct ieee80211_channel *chan;
fe33eb39 938 struct wiphy *request_wiphy = NULL;
a92a3ce7 939
761cf7ec
LR
940 assert_cfg80211_lock();
941
806a9e39
LR
942 request_wiphy = wiphy_idx_to_wiphy(last_request->wiphy_idx);
943
a92a3ce7
LR
944 sband = wiphy->bands[band];
945 BUG_ON(chan_idx >= sband->n_channels);
946 chan = &sband->channels[chan_idx];
947
948 flags = chan->orig_flags;
b2e1b302 949
038659e7
LR
950 r = freq_reg_info(wiphy,
951 MHZ_TO_KHZ(chan->center_freq),
952 desired_bw_khz,
953 &reg_rule);
b2e1b302
LR
954
955 if (r) {
fb1fc7ad
LR
956 /*
957 * This means no regulatory rule was found in the country IE
0c7dc45d
LR
958 * with a frequency range on the center_freq's band, since
959 * IEEE-802.11 allows for a country IE to have a subset of the
960 * regulatory information provided in a country we ignore
961 * disabling the channel unless at least one reg rule was
962 * found on the center_freq's band. For details see this
963 * clarification:
964 *
965 * http://tinyurl.com/11d-clarification
966 */
967 if (r == -ERANGE &&
7db90f4a
LR
968 last_request->initiator ==
969 NL80211_REGDOM_SET_BY_COUNTRY_IE) {
0c7dc45d
LR
970#ifdef CONFIG_CFG80211_REG_DEBUG
971 printk(KERN_DEBUG "cfg80211: Leaving channel %d MHz "
972 "intact on %s - no rule found in band on "
973 "Country IE\n",
974 chan->center_freq, wiphy_name(wiphy));
975#endif
976 } else {
fb1fc7ad
LR
977 /*
978 * In this case we know the country IE has at least one reg rule
979 * for the band so we respect its band definitions
980 */
0c7dc45d 981#ifdef CONFIG_CFG80211_REG_DEBUG
7db90f4a
LR
982 if (last_request->initiator ==
983 NL80211_REGDOM_SET_BY_COUNTRY_IE)
0c7dc45d
LR
984 printk(KERN_DEBUG "cfg80211: Disabling "
985 "channel %d MHz on %s due to "
986 "Country IE\n",
987 chan->center_freq, wiphy_name(wiphy));
988#endif
989 flags |= IEEE80211_CHAN_DISABLED;
990 chan->flags = flags;
991 }
8318d78a
JB
992 return;
993 }
994
b2e1b302 995 power_rule = &reg_rule->power_rule;
038659e7
LR
996 freq_range = &reg_rule->freq_range;
997
998 if (freq_range->max_bandwidth_khz < MHZ_TO_KHZ(40))
999 bw_flags = IEEE80211_CHAN_NO_HT40;
b2e1b302 1000
7db90f4a 1001 if (last_request->initiator == NL80211_REGDOM_SET_BY_DRIVER &&
806a9e39
LR
1002 request_wiphy && request_wiphy == wiphy &&
1003 request_wiphy->strict_regulatory) {
fb1fc7ad
LR
1004 /*
1005 * This gaurantees the driver's requested regulatory domain
f976376d 1006 * will always be used as a base for further regulatory
fb1fc7ad
LR
1007 * settings
1008 */
f976376d 1009 chan->flags = chan->orig_flags =
038659e7 1010 map_regdom_flags(reg_rule->flags) | bw_flags;
f976376d
LR
1011 chan->max_antenna_gain = chan->orig_mag =
1012 (int) MBI_TO_DBI(power_rule->max_antenna_gain);
038659e7 1013 chan->max_bandwidth = KHZ_TO_MHZ(desired_bw_khz);
f976376d
LR
1014 chan->max_power = chan->orig_mpwr =
1015 (int) MBM_TO_DBM(power_rule->max_eirp);
1016 return;
1017 }
1018
038659e7 1019 chan->flags = flags | bw_flags | map_regdom_flags(reg_rule->flags);
8318d78a 1020 chan->max_antenna_gain = min(chan->orig_mag,
b2e1b302 1021 (int) MBI_TO_DBI(power_rule->max_antenna_gain));
038659e7 1022 chan->max_bandwidth = KHZ_TO_MHZ(desired_bw_khz);
253898c4 1023 if (chan->orig_mpwr)
b2e1b302
LR
1024 chan->max_power = min(chan->orig_mpwr,
1025 (int) MBM_TO_DBM(power_rule->max_eirp));
253898c4 1026 else
b2e1b302 1027 chan->max_power = (int) MBM_TO_DBM(power_rule->max_eirp);
8318d78a
JB
1028}
1029
a92a3ce7 1030static void handle_band(struct wiphy *wiphy, enum ieee80211_band band)
8318d78a 1031{
a92a3ce7
LR
1032 unsigned int i;
1033 struct ieee80211_supported_band *sband;
1034
1035 BUG_ON(!wiphy->bands[band]);
1036 sband = wiphy->bands[band];
8318d78a
JB
1037
1038 for (i = 0; i < sband->n_channels; i++)
a92a3ce7 1039 handle_channel(wiphy, band, i);
8318d78a
JB
1040}
1041
7db90f4a
LR
1042static bool ignore_reg_update(struct wiphy *wiphy,
1043 enum nl80211_reg_initiator initiator)
14b9815a
LR
1044{
1045 if (!last_request)
1046 return true;
7db90f4a 1047 if (initiator == NL80211_REGDOM_SET_BY_CORE &&
2a44f911 1048 wiphy->custom_regulatory)
14b9815a 1049 return true;
fb1fc7ad
LR
1050 /*
1051 * wiphy->regd will be set once the device has its own
1052 * desired regulatory domain set
1053 */
f976376d
LR
1054 if (wiphy->strict_regulatory && !wiphy->regd &&
1055 !is_world_regdom(last_request->alpha2))
14b9815a
LR
1056 return true;
1057 return false;
1058}
1059
7db90f4a 1060static void update_all_wiphy_regulatory(enum nl80211_reg_initiator initiator)
8318d78a 1061{
b2e1b302 1062 struct cfg80211_registered_device *drv;
8318d78a 1063
b2e1b302 1064 list_for_each_entry(drv, &cfg80211_drv_list, list)
7db90f4a 1065 wiphy_update_regulatory(&drv->wiphy, initiator);
b2e1b302
LR
1066}
1067
e38f8a7a
LR
1068static void handle_reg_beacon(struct wiphy *wiphy,
1069 unsigned int chan_idx,
1070 struct reg_beacon *reg_beacon)
1071{
e38f8a7a
LR
1072 struct ieee80211_supported_band *sband;
1073 struct ieee80211_channel *chan;
6bad8766
LR
1074 bool channel_changed = false;
1075 struct ieee80211_channel chan_before;
e38f8a7a
LR
1076
1077 assert_cfg80211_lock();
1078
1079 sband = wiphy->bands[reg_beacon->chan.band];
1080 chan = &sband->channels[chan_idx];
1081
1082 if (likely(chan->center_freq != reg_beacon->chan.center_freq))
1083 return;
1084
6bad8766
LR
1085 if (chan->beacon_found)
1086 return;
1087
1088 chan->beacon_found = true;
1089
1090 chan_before.center_freq = chan->center_freq;
1091 chan_before.flags = chan->flags;
1092
a4ed90d6
LR
1093 if ((chan->flags & IEEE80211_CHAN_PASSIVE_SCAN) &&
1094 !(chan->orig_flags & IEEE80211_CHAN_PASSIVE_SCAN)) {
e38f8a7a 1095 chan->flags &= ~IEEE80211_CHAN_PASSIVE_SCAN;
6bad8766 1096 channel_changed = true;
e38f8a7a
LR
1097 }
1098
a4ed90d6
LR
1099 if ((chan->flags & IEEE80211_CHAN_NO_IBSS) &&
1100 !(chan->orig_flags & IEEE80211_CHAN_NO_IBSS)) {
e38f8a7a 1101 chan->flags &= ~IEEE80211_CHAN_NO_IBSS;
6bad8766 1102 channel_changed = true;
e38f8a7a
LR
1103 }
1104
6bad8766
LR
1105 if (channel_changed)
1106 nl80211_send_beacon_hint_event(wiphy, &chan_before, chan);
e38f8a7a
LR
1107}
1108
1109/*
1110 * Called when a scan on a wiphy finds a beacon on
1111 * new channel
1112 */
1113static void wiphy_update_new_beacon(struct wiphy *wiphy,
1114 struct reg_beacon *reg_beacon)
1115{
1116 unsigned int i;
1117 struct ieee80211_supported_band *sband;
1118
1119 assert_cfg80211_lock();
1120
1121 if (!wiphy->bands[reg_beacon->chan.band])
1122 return;
1123
1124 sband = wiphy->bands[reg_beacon->chan.band];
1125
1126 for (i = 0; i < sband->n_channels; i++)
1127 handle_reg_beacon(wiphy, i, reg_beacon);
1128}
1129
1130/*
1131 * Called upon reg changes or a new wiphy is added
1132 */
1133static void wiphy_update_beacon_reg(struct wiphy *wiphy)
1134{
1135 unsigned int i;
1136 struct ieee80211_supported_band *sband;
1137 struct reg_beacon *reg_beacon;
1138
1139 assert_cfg80211_lock();
1140
1141 if (list_empty(&reg_beacon_list))
1142 return;
1143
1144 list_for_each_entry(reg_beacon, &reg_beacon_list, list) {
1145 if (!wiphy->bands[reg_beacon->chan.band])
1146 continue;
1147 sband = wiphy->bands[reg_beacon->chan.band];
1148 for (i = 0; i < sband->n_channels; i++)
1149 handle_reg_beacon(wiphy, i, reg_beacon);
1150 }
1151}
1152
1153static bool reg_is_world_roaming(struct wiphy *wiphy)
1154{
1155 if (is_world_regdom(cfg80211_regdomain->alpha2) ||
1156 (wiphy->regd && is_world_regdom(wiphy->regd->alpha2)))
1157 return true;
b1ed8ddd
LR
1158 if (last_request &&
1159 last_request->initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE &&
e38f8a7a
LR
1160 wiphy->custom_regulatory)
1161 return true;
1162 return false;
1163}
1164
1165/* Reap the advantages of previously found beacons */
1166static void reg_process_beacons(struct wiphy *wiphy)
1167{
b1ed8ddd
LR
1168 /*
1169 * Means we are just firing up cfg80211, so no beacons would
1170 * have been processed yet.
1171 */
1172 if (!last_request)
1173 return;
e38f8a7a
LR
1174 if (!reg_is_world_roaming(wiphy))
1175 return;
1176 wiphy_update_beacon_reg(wiphy);
1177}
1178
038659e7
LR
1179static bool is_ht40_not_allowed(struct ieee80211_channel *chan)
1180{
1181 if (!chan)
1182 return true;
1183 if (chan->flags & IEEE80211_CHAN_DISABLED)
1184 return true;
1185 /* This would happen when regulatory rules disallow HT40 completely */
1186 if (IEEE80211_CHAN_NO_HT40 == (chan->flags & (IEEE80211_CHAN_NO_HT40)))
1187 return true;
1188 return false;
1189}
1190
1191static void reg_process_ht_flags_channel(struct wiphy *wiphy,
1192 enum ieee80211_band band,
1193 unsigned int chan_idx)
1194{
1195 struct ieee80211_supported_band *sband;
1196 struct ieee80211_channel *channel;
1197 struct ieee80211_channel *channel_before = NULL, *channel_after = NULL;
1198 unsigned int i;
1199
1200 assert_cfg80211_lock();
1201
1202 sband = wiphy->bands[band];
1203 BUG_ON(chan_idx >= sband->n_channels);
1204 channel = &sband->channels[chan_idx];
1205
1206 if (is_ht40_not_allowed(channel)) {
1207 channel->flags |= IEEE80211_CHAN_NO_HT40;
1208 return;
1209 }
1210
1211 /*
1212 * We need to ensure the extension channels exist to
1213 * be able to use HT40- or HT40+, this finds them (or not)
1214 */
1215 for (i = 0; i < sband->n_channels; i++) {
1216 struct ieee80211_channel *c = &sband->channels[i];
1217 if (c->center_freq == (channel->center_freq - 20))
1218 channel_before = c;
1219 if (c->center_freq == (channel->center_freq + 20))
1220 channel_after = c;
1221 }
1222
1223 /*
1224 * Please note that this assumes target bandwidth is 20 MHz,
1225 * if that ever changes we also need to change the below logic
1226 * to include that as well.
1227 */
1228 if (is_ht40_not_allowed(channel_before))
689da1b3 1229 channel->flags |= IEEE80211_CHAN_NO_HT40MINUS;
038659e7 1230 else
689da1b3 1231 channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
038659e7
LR
1232
1233 if (is_ht40_not_allowed(channel_after))
689da1b3 1234 channel->flags |= IEEE80211_CHAN_NO_HT40PLUS;
038659e7 1235 else
689da1b3 1236 channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
038659e7
LR
1237}
1238
1239static void reg_process_ht_flags_band(struct wiphy *wiphy,
1240 enum ieee80211_band band)
1241{
1242 unsigned int i;
1243 struct ieee80211_supported_band *sband;
1244
1245 BUG_ON(!wiphy->bands[band]);
1246 sband = wiphy->bands[band];
1247
1248 for (i = 0; i < sband->n_channels; i++)
1249 reg_process_ht_flags_channel(wiphy, band, i);
1250}
1251
1252static void reg_process_ht_flags(struct wiphy *wiphy)
1253{
1254 enum ieee80211_band band;
1255
1256 if (!wiphy)
1257 return;
1258
1259 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
1260 if (wiphy->bands[band])
1261 reg_process_ht_flags_band(wiphy, band);
1262 }
1263
1264}
1265
7db90f4a
LR
1266void wiphy_update_regulatory(struct wiphy *wiphy,
1267 enum nl80211_reg_initiator initiator)
b2e1b302
LR
1268{
1269 enum ieee80211_band band;
d46e5b1d 1270
7db90f4a 1271 if (ignore_reg_update(wiphy, initiator))
e38f8a7a 1272 goto out;
b2e1b302 1273 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
8318d78a 1274 if (wiphy->bands[band])
a92a3ce7 1275 handle_band(wiphy, band);
b2e1b302 1276 }
e38f8a7a
LR
1277out:
1278 reg_process_beacons(wiphy);
038659e7 1279 reg_process_ht_flags(wiphy);
560e28e1 1280 if (wiphy->reg_notifier)
716f9392 1281 wiphy->reg_notifier(wiphy, last_request);
b2e1b302
LR
1282}
1283
1fa25e41
LR
1284static void handle_channel_custom(struct wiphy *wiphy,
1285 enum ieee80211_band band,
1286 unsigned int chan_idx,
1287 const struct ieee80211_regdomain *regd)
1288{
1289 int r;
038659e7
LR
1290 u32 desired_bw_khz = MHZ_TO_KHZ(20);
1291 u32 bw_flags = 0;
1fa25e41
LR
1292 const struct ieee80211_reg_rule *reg_rule = NULL;
1293 const struct ieee80211_power_rule *power_rule = NULL;
038659e7 1294 const struct ieee80211_freq_range *freq_range = NULL;
1fa25e41
LR
1295 struct ieee80211_supported_band *sband;
1296 struct ieee80211_channel *chan;
1297
ac46d48e
LR
1298 assert_cfg80211_lock();
1299
1fa25e41
LR
1300 sband = wiphy->bands[band];
1301 BUG_ON(chan_idx >= sband->n_channels);
1302 chan = &sband->channels[chan_idx];
1303
038659e7
LR
1304 r = freq_reg_info_regd(wiphy,
1305 MHZ_TO_KHZ(chan->center_freq),
1306 desired_bw_khz,
1307 &reg_rule,
1308 regd);
1fa25e41
LR
1309
1310 if (r) {
1311 chan->flags = IEEE80211_CHAN_DISABLED;
1312 return;
1313 }
1314
1315 power_rule = &reg_rule->power_rule;
038659e7
LR
1316 freq_range = &reg_rule->freq_range;
1317
1318 if (freq_range->max_bandwidth_khz < MHZ_TO_KHZ(40))
1319 bw_flags = IEEE80211_CHAN_NO_HT40;
1fa25e41 1320
038659e7 1321 chan->flags |= map_regdom_flags(reg_rule->flags) | bw_flags;
1fa25e41 1322 chan->max_antenna_gain = (int) MBI_TO_DBI(power_rule->max_antenna_gain);
038659e7 1323 chan->max_bandwidth = KHZ_TO_MHZ(desired_bw_khz);
1fa25e41
LR
1324 chan->max_power = (int) MBM_TO_DBM(power_rule->max_eirp);
1325}
1326
1327static void handle_band_custom(struct wiphy *wiphy, enum ieee80211_band band,
1328 const struct ieee80211_regdomain *regd)
1329{
1330 unsigned int i;
1331 struct ieee80211_supported_band *sband;
1332
1333 BUG_ON(!wiphy->bands[band]);
1334 sband = wiphy->bands[band];
1335
1336 for (i = 0; i < sband->n_channels; i++)
1337 handle_channel_custom(wiphy, band, i, regd);
1338}
1339
1340/* Used by drivers prior to wiphy registration */
1341void wiphy_apply_custom_regulatory(struct wiphy *wiphy,
1342 const struct ieee80211_regdomain *regd)
1343{
1344 enum ieee80211_band band;
ac46d48e
LR
1345
1346 mutex_lock(&cfg80211_mutex);
1fa25e41
LR
1347 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
1348 if (wiphy->bands[band])
1349 handle_band_custom(wiphy, band, regd);
b2e1b302 1350 }
ac46d48e 1351 mutex_unlock(&cfg80211_mutex);
b2e1b302 1352}
1fa25e41
LR
1353EXPORT_SYMBOL(wiphy_apply_custom_regulatory);
1354
3e0c3ff3
LR
1355static int reg_copy_regd(const struct ieee80211_regdomain **dst_regd,
1356 const struct ieee80211_regdomain *src_regd)
1357{
1358 struct ieee80211_regdomain *regd;
1359 int size_of_regd = 0;
1360 unsigned int i;
1361
1362 size_of_regd = sizeof(struct ieee80211_regdomain) +
1363 ((src_regd->n_reg_rules + 1) * sizeof(struct ieee80211_reg_rule));
1364
1365 regd = kzalloc(size_of_regd, GFP_KERNEL);
1366 if (!regd)
1367 return -ENOMEM;
1368
1369 memcpy(regd, src_regd, sizeof(struct ieee80211_regdomain));
1370
1371 for (i = 0; i < src_regd->n_reg_rules; i++)
1372 memcpy(&regd->reg_rules[i], &src_regd->reg_rules[i],
1373 sizeof(struct ieee80211_reg_rule));
1374
1375 *dst_regd = regd;
1376 return 0;
1377}
b2e1b302 1378
fb1fc7ad
LR
1379/*
1380 * Return value which can be used by ignore_request() to indicate
1381 * it has been determined we should intersect two regulatory domains
1382 */
9c96477d
LR
1383#define REG_INTERSECT 1
1384
84fa4f43
JB
1385/* This has the logic which determines when a new request
1386 * should be ignored. */
2f92cd2e
LR
1387static int ignore_request(struct wiphy *wiphy,
1388 struct regulatory_request *pending_request)
84fa4f43 1389{
806a9e39 1390 struct wiphy *last_wiphy = NULL;
761cf7ec
LR
1391
1392 assert_cfg80211_lock();
1393
84fa4f43
JB
1394 /* All initial requests are respected */
1395 if (!last_request)
1396 return 0;
1397
2f92cd2e 1398 switch (pending_request->initiator) {
7db90f4a 1399 case NL80211_REGDOM_SET_BY_CORE:
ba25c141 1400 return -EINVAL;
7db90f4a 1401 case NL80211_REGDOM_SET_BY_COUNTRY_IE:
806a9e39
LR
1402
1403 last_wiphy = wiphy_idx_to_wiphy(last_request->wiphy_idx);
1404
2f92cd2e 1405 if (unlikely(!is_an_alpha2(pending_request->alpha2)))
84fa4f43 1406 return -EINVAL;
7db90f4a
LR
1407 if (last_request->initiator ==
1408 NL80211_REGDOM_SET_BY_COUNTRY_IE) {
806a9e39 1409 if (last_wiphy != wiphy) {
84fa4f43
JB
1410 /*
1411 * Two cards with two APs claiming different
1412 * different Country IE alpha2s. We could
1413 * intersect them, but that seems unlikely
1414 * to be correct. Reject second one for now.
1415 */
2f92cd2e 1416 if (regdom_changes(pending_request->alpha2))
84fa4f43
JB
1417 return -EOPNOTSUPP;
1418 return -EALREADY;
1419 }
fb1fc7ad
LR
1420 /*
1421 * Two consecutive Country IE hints on the same wiphy.
1422 * This should be picked up early by the driver/stack
1423 */
2f92cd2e 1424 if (WARN_ON(regdom_changes(pending_request->alpha2)))
84fa4f43
JB
1425 return 0;
1426 return -EALREADY;
1427 }
3f2355cb 1428 return REG_INTERSECT;
7db90f4a
LR
1429 case NL80211_REGDOM_SET_BY_DRIVER:
1430 if (last_request->initiator == NL80211_REGDOM_SET_BY_CORE) {
e74b1e7f
LR
1431 if (is_old_static_regdom(cfg80211_regdomain))
1432 return 0;
2f92cd2e 1433 if (regdom_changes(pending_request->alpha2))
e74b1e7f 1434 return 0;
84fa4f43 1435 return -EALREADY;
e74b1e7f 1436 }
fff32c04
LR
1437
1438 /*
1439 * This would happen if you unplug and plug your card
1440 * back in or if you add a new device for which the previously
1441 * loaded card also agrees on the regulatory domain.
1442 */
7db90f4a 1443 if (last_request->initiator == NL80211_REGDOM_SET_BY_DRIVER &&
2f92cd2e 1444 !regdom_changes(pending_request->alpha2))
fff32c04
LR
1445 return -EALREADY;
1446
3e0c3ff3 1447 return REG_INTERSECT;
7db90f4a
LR
1448 case NL80211_REGDOM_SET_BY_USER:
1449 if (last_request->initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE)
9c96477d 1450 return REG_INTERSECT;
fb1fc7ad
LR
1451 /*
1452 * If the user knows better the user should set the regdom
1453 * to their country before the IE is picked up
1454 */
7db90f4a 1455 if (last_request->initiator == NL80211_REGDOM_SET_BY_USER &&
3f2355cb
LR
1456 last_request->intersect)
1457 return -EOPNOTSUPP;
fb1fc7ad
LR
1458 /*
1459 * Process user requests only after previous user/driver/core
1460 * requests have been processed
1461 */
7db90f4a
LR
1462 if (last_request->initiator == NL80211_REGDOM_SET_BY_CORE ||
1463 last_request->initiator == NL80211_REGDOM_SET_BY_DRIVER ||
1464 last_request->initiator == NL80211_REGDOM_SET_BY_USER) {
69b1572b 1465 if (regdom_changes(last_request->alpha2))
5eebade6
LR
1466 return -EAGAIN;
1467 }
1468
e74b1e7f 1469 if (!is_old_static_regdom(cfg80211_regdomain) &&
2f92cd2e 1470 !regdom_changes(pending_request->alpha2))
e74b1e7f
LR
1471 return -EALREADY;
1472
84fa4f43
JB
1473 return 0;
1474 }
1475
1476 return -EINVAL;
1477}
1478
d1c96a9a
LR
1479/**
1480 * __regulatory_hint - hint to the wireless core a regulatory domain
1481 * @wiphy: if the hint comes from country information from an AP, this
1482 * is required to be set to the wiphy that received the information
28da32d7 1483 * @pending_request: the regulatory request currently being processed
d1c96a9a
LR
1484 *
1485 * The Wireless subsystem can use this function to hint to the wireless core
28da32d7 1486 * what it believes should be the current regulatory domain.
d1c96a9a
LR
1487 *
1488 * Returns zero if all went fine, %-EALREADY if a regulatory domain had
1489 * already been set or other standard error codes.
1490 *
1491 * Caller must hold &cfg80211_mutex
1492 */
28da32d7
LR
1493static int __regulatory_hint(struct wiphy *wiphy,
1494 struct regulatory_request *pending_request)
b2e1b302 1495{
9c96477d 1496 bool intersect = false;
b2e1b302
LR
1497 int r = 0;
1498
761cf7ec
LR
1499 assert_cfg80211_lock();
1500
2f92cd2e 1501 r = ignore_request(wiphy, pending_request);
9c96477d 1502
3e0c3ff3 1503 if (r == REG_INTERSECT) {
7db90f4a
LR
1504 if (pending_request->initiator ==
1505 NL80211_REGDOM_SET_BY_DRIVER) {
3e0c3ff3 1506 r = reg_copy_regd(&wiphy->regd, cfg80211_regdomain);
d951c1dd
LR
1507 if (r) {
1508 kfree(pending_request);
3e0c3ff3 1509 return r;
d951c1dd 1510 }
3e0c3ff3 1511 }
9c96477d 1512 intersect = true;
3e0c3ff3 1513 } else if (r) {
fb1fc7ad
LR
1514 /*
1515 * If the regulatory domain being requested by the
3e0c3ff3 1516 * driver has already been set just copy it to the
fb1fc7ad
LR
1517 * wiphy
1518 */
28da32d7 1519 if (r == -EALREADY &&
7db90f4a
LR
1520 pending_request->initiator ==
1521 NL80211_REGDOM_SET_BY_DRIVER) {
3e0c3ff3 1522 r = reg_copy_regd(&wiphy->regd, cfg80211_regdomain);
d951c1dd
LR
1523 if (r) {
1524 kfree(pending_request);
3e0c3ff3 1525 return r;
d951c1dd 1526 }
3e0c3ff3
LR
1527 r = -EALREADY;
1528 goto new_request;
1529 }
d951c1dd 1530 kfree(pending_request);
b2e1b302 1531 return r;
3e0c3ff3 1532 }
b2e1b302 1533
3e0c3ff3 1534new_request:
d951c1dd 1535 kfree(last_request);
5203cdb6 1536
d951c1dd
LR
1537 last_request = pending_request;
1538 last_request->intersect = intersect;
5203cdb6 1539
d951c1dd 1540 pending_request = NULL;
3e0c3ff3
LR
1541
1542 /* When r == REG_INTERSECT we do need to call CRDA */
73d54c9e
LR
1543 if (r < 0) {
1544 /*
1545 * Since CRDA will not be called in this case as we already
1546 * have applied the requested regulatory domain before we just
1547 * inform userspace we have processed the request
1548 */
1549 if (r == -EALREADY)
1550 nl80211_send_reg_change_event(last_request);
3e0c3ff3 1551 return r;
73d54c9e 1552 }
3e0c3ff3 1553
d951c1dd 1554 return call_crda(last_request->alpha2);
b2e1b302
LR
1555}
1556
30a548c7 1557/* This processes *all* regulatory hints */
d951c1dd 1558static void reg_process_hint(struct regulatory_request *reg_request)
fe33eb39
LR
1559{
1560 int r = 0;
1561 struct wiphy *wiphy = NULL;
1562
1563 BUG_ON(!reg_request->alpha2);
1564
1565 mutex_lock(&cfg80211_mutex);
1566
1567 if (wiphy_idx_valid(reg_request->wiphy_idx))
1568 wiphy = wiphy_idx_to_wiphy(reg_request->wiphy_idx);
1569
7db90f4a 1570 if (reg_request->initiator == NL80211_REGDOM_SET_BY_DRIVER &&
fe33eb39 1571 !wiphy) {
d951c1dd 1572 kfree(reg_request);
fe33eb39
LR
1573 goto out;
1574 }
1575
28da32d7 1576 r = __regulatory_hint(wiphy, reg_request);
fe33eb39
LR
1577 /* This is required so that the orig_* parameters are saved */
1578 if (r == -EALREADY && wiphy && wiphy->strict_regulatory)
1579 wiphy_update_regulatory(wiphy, reg_request->initiator);
1580out:
1581 mutex_unlock(&cfg80211_mutex);
fe33eb39
LR
1582}
1583
7db90f4a 1584/* Processes regulatory hints, this is all the NL80211_REGDOM_SET_BY_* */
fe33eb39
LR
1585static void reg_process_pending_hints(void)
1586 {
1587 struct regulatory_request *reg_request;
fe33eb39
LR
1588
1589 spin_lock(&reg_requests_lock);
1590 while (!list_empty(&reg_requests_list)) {
1591 reg_request = list_first_entry(&reg_requests_list,
1592 struct regulatory_request,
1593 list);
1594 list_del_init(&reg_request->list);
fe33eb39 1595
d951c1dd
LR
1596 spin_unlock(&reg_requests_lock);
1597 reg_process_hint(reg_request);
fe33eb39
LR
1598 spin_lock(&reg_requests_lock);
1599 }
1600 spin_unlock(&reg_requests_lock);
1601}
1602
e38f8a7a
LR
1603/* Processes beacon hints -- this has nothing to do with country IEs */
1604static void reg_process_pending_beacon_hints(void)
1605{
1606 struct cfg80211_registered_device *drv;
1607 struct reg_beacon *pending_beacon, *tmp;
1608
1609 mutex_lock(&cfg80211_mutex);
1610
1611 /* This goes through the _pending_ beacon list */
1612 spin_lock_bh(&reg_pending_beacons_lock);
1613
1614 if (list_empty(&reg_pending_beacons)) {
1615 spin_unlock_bh(&reg_pending_beacons_lock);
1616 goto out;
1617 }
1618
1619 list_for_each_entry_safe(pending_beacon, tmp,
1620 &reg_pending_beacons, list) {
1621
1622 list_del_init(&pending_beacon->list);
1623
1624 /* Applies the beacon hint to current wiphys */
1625 list_for_each_entry(drv, &cfg80211_drv_list, list)
1626 wiphy_update_new_beacon(&drv->wiphy, pending_beacon);
1627
1628 /* Remembers the beacon hint for new wiphys or reg changes */
1629 list_add_tail(&pending_beacon->list, &reg_beacon_list);
1630 }
1631
1632 spin_unlock_bh(&reg_pending_beacons_lock);
1633out:
1634 mutex_unlock(&cfg80211_mutex);
1635}
1636
fe33eb39
LR
1637static void reg_todo(struct work_struct *work)
1638{
1639 reg_process_pending_hints();
e38f8a7a 1640 reg_process_pending_beacon_hints();
fe33eb39
LR
1641}
1642
1643static DECLARE_WORK(reg_work, reg_todo);
1644
1645static void queue_regulatory_request(struct regulatory_request *request)
1646{
1647 spin_lock(&reg_requests_lock);
1648 list_add_tail(&request->list, &reg_requests_list);
1649 spin_unlock(&reg_requests_lock);
1650
1651 schedule_work(&reg_work);
1652}
1653
1654/* Core regulatory hint -- happens once during cfg80211_init() */
ba25c141
LR
1655static int regulatory_hint_core(const char *alpha2)
1656{
1657 struct regulatory_request *request;
1658
1659 BUG_ON(last_request);
1660
1661 request = kzalloc(sizeof(struct regulatory_request),
1662 GFP_KERNEL);
1663 if (!request)
1664 return -ENOMEM;
1665
1666 request->alpha2[0] = alpha2[0];
1667 request->alpha2[1] = alpha2[1];
7db90f4a 1668 request->initiator = NL80211_REGDOM_SET_BY_CORE;
ba25c141 1669
fe33eb39 1670 queue_regulatory_request(request);
ba25c141 1671
fe33eb39 1672 return 0;
ba25c141
LR
1673}
1674
fe33eb39
LR
1675/* User hints */
1676int regulatory_hint_user(const char *alpha2)
b2e1b302 1677{
fe33eb39
LR
1678 struct regulatory_request *request;
1679
be3d4810 1680 BUG_ON(!alpha2);
b2e1b302 1681
fe33eb39
LR
1682 request = kzalloc(sizeof(struct regulatory_request), GFP_KERNEL);
1683 if (!request)
1684 return -ENOMEM;
1685
1686 request->wiphy_idx = WIPHY_IDX_STALE;
1687 request->alpha2[0] = alpha2[0];
1688 request->alpha2[1] = alpha2[1];
7db90f4a 1689 request->initiator = NL80211_REGDOM_SET_BY_USER,
fe33eb39
LR
1690
1691 queue_regulatory_request(request);
1692
1693 return 0;
1694}
1695
1696/* Driver hints */
1697int regulatory_hint(struct wiphy *wiphy, const char *alpha2)
1698{
1699 struct regulatory_request *request;
1700
1701 BUG_ON(!alpha2);
1702 BUG_ON(!wiphy);
1703
1704 request = kzalloc(sizeof(struct regulatory_request), GFP_KERNEL);
1705 if (!request)
1706 return -ENOMEM;
1707
1708 request->wiphy_idx = get_wiphy_idx(wiphy);
1709
1710 /* Must have registered wiphy first */
1711 BUG_ON(!wiphy_idx_valid(request->wiphy_idx));
1712
1713 request->alpha2[0] = alpha2[0];
1714 request->alpha2[1] = alpha2[1];
7db90f4a 1715 request->initiator = NL80211_REGDOM_SET_BY_DRIVER;
fe33eb39
LR
1716
1717 queue_regulatory_request(request);
1718
1719 return 0;
b2e1b302
LR
1720}
1721EXPORT_SYMBOL(regulatory_hint);
1722
3f2355cb
LR
1723static bool reg_same_country_ie_hint(struct wiphy *wiphy,
1724 u32 country_ie_checksum)
1725{
806a9e39
LR
1726 struct wiphy *request_wiphy;
1727
761cf7ec
LR
1728 assert_cfg80211_lock();
1729
cc0b6fe8
LR
1730 if (unlikely(last_request->initiator !=
1731 NL80211_REGDOM_SET_BY_COUNTRY_IE))
1732 return false;
1733
806a9e39
LR
1734 request_wiphy = wiphy_idx_to_wiphy(last_request->wiphy_idx);
1735
1736 if (!request_wiphy)
3f2355cb 1737 return false;
806a9e39
LR
1738
1739 if (likely(request_wiphy != wiphy))
3f2355cb 1740 return !country_ie_integrity_changes(country_ie_checksum);
fb1fc7ad
LR
1741 /*
1742 * We should not have let these through at this point, they
3f2355cb 1743 * should have been picked up earlier by the first alpha2 check
fb1fc7ad
LR
1744 * on the device
1745 */
3f2355cb
LR
1746 if (WARN_ON(!country_ie_integrity_changes(country_ie_checksum)))
1747 return true;
1748 return false;
1749}
1750
1751void regulatory_hint_11d(struct wiphy *wiphy,
1752 u8 *country_ie,
1753 u8 country_ie_len)
1754{
1755 struct ieee80211_regdomain *rd = NULL;
1756 char alpha2[2];
1757 u32 checksum = 0;
1758 enum environment_cap env = ENVIRON_ANY;
fe33eb39 1759 struct regulatory_request *request;
3f2355cb 1760
a1794390 1761 mutex_lock(&cfg80211_mutex);
3f2355cb 1762
d335fe63
LR
1763 if (unlikely(!last_request)) {
1764 mutex_unlock(&cfg80211_mutex);
1765 return;
1766 }
1767
3f2355cb
LR
1768 /* IE len must be evenly divisible by 2 */
1769 if (country_ie_len & 0x01)
1770 goto out;
1771
1772 if (country_ie_len < IEEE80211_COUNTRY_IE_MIN_LEN)
1773 goto out;
1774
fb1fc7ad
LR
1775 /*
1776 * Pending country IE processing, this can happen after we
3f2355cb 1777 * call CRDA and wait for a response if a beacon was received before
fb1fc7ad
LR
1778 * we were able to process the last regulatory_hint_11d() call
1779 */
3f2355cb
LR
1780 if (country_ie_regdomain)
1781 goto out;
1782
1783 alpha2[0] = country_ie[0];
1784 alpha2[1] = country_ie[1];
1785
1786 if (country_ie[2] == 'I')
1787 env = ENVIRON_INDOOR;
1788 else if (country_ie[2] == 'O')
1789 env = ENVIRON_OUTDOOR;
1790
fb1fc7ad
LR
1791 /*
1792 * We will run this for *every* beacon processed for the BSSID, so
3f2355cb 1793 * we optimize an early check to exit out early if we don't have to
fb1fc7ad
LR
1794 * do anything
1795 */
cc0b6fe8
LR
1796 if (likely(last_request->initiator ==
1797 NL80211_REGDOM_SET_BY_COUNTRY_IE &&
1798 wiphy_idx_valid(last_request->wiphy_idx))) {
3f2355cb
LR
1799 struct cfg80211_registered_device *drv_last_ie;
1800
806a9e39
LR
1801 drv_last_ie =
1802 cfg80211_drv_by_wiphy_idx(last_request->wiphy_idx);
3f2355cb 1803
fb1fc7ad
LR
1804 /*
1805 * Lets keep this simple -- we trust the first AP
1806 * after we intersect with CRDA
1807 */
806a9e39 1808 if (likely(&drv_last_ie->wiphy == wiphy)) {
fb1fc7ad
LR
1809 /*
1810 * Ignore IEs coming in on this wiphy with
1811 * the same alpha2 and environment cap
1812 */
3f2355cb
LR
1813 if (likely(alpha2_equal(drv_last_ie->country_ie_alpha2,
1814 alpha2) &&
1815 env == drv_last_ie->env)) {
1816 goto out;
1817 }
fb1fc7ad
LR
1818 /*
1819 * the wiphy moved on to another BSSID or the AP
3f2355cb
LR
1820 * was reconfigured. XXX: We need to deal with the
1821 * case where the user suspends and goes to goes
1822 * to another country, and then gets IEs from an
fb1fc7ad
LR
1823 * AP with different settings
1824 */
3f2355cb
LR
1825 goto out;
1826 } else {
fb1fc7ad
LR
1827 /*
1828 * Ignore IEs coming in on two separate wiphys with
1829 * the same alpha2 and environment cap
1830 */
3f2355cb
LR
1831 if (likely(alpha2_equal(drv_last_ie->country_ie_alpha2,
1832 alpha2) &&
1833 env == drv_last_ie->env)) {
1834 goto out;
1835 }
1836 /* We could potentially intersect though */
1837 goto out;
1838 }
1839 }
1840
1841 rd = country_ie_2_rd(country_ie, country_ie_len, &checksum);
1842 if (!rd)
1843 goto out;
1844
915278e0
LR
1845 /*
1846 * This will not happen right now but we leave it here for the
3f2355cb
LR
1847 * the future when we want to add suspend/resume support and having
1848 * the user move to another country after doing so, or having the user
915278e0
LR
1849 * move to another AP. Right now we just trust the first AP.
1850 *
1851 * If we hit this before we add this support we want to be informed of
1852 * it as it would indicate a mistake in the current design
1853 */
1854 if (WARN_ON(reg_same_country_ie_hint(wiphy, checksum)))
0441d6ff 1855 goto free_rd_out;
3f2355cb 1856
fe33eb39
LR
1857 request = kzalloc(sizeof(struct regulatory_request), GFP_KERNEL);
1858 if (!request)
1859 goto free_rd_out;
1860
fb1fc7ad
LR
1861 /*
1862 * We keep this around for when CRDA comes back with a response so
1863 * we can intersect with that
1864 */
3f2355cb
LR
1865 country_ie_regdomain = rd;
1866
fe33eb39
LR
1867 request->wiphy_idx = get_wiphy_idx(wiphy);
1868 request->alpha2[0] = rd->alpha2[0];
1869 request->alpha2[1] = rd->alpha2[1];
7db90f4a 1870 request->initiator = NL80211_REGDOM_SET_BY_COUNTRY_IE;
fe33eb39
LR
1871 request->country_ie_checksum = checksum;
1872 request->country_ie_env = env;
1873
1874 mutex_unlock(&cfg80211_mutex);
3f2355cb 1875
fe33eb39
LR
1876 queue_regulatory_request(request);
1877
1878 return;
0441d6ff
LR
1879
1880free_rd_out:
1881 kfree(rd);
3f2355cb 1882out:
a1794390 1883 mutex_unlock(&cfg80211_mutex);
3f2355cb
LR
1884}
1885EXPORT_SYMBOL(regulatory_hint_11d);
b2e1b302 1886
e38f8a7a
LR
1887static bool freq_is_chan_12_13_14(u16 freq)
1888{
1889 if (freq == ieee80211_channel_to_frequency(12) ||
1890 freq == ieee80211_channel_to_frequency(13) ||
1891 freq == ieee80211_channel_to_frequency(14))
1892 return true;
1893 return false;
1894}
1895
1896int regulatory_hint_found_beacon(struct wiphy *wiphy,
1897 struct ieee80211_channel *beacon_chan,
1898 gfp_t gfp)
1899{
1900 struct reg_beacon *reg_beacon;
1901
1902 if (likely((beacon_chan->beacon_found ||
1903 (beacon_chan->flags & IEEE80211_CHAN_RADAR) ||
1904 (beacon_chan->band == IEEE80211_BAND_2GHZ &&
1905 !freq_is_chan_12_13_14(beacon_chan->center_freq)))))
1906 return 0;
1907
1908 reg_beacon = kzalloc(sizeof(struct reg_beacon), gfp);
1909 if (!reg_beacon)
1910 return -ENOMEM;
1911
1912#ifdef CONFIG_CFG80211_REG_DEBUG
1913 printk(KERN_DEBUG "cfg80211: Found new beacon on "
1914 "frequency: %d MHz (Ch %d) on %s\n",
1915 beacon_chan->center_freq,
1916 ieee80211_frequency_to_channel(beacon_chan->center_freq),
1917 wiphy_name(wiphy));
1918#endif
1919 memcpy(&reg_beacon->chan, beacon_chan,
1920 sizeof(struct ieee80211_channel));
1921
1922
1923 /*
1924 * Since we can be called from BH or and non-BH context
1925 * we must use spin_lock_bh()
1926 */
1927 spin_lock_bh(&reg_pending_beacons_lock);
1928 list_add_tail(&reg_beacon->list, &reg_pending_beacons);
1929 spin_unlock_bh(&reg_pending_beacons_lock);
1930
1931 schedule_work(&reg_work);
1932
1933 return 0;
1934}
1935
a3d2eaf0 1936static void print_rd_rules(const struct ieee80211_regdomain *rd)
b2e1b302
LR
1937{
1938 unsigned int i;
a3d2eaf0
JB
1939 const struct ieee80211_reg_rule *reg_rule = NULL;
1940 const struct ieee80211_freq_range *freq_range = NULL;
1941 const struct ieee80211_power_rule *power_rule = NULL;
b2e1b302
LR
1942
1943 printk(KERN_INFO "\t(start_freq - end_freq @ bandwidth), "
1944 "(max_antenna_gain, max_eirp)\n");
1945
1946 for (i = 0; i < rd->n_reg_rules; i++) {
1947 reg_rule = &rd->reg_rules[i];
1948 freq_range = &reg_rule->freq_range;
1949 power_rule = &reg_rule->power_rule;
1950
fb1fc7ad
LR
1951 /*
1952 * There may not be documentation for max antenna gain
1953 * in certain regions
1954 */
b2e1b302
LR
1955 if (power_rule->max_antenna_gain)
1956 printk(KERN_INFO "\t(%d KHz - %d KHz @ %d KHz), "
1957 "(%d mBi, %d mBm)\n",
1958 freq_range->start_freq_khz,
1959 freq_range->end_freq_khz,
1960 freq_range->max_bandwidth_khz,
1961 power_rule->max_antenna_gain,
1962 power_rule->max_eirp);
1963 else
1964 printk(KERN_INFO "\t(%d KHz - %d KHz @ %d KHz), "
1965 "(N/A, %d mBm)\n",
1966 freq_range->start_freq_khz,
1967 freq_range->end_freq_khz,
1968 freq_range->max_bandwidth_khz,
1969 power_rule->max_eirp);
1970 }
1971}
1972
a3d2eaf0 1973static void print_regdomain(const struct ieee80211_regdomain *rd)
b2e1b302
LR
1974{
1975
3f2355cb 1976 if (is_intersected_alpha2(rd->alpha2)) {
3f2355cb 1977
7db90f4a
LR
1978 if (last_request->initiator ==
1979 NL80211_REGDOM_SET_BY_COUNTRY_IE) {
806a9e39
LR
1980 struct cfg80211_registered_device *drv;
1981 drv = cfg80211_drv_by_wiphy_idx(
1982 last_request->wiphy_idx);
1983 if (drv) {
3f2355cb
LR
1984 printk(KERN_INFO "cfg80211: Current regulatory "
1985 "domain updated by AP to: %c%c\n",
1986 drv->country_ie_alpha2[0],
1987 drv->country_ie_alpha2[1]);
1988 } else
1989 printk(KERN_INFO "cfg80211: Current regulatory "
1990 "domain intersected: \n");
1991 } else
1992 printk(KERN_INFO "cfg80211: Current regulatory "
039498c6 1993 "domain intersected: \n");
3f2355cb 1994 } else if (is_world_regdom(rd->alpha2))
b2e1b302
LR
1995 printk(KERN_INFO "cfg80211: World regulatory "
1996 "domain updated:\n");
1997 else {
1998 if (is_unknown_alpha2(rd->alpha2))
1999 printk(KERN_INFO "cfg80211: Regulatory domain "
2000 "changed to driver built-in settings "
2001 "(unknown country)\n");
2002 else
2003 printk(KERN_INFO "cfg80211: Regulatory domain "
2004 "changed to country: %c%c\n",
2005 rd->alpha2[0], rd->alpha2[1]);
2006 }
2007 print_rd_rules(rd);
2008}
2009
2df78167 2010static void print_regdomain_info(const struct ieee80211_regdomain *rd)
b2e1b302
LR
2011{
2012 printk(KERN_INFO "cfg80211: Regulatory domain: %c%c\n",
2013 rd->alpha2[0], rd->alpha2[1]);
2014 print_rd_rules(rd);
2015}
2016
3f2355cb
LR
2017#ifdef CONFIG_CFG80211_REG_DEBUG
2018static void reg_country_ie_process_debug(
2019 const struct ieee80211_regdomain *rd,
2020 const struct ieee80211_regdomain *country_ie_regdomain,
2021 const struct ieee80211_regdomain *intersected_rd)
2022{
2023 printk(KERN_DEBUG "cfg80211: Received country IE:\n");
2024 print_regdomain_info(country_ie_regdomain);
2025 printk(KERN_DEBUG "cfg80211: CRDA thinks this should applied:\n");
2026 print_regdomain_info(rd);
2027 if (intersected_rd) {
2028 printk(KERN_DEBUG "cfg80211: We intersect both of these "
2029 "and get:\n");
667ecd01 2030 print_regdomain_info(intersected_rd);
3f2355cb
LR
2031 return;
2032 }
2033 printk(KERN_DEBUG "cfg80211: Intersection between both failed\n");
2034}
2035#else
2036static inline void reg_country_ie_process_debug(
2037 const struct ieee80211_regdomain *rd,
2038 const struct ieee80211_regdomain *country_ie_regdomain,
2039 const struct ieee80211_regdomain *intersected_rd)
2040{
2041}
2042#endif
2043
d2372b31 2044/* Takes ownership of rd only if it doesn't fail */
a3d2eaf0 2045static int __set_regdom(const struct ieee80211_regdomain *rd)
b2e1b302 2046{
9c96477d 2047 const struct ieee80211_regdomain *intersected_rd = NULL;
3f2355cb 2048 struct cfg80211_registered_device *drv = NULL;
806a9e39 2049 struct wiphy *request_wiphy;
b2e1b302
LR
2050 /* Some basic sanity checks first */
2051
b2e1b302 2052 if (is_world_regdom(rd->alpha2)) {
f6037d09 2053 if (WARN_ON(!reg_is_valid_request(rd->alpha2)))
b2e1b302
LR
2054 return -EINVAL;
2055 update_world_regdomain(rd);
2056 return 0;
2057 }
b2e1b302
LR
2058
2059 if (!is_alpha2_set(rd->alpha2) && !is_an_alpha2(rd->alpha2) &&
2060 !is_unknown_alpha2(rd->alpha2))
2061 return -EINVAL;
2062
f6037d09 2063 if (!last_request)
b2e1b302
LR
2064 return -EINVAL;
2065
fb1fc7ad
LR
2066 /*
2067 * Lets only bother proceeding on the same alpha2 if the current
3f2355cb 2068 * rd is non static (it means CRDA was present and was used last)
fb1fc7ad
LR
2069 * and the pending request came in from a country IE
2070 */
7db90f4a 2071 if (last_request->initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) {
fb1fc7ad
LR
2072 /*
2073 * If someone else asked us to change the rd lets only bother
2074 * checking if the alpha2 changes if CRDA was already called
2075 */
3f2355cb 2076 if (!is_old_static_regdom(cfg80211_regdomain) &&
69b1572b 2077 !regdom_changes(rd->alpha2))
3f2355cb
LR
2078 return -EINVAL;
2079 }
2080
fb1fc7ad
LR
2081 /*
2082 * Now lets set the regulatory domain, update all driver channels
b2e1b302
LR
2083 * and finally inform them of what we have done, in case they want
2084 * to review or adjust their own settings based on their own
fb1fc7ad
LR
2085 * internal EEPROM data
2086 */
b2e1b302 2087
f6037d09 2088 if (WARN_ON(!reg_is_valid_request(rd->alpha2)))
b2e1b302
LR
2089 return -EINVAL;
2090
8375af3b
LR
2091 if (!is_valid_rd(rd)) {
2092 printk(KERN_ERR "cfg80211: Invalid "
2093 "regulatory domain detected:\n");
2094 print_regdomain_info(rd);
2095 return -EINVAL;
b2e1b302
LR
2096 }
2097
806a9e39
LR
2098 request_wiphy = wiphy_idx_to_wiphy(last_request->wiphy_idx);
2099
b8295acd 2100 if (!last_request->intersect) {
3e0c3ff3
LR
2101 int r;
2102
7db90f4a 2103 if (last_request->initiator != NL80211_REGDOM_SET_BY_DRIVER) {
3e0c3ff3
LR
2104 reset_regdomains();
2105 cfg80211_regdomain = rd;
2106 return 0;
2107 }
2108
fb1fc7ad
LR
2109 /*
2110 * For a driver hint, lets copy the regulatory domain the
2111 * driver wanted to the wiphy to deal with conflicts
2112 */
3e0c3ff3 2113
806a9e39 2114 BUG_ON(request_wiphy->regd);
3e0c3ff3 2115
806a9e39 2116 r = reg_copy_regd(&request_wiphy->regd, rd);
3e0c3ff3
LR
2117 if (r)
2118 return r;
2119
b8295acd
LR
2120 reset_regdomains();
2121 cfg80211_regdomain = rd;
2122 return 0;
2123 }
2124
2125 /* Intersection requires a bit more work */
2126
7db90f4a 2127 if (last_request->initiator != NL80211_REGDOM_SET_BY_COUNTRY_IE) {
b8295acd 2128
9c96477d
LR
2129 intersected_rd = regdom_intersect(rd, cfg80211_regdomain);
2130 if (!intersected_rd)
2131 return -EINVAL;
b8295acd 2132
fb1fc7ad
LR
2133 /*
2134 * We can trash what CRDA provided now.
3e0c3ff3 2135 * However if a driver requested this specific regulatory
fb1fc7ad
LR
2136 * domain we keep it for its private use
2137 */
7db90f4a 2138 if (last_request->initiator == NL80211_REGDOM_SET_BY_DRIVER)
806a9e39 2139 request_wiphy->regd = rd;
3e0c3ff3
LR
2140 else
2141 kfree(rd);
2142
b8295acd
LR
2143 rd = NULL;
2144
2145 reset_regdomains();
2146 cfg80211_regdomain = intersected_rd;
2147
2148 return 0;
9c96477d
LR
2149 }
2150
3f2355cb
LR
2151 /*
2152 * Country IE requests are handled a bit differently, we intersect
2153 * the country IE rd with what CRDA believes that country should have
2154 */
2155
2156 BUG_ON(!country_ie_regdomain);
86f04680 2157 BUG_ON(rd == country_ie_regdomain);
3f2355cb 2158
86f04680
LR
2159 /*
2160 * Intersect what CRDA returned and our what we
2161 * had built from the Country IE received
2162 */
3f2355cb 2163
86f04680 2164 intersected_rd = regdom_intersect(rd, country_ie_regdomain);
3f2355cb 2165
86f04680
LR
2166 reg_country_ie_process_debug(rd,
2167 country_ie_regdomain,
2168 intersected_rd);
3f2355cb 2169
86f04680
LR
2170 kfree(country_ie_regdomain);
2171 country_ie_regdomain = NULL;
3f2355cb
LR
2172
2173 if (!intersected_rd)
2174 return -EINVAL;
2175
806a9e39 2176 drv = wiphy_to_dev(request_wiphy);
3f2355cb
LR
2177
2178 drv->country_ie_alpha2[0] = rd->alpha2[0];
2179 drv->country_ie_alpha2[1] = rd->alpha2[1];
2180 drv->env = last_request->country_ie_env;
2181
2182 BUG_ON(intersected_rd == rd);
2183
2184 kfree(rd);
2185 rd = NULL;
2186
b8295acd 2187 reset_regdomains();
3f2355cb 2188 cfg80211_regdomain = intersected_rd;
b2e1b302
LR
2189
2190 return 0;
2191}
2192
2193
fb1fc7ad
LR
2194/*
2195 * Use this call to set the current regulatory domain. Conflicts with
b2e1b302 2196 * multiple drivers can be ironed out later. Caller must've already
fb1fc7ad
LR
2197 * kmalloc'd the rd structure. Caller must hold cfg80211_mutex
2198 */
a3d2eaf0 2199int set_regdom(const struct ieee80211_regdomain *rd)
b2e1b302 2200{
b2e1b302
LR
2201 int r;
2202
761cf7ec
LR
2203 assert_cfg80211_lock();
2204
b2e1b302
LR
2205 /* Note that this doesn't update the wiphys, this is done below */
2206 r = __set_regdom(rd);
d2372b31
JB
2207 if (r) {
2208 kfree(rd);
b2e1b302 2209 return r;
d2372b31 2210 }
b2e1b302 2211
b2e1b302 2212 /* This would make this whole thing pointless */
a01ddafd
LR
2213 if (!last_request->intersect)
2214 BUG_ON(rd != cfg80211_regdomain);
b2e1b302
LR
2215
2216 /* update all wiphys now with the new established regulatory domain */
f6037d09 2217 update_all_wiphy_regulatory(last_request->initiator);
b2e1b302 2218
a01ddafd 2219 print_regdomain(cfg80211_regdomain);
b2e1b302 2220
73d54c9e
LR
2221 nl80211_send_reg_change_event(last_request);
2222
b2e1b302
LR
2223 return r;
2224}
2225
a1794390 2226/* Caller must hold cfg80211_mutex */
3f2355cb
LR
2227void reg_device_remove(struct wiphy *wiphy)
2228{
0ad8acaf 2229 struct wiphy *request_wiphy = NULL;
806a9e39 2230
761cf7ec
LR
2231 assert_cfg80211_lock();
2232
0ef9ccdd
CW
2233 kfree(wiphy->regd);
2234
0ad8acaf
LR
2235 if (last_request)
2236 request_wiphy = wiphy_idx_to_wiphy(last_request->wiphy_idx);
806a9e39 2237
0ef9ccdd 2238 if (!request_wiphy || request_wiphy != wiphy)
3f2355cb 2239 return;
0ef9ccdd 2240
806a9e39 2241 last_request->wiphy_idx = WIPHY_IDX_STALE;
3f2355cb
LR
2242 last_request->country_ie_env = ENVIRON_ANY;
2243}
2244
b2e1b302
LR
2245int regulatory_init(void)
2246{
bcf4f99b 2247 int err = 0;
734366de 2248
b2e1b302
LR
2249 reg_pdev = platform_device_register_simple("regulatory", 0, NULL, 0);
2250 if (IS_ERR(reg_pdev))
2251 return PTR_ERR(reg_pdev);
734366de 2252
fe33eb39 2253 spin_lock_init(&reg_requests_lock);
e38f8a7a 2254 spin_lock_init(&reg_pending_beacons_lock);
fe33eb39 2255
734366de 2256#ifdef CONFIG_WIRELESS_OLD_REGULATORY
a3d2eaf0 2257 cfg80211_regdomain = static_regdom(ieee80211_regdom);
734366de 2258
942b25cf 2259 printk(KERN_INFO "cfg80211: Using static regulatory domain info\n");
734366de 2260 print_regdomain_info(cfg80211_regdomain);
fb1fc7ad
LR
2261 /*
2262 * The old code still requests for a new regdomain and if
734366de 2263 * you have CRDA you get it updated, otherwise you get
2e097dc6
LR
2264 * stuck with the static values. Since "EU" is not a valid
2265 * ISO / IEC 3166 alpha2 code we can't expect userpace to
2266 * give us a regulatory domain for it. We need last_request
2267 * iniitalized though so lets just send a request which we
2268 * know will be ignored... this crap will be removed once
2269 * OLD_REG dies.
fb1fc7ad 2270 */
2e097dc6 2271 err = regulatory_hint_core(ieee80211_regdom);
734366de 2272#else
a3d2eaf0 2273 cfg80211_regdomain = cfg80211_world_regdom;
734366de 2274
6ee7d330 2275 err = regulatory_hint_core(ieee80211_regdom);
bcf4f99b 2276#endif
ba25c141 2277 if (err) {
bcf4f99b
LR
2278 if (err == -ENOMEM)
2279 return err;
2280 /*
2281 * N.B. kobject_uevent_env() can fail mainly for when we're out
2282 * memory which is handled and propagated appropriately above
2283 * but it can also fail during a netlink_broadcast() or during
2284 * early boot for call_usermodehelper(). For now treat these
2285 * errors as non-fatal.
2286 */
2287 printk(KERN_ERR "cfg80211: kobject_uevent_env() was unable "
2288 "to call CRDA during init");
2289#ifdef CONFIG_CFG80211_REG_DEBUG
2290 /* We want to find out exactly why when debugging */
2291 WARN_ON(err);
734366de 2292#endif
bcf4f99b 2293 }
734366de 2294
b2e1b302
LR
2295 return 0;
2296}
2297
2298void regulatory_exit(void)
2299{
fe33eb39 2300 struct regulatory_request *reg_request, *tmp;
e38f8a7a 2301 struct reg_beacon *reg_beacon, *btmp;
fe33eb39
LR
2302
2303 cancel_work_sync(&reg_work);
2304
a1794390 2305 mutex_lock(&cfg80211_mutex);
734366de 2306
b2e1b302 2307 reset_regdomains();
734366de 2308
3f2355cb
LR
2309 kfree(country_ie_regdomain);
2310 country_ie_regdomain = NULL;
2311
f6037d09
JB
2312 kfree(last_request);
2313
b2e1b302 2314 platform_device_unregister(reg_pdev);
734366de 2315
e38f8a7a
LR
2316 spin_lock_bh(&reg_pending_beacons_lock);
2317 if (!list_empty(&reg_pending_beacons)) {
2318 list_for_each_entry_safe(reg_beacon, btmp,
2319 &reg_pending_beacons, list) {
2320 list_del(&reg_beacon->list);
2321 kfree(reg_beacon);
2322 }
2323 }
2324 spin_unlock_bh(&reg_pending_beacons_lock);
2325
2326 if (!list_empty(&reg_beacon_list)) {
2327 list_for_each_entry_safe(reg_beacon, btmp,
2328 &reg_beacon_list, list) {
2329 list_del(&reg_beacon->list);
2330 kfree(reg_beacon);
2331 }
2332 }
2333
fe33eb39
LR
2334 spin_lock(&reg_requests_lock);
2335 if (!list_empty(&reg_requests_list)) {
2336 list_for_each_entry_safe(reg_request, tmp,
2337 &reg_requests_list, list) {
2338 list_del(&reg_request->list);
2339 kfree(reg_request);
2340 }
2341 }
2342 spin_unlock(&reg_requests_lock);
2343
a1794390 2344 mutex_unlock(&cfg80211_mutex);
8318d78a 2345}