rndis_wlan: convert set/get txpower to cfg80211

Convert set/get txpower to cfg80211 and add stop netdev handler to turn off
radio for rfkill.

Signed-off-by: Jussi Kivilinna <jussi.kivilinna@mbnet.fi>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

1 files changed, 75 insertions, 73 deletions

diff --git a/drivers/net/wireless/rndis_wlan.c b/drivers/net/wireless/rndis_wlan.c
index edd4aad68be9..09c0702ae645 100644
--- a/drivers/net/wireless/rndis_wlan.c
+++ b/drivers/net/wireless/rndis_wlan.c
@@ -139,9 +139,15 @@ MODULE_PARM_DESC(workaround_interval,
 /* Assume that Broadcom 4320 (only chipset at time of writing known to be
  * based on wireless rndis) has default txpower of 13dBm.
  * This value is from Linksys WUSB54GSC User Guide, Appendix F: Specifications.
- *   13dBm == 19.9mW
+ *  100% : 20 mW ~ 13dBm
+ *   75% : 15 mW ~ 12dBm
+ *   50% : 10 mW ~ 10dBm
+ *   25% :  5 mW ~  7dBm
  */
-#define BCM4320_DEFAULT_TXPOWER 20
+#define BCM4320_DEFAULT_TXPOWER_DBM_100 13
+#define BCM4320_DEFAULT_TXPOWER_DBM_75  12
+#define BCM4320_DEFAULT_TXPOWER_DBM_50  10
+#define BCM4320_DEFAULT_TXPOWER_DBM_25  7
 
 
 /* codes for "status" field of completion messages */
@@ -430,15 +436,20 @@ static int rndis_scan(struct wiphy *wiphy, struct net_device *dev,
 
 static int rndis_set_wiphy_params(struct wiphy *wiphy, u32 changed);
 
+static int rndis_set_tx_power(struct wiphy *wiphy, enum tx_power_setting type,
+                                int dbm);
+static int rndis_get_tx_power(struct wiphy *wiphy, int *dbm);
+
 static struct cfg80211_ops rndis_config_ops = {
         .change_virtual_intf = rndis_change_virtual_intf,
         .scan = rndis_scan,
         .set_wiphy_params = rndis_set_wiphy_params,
+        .set_tx_power = rndis_set_tx_power,
+        .get_tx_power = rndis_get_tx_power,
 };
 
 static void *rndis_wiphy_privid = &rndis_wiphy_privid;
 
-static const int bcm4320_power_output[4] = { 25, 50, 75, 100 };
 
 static const unsigned char zero_bssid[ETH_ALEN] = {0,};
 static const unsigned char ffff_bssid[ETH_ALEN] = { 0xff, 0xff, 0xff,
@@ -451,10 +462,19 @@ static struct rndis_wlan_private *get_rndis_wlan_priv(struct usbnet *dev)
 }
 
 
-static u32 get_bcm4320_power(struct rndis_wlan_private *priv)
+static u32 get_bcm4320_power_dbm(struct rndis_wlan_private *priv)
 {
-        return BCM4320_DEFAULT_TXPOWER *
-                bcm4320_power_output[priv->param_power_output] / 100;
+        switch (priv->param_power_output) {
+        default:
+        case 3:
+                return BCM4320_DEFAULT_TXPOWER_DBM_100;
+        case 2:
+                return BCM4320_DEFAULT_TXPOWER_DBM_75;
+        case 1:
+                return BCM4320_DEFAULT_TXPOWER_DBM_50;
+        case 0:
+                return BCM4320_DEFAULT_TXPOWER_DBM_25;
+        }
 }
 
 
@@ -1301,6 +1321,42 @@ static int rndis_set_wiphy_params(struct wiphy *wiphy, u32 changed)
 }
 
 
+static int rndis_set_tx_power(struct wiphy *wiphy, enum tx_power_setting type,
+                                int dbm)
+{
+        struct rndis_wlan_private *priv = wiphy_priv(wiphy);
+        struct usbnet *usbdev = priv->usbdev;
+
+        devdbg(usbdev, "rndis_set_tx_power type:0x%x dbm:%i", type, dbm);
+
+        /* Device doesn't support changing txpower after initialization, only
+         * turn off/on radio. Support 'auto' mode and setting same dBm that is
+         * currently used.
+         */
+        if (type == TX_POWER_AUTOMATIC || dbm == get_bcm4320_power_dbm(priv)) {
+                if (!priv->radio_on)
+                        disassociate(usbdev, 1); /* turn on radio */
+
+                return 0;
+        }
+
+        return -ENOTSUPP;
+}
+
+
+static int rndis_get_tx_power(struct wiphy *wiphy, int *dbm)
+{
+        struct rndis_wlan_private *priv = wiphy_priv(wiphy);
+        struct usbnet *usbdev = priv->usbdev;
+
+        *dbm = get_bcm4320_power_dbm(priv);
+
+        devdbg(usbdev, "rndis_get_tx_power dbm:%i", *dbm);
+
+        return 0;
+}
+
+
 #define SCAN_DELAY_JIFFIES (HZ)
 static int rndis_scan(struct wiphy *wiphy, struct net_device *dev,
                         struct cfg80211_scan_request *request)
@@ -1864,71 +1920,6 @@ static int rndis_iw_get_freq(struct net_device *dev,
 }
 
 
-static int rndis_iw_get_txpower(struct net_device *dev,
-    struct iw_request_info *info, union iwreq_data *wrqu, char *extra)
-{
-        struct usbnet *usbdev = netdev_priv(dev);
-        struct rndis_wlan_private *priv = get_rndis_wlan_priv(usbdev);
-        __le32 tx_power;
-
-        if (priv->radio_on) {
-                /* fake since changing tx_power (by userlevel) not supported */
-                tx_power = cpu_to_le32(get_bcm4320_power(priv));
-
-                wrqu->txpower.flags = IW_TXPOW_MWATT;
-                wrqu->txpower.value = le32_to_cpu(tx_power);
-                wrqu->txpower.disabled = 0;
-        } else {
-                wrqu->txpower.flags = IW_TXPOW_MWATT;
-                wrqu->txpower.value = 0;
-                wrqu->txpower.disabled = 1;
-        }
-
-        devdbg(usbdev, "SIOCGIWTXPOW: %d", wrqu->txpower.value);
-
-        return 0;
-}
-
-
-static int rndis_iw_set_txpower(struct net_device *dev,
-    struct iw_request_info *info, union iwreq_data *wrqu, char *extra)
-{
-        struct usbnet *usbdev = netdev_priv(dev);
-        struct rndis_wlan_private *priv = get_rndis_wlan_priv(usbdev);
-        __le32 tx_power = 0;
-
-        if (!wrqu->txpower.disabled) {
-                if (wrqu->txpower.flags == IW_TXPOW_MWATT)
-                        tx_power = cpu_to_le32(wrqu->txpower.value);
-                else { /* wrqu->txpower.flags == IW_TXPOW_DBM */
-                        if (wrqu->txpower.value > 20)
-                                tx_power = cpu_to_le32(128);
-                        else if (wrqu->txpower.value < -43)
-                                tx_power = cpu_to_le32(127);
-                        else {
-                                signed char tmp;
-                                tmp = wrqu->txpower.value;
-                                tmp = -12 - tmp;
-                                tmp <<= 2;
-                                tx_power = cpu_to_le32((unsigned char)tmp);
-                        }
-                }
-        }
-
-        devdbg(usbdev, "SIOCSIWTXPOW: %d", le32_to_cpu(tx_power));
-
-        if (le32_to_cpu(tx_power) != 0) {
-                /* txpower unsupported, just turn radio on */
-                if (!priv->radio_on)
-                        return disassociate(usbdev, 1);
-                return 0; /* all ready on */
-        }
-
-        /* tx_power == 0, turn off radio */
-        return disassociate(usbdev, 0);
-}
-
-
 static int rndis_iw_get_rate(struct net_device *dev,
     struct iw_request_info *info, union iwreq_data *wrqu, char *extra)
 {
@@ -2008,8 +1999,8 @@ static const iw_handler rndis_iw_handler[] =
         IW_IOCTL(SIOCGIWRTS)       = (iw_handler) cfg80211_wext_giwrts,
         IW_IOCTL(SIOCSIWFRAG)      = (iw_handler) cfg80211_wext_siwfrag,
         IW_IOCTL(SIOCGIWFRAG)      = (iw_handler) cfg80211_wext_giwfrag,
-        IW_IOCTL(SIOCSIWTXPOW)     = rndis_iw_set_txpower,
-        IW_IOCTL(SIOCGIWTXPOW)     = rndis_iw_get_txpower,
+        IW_IOCTL(SIOCSIWTXPOW)     = (iw_handler) cfg80211_wext_siwtxpower,
+        IW_IOCTL(SIOCGIWTXPOW)     = (iw_handler) cfg80211_wext_giwtxpower,
         IW_IOCTL(SIOCSIWENCODE)    = rndis_iw_set_encode,
         IW_IOCTL(SIOCSIWENCODEEXT) = rndis_iw_set_encode_ext,
         IW_IOCTL(SIOCSIWAUTH)      = rndis_iw_set_auth,
@@ -2508,10 +2499,18 @@ static void rndis_wlan_unbind(struct usbnet *usbdev, struct usb_interface *intf)
 
 static int rndis_wlan_reset(struct usbnet *usbdev)
 {
+        devdbg(usbdev, "rndis_wlan_reset");
         return deauthenticate(usbdev);
 }
 
 
+static int rndis_wlan_stop(struct usbnet *usbdev)
+{
+        devdbg(usbdev, "rndis_wlan_stop");
+        return disassociate(usbdev, 0);
+}
+
+
 static const struct driver_info bcm4320b_info = {
         .description =  "Wireless RNDIS device, BCM4320b based",
         .flags =        FLAG_WLAN | FLAG_FRAMING_RN | FLAG_NO_SETINT,
@@ -2521,6 +2520,7 @@ static const struct driver_info	bcm4320b_info = {
         .rx_fixup =     rndis_rx_fixup,
         .tx_fixup =     rndis_tx_fixup,
         .reset =        rndis_wlan_reset,
+        .stop =         rndis_wlan_stop,
         .early_init =   bcm4320b_early_init,
         .link_change =  rndis_wlan_link_change,
 };
@@ -2534,6 +2534,7 @@ static const struct driver_info	bcm4320a_info = {
         .rx_fixup =     rndis_rx_fixup,
         .tx_fixup =     rndis_tx_fixup,
         .reset =        rndis_wlan_reset,
+        .stop =         rndis_wlan_stop,
         .early_init =   bcm4320a_early_init,
         .link_change =  rndis_wlan_link_change,
 };
@@ -2547,6 +2548,7 @@ static const struct driver_info rndis_wlan_info = {
         .rx_fixup =     rndis_rx_fixup,
         .tx_fixup =     rndis_tx_fixup,
         .reset =        rndis_wlan_reset,
+        .stop =         rndis_wlan_stop,
         .early_init =   bcm4320a_early_init,
         .link_change =  rndis_wlan_link_change,
 };