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