drivers/net/wireless/libertas/cfg.c

   1 /*
   2  * Implement cfg80211 ("iw") support.
   3  *
   4  * Copyright (C) 2009 M&N Solutions GmbH, 61191 Rosbach, Germany
   5  * Holger Schurig <hs4233@mail.mn-solutions.de>
   6  *
   7  */
   8
   9 #include <linux/slab.h>
  10 #include <net/cfg80211.h>
  11
  12 #include "cfg.h"
  13 #include "cmd.h"
  14
  15
  16 #define CHAN2G(_channel, _freq, _flags) {        \
  17         .band             = IEEE80211_BAND_2GHZ, \
  18         .center_freq      = (_freq),             \
  19         .hw_value         = (_channel),          \
  20         .flags            = (_flags),            \
  21         .max_antenna_gain = 0,                   \
  22         .max_power        = 30,                  \
  23 }
  24
  25 static struct ieee80211_channel lbs_2ghz_channels[] = {
  26         CHAN2G(1,  2412, 0),
  27         CHAN2G(2,  2417, 0),
  28         CHAN2G(3,  2422, 0),
  29         CHAN2G(4,  2427, 0),
  30         CHAN2G(5,  2432, 0),
  31         CHAN2G(6,  2437, 0),
  32         CHAN2G(7,  2442, 0),
  33         CHAN2G(8,  2447, 0),
  34         CHAN2G(9,  2452, 0),
  35         CHAN2G(10, 2457, 0),
  36         CHAN2G(11, 2462, 0),
  37         CHAN2G(12, 2467, 0),
  38         CHAN2G(13, 2472, 0),
  39         CHAN2G(14, 2484, 0),
  40 };
  41
  42 #define RATETAB_ENT(_rate, _rateid, _flags) { \
  43         .bitrate  = (_rate),                  \
  44         .hw_value = (_rateid),                \
  45         .flags    = (_flags),                 \
  46 }
  47
  48
  49 static struct ieee80211_rate lbs_rates[] = {
  50         RATETAB_ENT(10,  0x1,   0),
  51         RATETAB_ENT(20,  0x2,   0),
  52         RATETAB_ENT(55,  0x4,   0),
  53         RATETAB_ENT(110, 0x8,   0),
  54         RATETAB_ENT(60,  0x10,  0),
  55         RATETAB_ENT(90,  0x20,  0),
  56         RATETAB_ENT(120, 0x40,  0),
  57         RATETAB_ENT(180, 0x80,  0),
  58         RATETAB_ENT(240, 0x100, 0),
  59         RATETAB_ENT(360, 0x200, 0),
  60         RATETAB_ENT(480, 0x400, 0),
  61         RATETAB_ENT(540, 0x800, 0),
  62 };
  63
  64 static struct ieee80211_supported_band lbs_band_2ghz = {
  65         .channels = lbs_2ghz_channels,
  66         .n_channels = ARRAY_SIZE(lbs_2ghz_channels),
  67         .bitrates = lbs_rates,
  68         .n_bitrates = ARRAY_SIZE(lbs_rates),
  69 };
  70
  71
  72 static const u32 cipher_suites[] = {
  73         WLAN_CIPHER_SUITE_WEP40,
  74         WLAN_CIPHER_SUITE_WEP104,
  75         WLAN_CIPHER_SUITE_TKIP,
  76         WLAN_CIPHER_SUITE_CCMP,
  77 };
  78
  79
  80
  81 static int lbs_cfg_set_channel(struct wiphy *wiphy,
  82         struct net_device *netdev,
  83         struct ieee80211_channel *chan,
  84         enum nl80211_channel_type channel_type)
  85 {
  86         struct lbs_private *priv = wiphy_priv(wiphy);
  87         int ret = -ENOTSUPP;
  88
  89         lbs_deb_enter_args(LBS_DEB_CFG80211, "freq %d, type %d", chan->center_freq, channel_type);
  90
  91         if (channel_type != NL80211_CHAN_NO_HT)
  92                 goto out;
  93
  94         ret = lbs_set_channel(priv, chan->hw_value);
  95
  96  out:
  97         lbs_deb_leave_args(LBS_DEB_CFG80211, "ret %d", ret);
  98         return ret;
  99 }
 100
 101
 102
 103
 104 static struct cfg80211_ops lbs_cfg80211_ops = {
 105         .set_channel = lbs_cfg_set_channel,
 106 };
 107
 108
 109 /*
 110  * At this time lbs_private *priv doesn't even exist, so we just allocate
 111  * memory and don't initialize the wiphy further. This is postponed until we
 112  * can talk to the firmware and happens at registration time in
 113  * lbs_cfg_wiphy_register().
 114  */
 115 struct wireless_dev *lbs_cfg_alloc(struct device *dev)
 116 {
 117         int ret = 0;
 118         struct wireless_dev *wdev;
 119
 120         lbs_deb_enter(LBS_DEB_CFG80211);
 121
 122         wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL);
 123         if (!wdev) {
 124                 dev_err(dev, "cannot allocate wireless device\n");
 125                 return ERR_PTR(-ENOMEM);
 126         }
 127
 128         wdev->wiphy = wiphy_new(&lbs_cfg80211_ops, sizeof(struct lbs_private));
 129         if (!wdev->wiphy) {
 130                 dev_err(dev, "cannot allocate wiphy\n");
 131                 ret = -ENOMEM;
 132                 goto err_wiphy_new;
 133         }
 134
 135         lbs_deb_leave(LBS_DEB_CFG80211);
 136         return wdev;
 137
 138  err_wiphy_new:
 139         kfree(wdev);
 140         lbs_deb_leave_args(LBS_DEB_CFG80211, "ret %d", ret);
 141         return ERR_PTR(ret);
 142 }
 143
 144
 145 /*
 146  * This function get's called after lbs_setup_firmware() determined the
 147  * firmware capabities. So we can setup the wiphy according to our
 148  * hardware/firmware.
 149  */
 150 int lbs_cfg_register(struct lbs_private *priv)
 151 {
 152         struct wireless_dev *wdev = priv->wdev;
 153         int ret;
 154
 155         lbs_deb_enter(LBS_DEB_CFG80211);
 156
 157         wdev->wiphy->max_scan_ssids = 1;
 158         wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
 159
 160         /* TODO: BIT(NL80211_IFTYPE_ADHOC); */
 161         wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
 162
 163         /* TODO: honor priv->regioncode */
 164         wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &lbs_band_2ghz;
 165
 166         /*
 167          * We could check priv->fwcapinfo && FW_CAPINFO_WPA, but I have
 168          * never seen a firmware without WPA
 169          */
 170         wdev->wiphy->cipher_suites = cipher_suites;
 171         wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
 172
 173         ret = wiphy_register(wdev->wiphy);
 174         if (ret < 0)
 175                 lbs_pr_err("cannot register wiphy device\n");
 176
 177         priv->wiphy_registered = true;
 178
 179         ret = register_netdev(priv->dev);
 180         if (ret)
 181                 lbs_pr_err("cannot register network device\n");
 182
 183         lbs_deb_leave_args(LBS_DEB_CFG80211, "ret %d", ret);
 184         return ret;
 185 }
 186
 187
 188 void lbs_cfg_free(struct lbs_private *priv)
 189 {
 190         struct wireless_dev *wdev = priv->wdev;
 191
 192         lbs_deb_enter(LBS_DEB_CFG80211);
 193
 194         if (!wdev)
 195                 return;
 196
 197         if (priv->wiphy_registered)
 198                 wiphy_unregister(wdev->wiphy);
 199
 200         if (wdev->wiphy)
 201                 wiphy_free(wdev->wiphy);
 202
 203         kfree(wdev);
 204 }