5 files changed, 296 insertions, 1 deletions

diff --git a/net/wireless/Makefile b/net/wireless/Makefile
index 65710a42e5a7..b9f943c45f3b 100644
--- a/net/wireless/Makefile
+++ b/net/wireless/Makefile
@@ -1,5 +1,5 @@
 obj-$(CONFIG_WIRELESS_EXT) += wext.o
 obj-$(CONFIG_CFG80211) += cfg80211.o
 
-cfg80211-y += core.o sysfs.o radiotap.o
+cfg80211-y += core.o sysfs.o radiotap.o util.o reg.o
 cfg80211-$(CONFIG_NL80211) += nl80211.o
diff --git a/net/wireless/core.c b/net/wireless/core.c
index cfc5fc5f9e75..80afacdae46c 100644
--- a/net/wireless/core.c
+++ b/net/wireless/core.c
@@ -232,6 +232,47 @@ int wiphy_register(struct wiphy *wiphy)
 {
         struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
         int res;
+        enum ieee80211_band band;
+        struct ieee80211_supported_band *sband;
+        bool have_band = false;
+        int i;
+
+        /* sanity check supported bands/channels */
+        for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
+                sband = wiphy->bands[band];
+                if (!sband)
+                        continue;
+
+                sband->band = band;
+
+                if (!sband->n_channels || !sband->n_bitrates) {
+                        WARN_ON(1);
+                        return -EINVAL;
+                }
+
+                for (i = 0; i < sband->n_channels; i++) {
+                        sband->channels[i].orig_flags =
+                                sband->channels[i].flags;
+                        sband->channels[i].orig_mag =
+                                sband->channels[i].max_antenna_gain;
+                        sband->channels[i].orig_mpwr =
+                                sband->channels[i].max_power;
+                        sband->channels[i].band = band;
+                }
+
+                have_band = true;
+        }
+
+        if (!have_band) {
+                WARN_ON(1);
+                return -EINVAL;
+        }
+
+        /* check and set up bitrates */
+        ieee80211_set_bitrate_flags(wiphy);
+
+        /* set up regulatory info */
+        wiphy_update_regulatory(wiphy);
 
         mutex_lock(&cfg80211_drv_mutex);
 
diff --git a/net/wireless/core.h b/net/wireless/core.h
index eb0f846b40df..7a02c356d63d 100644
--- a/net/wireless/core.h
+++ b/net/wireless/core.h
@@ -78,4 +78,7 @@ extern void cfg80211_dev_free(struct cfg80211_registered_device *drv);
 extern int cfg80211_dev_rename(struct cfg80211_registered_device *drv,
                                char *newname);
 
+void ieee80211_set_bitrate_flags(struct wiphy *wiphy);
+void wiphy_update_regulatory(struct wiphy *wiphy);
+
 #endif /* __NET_WIRELESS_CORE_H */
diff --git a/net/wireless/reg.c b/net/wireless/reg.c
new file mode 100644
index 000000000000..2b63c96dcf19
--- /dev/null
+++ b/net/wireless/reg.c
@@ -0,0 +1,153 @@
+/*
+ * Copyright 2002-2005, Instant802 Networks, Inc.
+ * Copyright 2005-2006, Devicescape Software, Inc.
+ * Copyright 2007       Johannes Berg <johannes@sipsolutions.net>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+/*
+ * This regulatory domain control implementation is highly incomplete, it
+ * only exists for the purpose of not regressing mac80211.
+ *
+ * For now, drivers can restrict the set of allowed channels by either
+ * not registering those channels or setting the IEEE80211_CHAN_DISABLED
+ * flag; that flag will only be *set* by this code, never *cleared.
+ *
+ * The usual implementation is for a driver to read a device EEPROM to
+ * determine which regulatory domain it should be operating under, then
+ * looking up the allowable channels in a driver-local table and finally
+ * registering those channels in the wiphy structure.
+ *
+ * Alternatively, drivers that trust the regulatory domain control here
+ * will register a complete set of capabilities and the control code
+ * will restrict the set by setting the IEEE80211_CHAN_* flags.
+ */
+#include <linux/kernel.h>
+#include <net/wireless.h>
+#include "core.h"
+
+static char *ieee80211_regdom = "US";
+module_param(ieee80211_regdom, charp, 0444);
+MODULE_PARM_DESC(ieee80211_regdom, "IEEE 802.11 regulatory domain code");
+
+struct ieee80211_channel_range {
+        short start_freq;
+        short end_freq;
+        int max_power;
+        int max_antenna_gain;
+        u32 flags;
+};
+
+struct ieee80211_regdomain {
+        const char *code;
+        const struct ieee80211_channel_range *ranges;
+        int n_ranges;
+};
+
+#define RANGE_PWR(_start, _end, _pwr, _ag, _flags)      \
+        { _start, _end, _pwr, _ag, _flags }
+
+
+/*
+ * Ideally, in the future, these definitions will be loaded from a
+ * userspace table via some daemon.
+ */
+static const struct ieee80211_channel_range ieee80211_US_channels[] = {
+        /* IEEE 802.11b/g, channels 1..11 */
+        RANGE_PWR(2412, 2462, 27, 6, 0),
+        /* IEEE 802.11a, channels 52..64 */
+        RANGE_PWR(5260, 5320, 23, 6, 0),
+        /* IEEE 802.11a, channels 149..165, outdoor */
+        RANGE_PWR(5745, 5825, 30, 6, 0),
+};
+
+static const struct ieee80211_channel_range ieee80211_JP_channels[] = {
+        /* IEEE 802.11b/g, channels 1..14 */
+        RANGE_PWR(2412, 2484, 20, 6, 0),
+        /* IEEE 802.11a, channels 34..48 */
+        RANGE_PWR(5170, 5240, 20, 6, IEEE80211_CHAN_PASSIVE_SCAN),
+        /* IEEE 802.11a, channels 52..64 */
+        RANGE_PWR(5260, 5320, 20, 6, IEEE80211_CHAN_NO_IBSS |
+                                     IEEE80211_CHAN_RADAR),
+};
+
+#define REGDOM(_code)                                                   \
+        {                                                               \
+                .code = __stringify(_code),                             \
+                .ranges = ieee80211_ ##_code## _channels,               \
+                .n_ranges = ARRAY_SIZE(ieee80211_ ##_code## _channels), \
+        }
+
+static const struct ieee80211_regdomain ieee80211_regdoms[] = {
+        REGDOM(US),
+        REGDOM(JP),
+};
+
+
+static const struct ieee80211_regdomain *get_regdom(void)
+{
+        static const struct ieee80211_channel_range
+        ieee80211_world_channels[] = {
+                /* IEEE 802.11b/g, channels 1..11 */
+                RANGE_PWR(2412, 2462, 27, 6, 0),
+        };
+        static const struct ieee80211_regdomain regdom_world = REGDOM(world);
+        int i;
+
+        for (i = 0; i < ARRAY_SIZE(ieee80211_regdoms); i++)
+                if (strcmp(ieee80211_regdom, ieee80211_regdoms[i].code) == 0)
+                        return &ieee80211_regdoms[i];
+
+        return &regdom_world;
+}
+
+
+static void handle_channel(struct ieee80211_channel *chan,
+                           const struct ieee80211_regdomain *rd)
+{
+        int i;
+        u32 flags = chan->orig_flags;
+        const struct ieee80211_channel_range *rg = NULL;
+
+        for (i = 0; i < rd->n_ranges; i++) {
+                if (rd->ranges[i].start_freq <= chan->center_freq &&
+                    chan->center_freq <= rd->ranges[i].end_freq) {
+                        rg = &rd->ranges[i];
+                        break;
+                }
+        }
+
+        if (!rg) {
+                /* not found */
+                flags |= IEEE80211_CHAN_DISABLED;
+                chan->flags = flags;
+                return;
+        }
+
+        chan->flags = flags;
+        chan->max_antenna_gain = min(chan->orig_mag,
+                                         rg->max_antenna_gain);
+        chan->max_power = min(chan->orig_mpwr, rg->max_power);
+}
+
+static void handle_band(struct ieee80211_supported_band *sband,
+                        const struct ieee80211_regdomain *rd)
+{
+        int i;
+
+        for (i = 0; i < sband->n_channels; i++)
+                handle_channel(&sband->channels[i], rd);
+}
+
+void wiphy_update_regulatory(struct wiphy *wiphy)
+{
+        enum ieee80211_band band;
+        const struct ieee80211_regdomain *rd = get_regdom();
+
+        for (band = 0; band < IEEE80211_NUM_BANDS; band++)
+                if (wiphy->bands[band])
+                        handle_band(wiphy->bands[band], rd);
+}
diff --git a/net/wireless/util.c b/net/wireless/util.c
new file mode 100644
index 000000000000..0dcccbf3eb57
--- /dev/null
+++ b/net/wireless/util.c
@@ -0,0 +1,98 @@
+/*
+ * Wireless utility functions
+ *
+ * Copyright 2007       Johannes Berg <johannes@sipsolutions.net>
+ */
+#include <net/wireless.h>
+#include <asm/bitops.h>
+#include "core.h"
+
+int ieee80211_channel_to_frequency(int chan)
+{
+        if (chan < 14)
+                return 2407 + chan * 5;
+
+        if (chan == 14)
+                return 2484;
+
+        /* FIXME: 802.11j 17.3.8.3.2 */
+        return (chan + 1000) * 5;
+}
+EXPORT_SYMBOL(ieee80211_channel_to_frequency);
+
+int ieee80211_frequency_to_channel(int freq)
+{
+        if (freq == 2484)
+                return 14;
+
+        if (freq < 2484)
+                return (freq - 2407) / 5;
+
+        /* FIXME: 802.11j 17.3.8.3.2 */
+        return freq/5 - 1000;
+}
+EXPORT_SYMBOL(ieee80211_frequency_to_channel);
+
+static void set_mandatory_flags_band(struct ieee80211_supported_band *sband,
+                                     enum ieee80211_band band)
+{
+        int i, want;
+
+        switch (band) {
+        case IEEE80211_BAND_5GHZ:
+                want = 3;
+                for (i = 0; i < sband->n_bitrates; i++) {
+                        if (sband->bitrates[i].bitrate == 60 ||
+                            sband->bitrates[i].bitrate == 120 ||
+                            sband->bitrates[i].bitrate == 240) {
+                                sband->bitrates[i].flags |=
+                                        IEEE80211_RATE_MANDATORY_A;
+                                want--;
+                        }
+                }
+                WARN_ON(want);
+                break;
+        case IEEE80211_BAND_2GHZ:
+                want = 7;
+                for (i = 0; i < sband->n_bitrates; i++) {
+                        if (sband->bitrates[i].bitrate == 10) {
+                                sband->bitrates[i].flags |=
+                                        IEEE80211_RATE_MANDATORY_B |
+                                        IEEE80211_RATE_MANDATORY_G;
+                                want--;
+                        }
+
+                        if (sband->bitrates[i].bitrate == 20 ||
+                            sband->bitrates[i].bitrate == 55 ||
+                            sband->bitrates[i].bitrate == 110 ||
+                            sband->bitrates[i].bitrate == 60 ||
+                            sband->bitrates[i].bitrate == 120 ||
+                            sband->bitrates[i].bitrate == 240) {
+                                sband->bitrates[i].flags |=
+                                        IEEE80211_RATE_MANDATORY_G;
+                                want--;
+                        }
+
+                        if (sband->bitrates[i].bitrate == 10 ||
+                            sband->bitrates[i].bitrate == 20 ||
+                            sband->bitrates[i].bitrate == 55 ||
+                            sband->bitrates[i].bitrate == 110)
+                                sband->bitrates[i].flags |=
+                                        IEEE80211_RATE_ERP_G;
+                }
+                WARN_ON(want != 0 && want != 6);
+                break;
+        case IEEE80211_NUM_BANDS:
+                WARN_ON(1);
+                break;
+        }
+}
+
+void ieee80211_set_bitrate_flags(struct wiphy *wiphy)
+{
+        enum ieee80211_band band;
+
+        for (band = 0; band < IEEE80211_NUM_BANDS; band++)
+                if (wiphy->bands[band])
+                        set_mandatory_flags_band(wiphy->bands[band], band);
+}