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