mirror of
https://github.com/torvalds/linux
synced 2024-11-05 18:23:50 +00:00
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>
This commit is contained in:
parent
1a1bc59c5f
commit
e10c1674e3
1 changed files with 102 additions and 0 deletions
|
@ -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)
|
||||
|
|
Loading…
Reference in a new issue