cc2520: add set transmit power setting support

This patch adds support for seeting tx power values for cc2520
and also for the combination of CC2520-CC2591.

Signed-off-by: Varka Bhadram <varkab@cdac.in>
Cc: Brad Campbell <bradjc5@gmail.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

1 files changed, 102 insertions, 0 deletions

diff --git a/drivers/net/ieee802154/cc2520.c b/drivers/net/ieee802154/cc2520.c
index 0d9353756598..36a4f312cc7c 100644
--- a/drivers/net/ieee802154/cc2520.c
+++ b/drivers/net/ieee802154/cc2520.c
@@ -629,6 +629,97 @@ cc2520_filter(struct ieee802154_hw *hw,
         return 0;
 }
 
+static inline int cc2520_set_tx_power(struct cc2520_private *priv, s32 mbm)
+{
+        u8 power;
+
+        switch (mbm) {
+        case 500:
+                power = 0xF7;
+                break;
+        case 300:
+                power = 0xF2;
+                break;
+        case 200:
+                power = 0xAB;
+                break;
+        case 100:
+                power = 0x13;
+                break;
+        case 0:
+                power = 0x32;
+                break;
+        case -200:
+                power = 0x81;
+                break;
+        case -400:
+                power = 0x88;
+                break;
+        case -700:
+                power = 0x2C;
+                break;
+        case -1800:
+                power = 0x03;
+                break;
+        default:
+                return -EINVAL;
+        }
+
+        return cc2520_write_register(priv, CC2520_TXPOWER, power);
+}
+
+static inline int cc2520_cc2591_set_tx_power(struct cc2520_private *priv,
+                                             s32 mbm)
+{
+        u8 power;
+
+        switch (mbm) {
+        case 1700:
+                power = 0xF9;
+                break;
+        case 1600:
+                power = 0xF0;
+                break;
+        case 1400:
+                power = 0xA0;
+                break;
+        case 1100:
+                power = 0x2C;
+                break;
+        case -100:
+                power = 0x03;
+                break;
+        case -800:
+                power = 0x01;
+                break;
+        default:
+                return -EINVAL;
+        }
+
+        return cc2520_write_register(priv, CC2520_TXPOWER, power);
+}
+
+#define CC2520_MAX_TX_POWERS 0x8
+static const s32 cc2520_powers[CC2520_MAX_TX_POWERS + 1] = {
+        500, 300, 200, 100, 0, -200, -400, -700, -1800,
+};
+
+#define CC2520_CC2591_MAX_TX_POWERS 0x5
+static const s32 cc2520_cc2591_powers[CC2520_CC2591_MAX_TX_POWERS + 1] = {
+        1700, 1600, 1400, 1100, -100, -800,
+};
+
+static int
+cc2520_set_txpower(struct ieee802154_hw *hw, s32 mbm)
+{
+        struct cc2520_private *priv = hw->priv;
+
+        if (!priv->amplified)
+                return cc2520_set_tx_power(priv, mbm);
+
+        return cc2520_cc2591_set_tx_power(priv, mbm);
+}
+
 static const struct ieee802154_ops cc2520_ops = {
         .owner = THIS_MODULE,
         .start = cc2520_start,
@@ -637,6 +728,7 @@ static const struct ieee802154_ops cc2520_ops = {
         .ed = cc2520_ed,
         .set_channel = cc2520_set_channel,
         .set_hw_addr_filt = cc2520_filter,
+        .set_txpower = cc2520_set_txpower,
 };
 
 static int cc2520_register(struct cc2520_private *priv)
@@ -658,6 +750,16 @@ static int cc2520_register(struct cc2520_private *priv)
         priv->hw->flags = IEEE802154_HW_OMIT_CKSUM | IEEE802154_HW_AACK |
                           IEEE802154_HW_AFILT;
 
+        priv->hw->phy->flags = WPAN_PHY_FLAG_TXPOWER;
+
+        if (!priv->amplified) {
+                priv->hw->phy->supported.tx_powers = cc2520_powers;
+                priv->hw->phy->supported.tx_powers_size = ARRAY_SIZE(cc2520_powers);
+        } else {
+                priv->hw->phy->supported.tx_powers = cc2520_cc2591_powers;
+                priv->hw->phy->supported.tx_powers_size = ARRAY_SIZE(cc2520_cc2591_powers);
+        }
+
         dev_vdbg(&priv->spi->dev, "registered cc2520\n");
         ret = ieee802154_register_hw(priv->hw);
         if (ret)