mac802154: set and get PAN id

Two methods intended to get and set the Private Area Network identifier
were added to the MIB implementation.

Signed-off-by: Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

2 files changed, 33 insertions, 0 deletions

diff --git a/net/mac802154/mac802154.h b/net/mac802154/mac802154.h
index c0efcf19a171..5cb7dc286cd1 100644
--- a/net/mac802154/mac802154.h
+++ b/net/mac802154/mac802154.h
@@ -109,5 +109,7 @@ netdev_tx_t mac802154_tx(struct mac802154_priv *priv, struct sk_buff *skb,
 
 /* MIB callbacks */
 void mac802154_dev_set_ieee_addr(struct net_device *dev);
+u16 mac802154_dev_get_pan_id(const struct net_device *dev);
+void mac802154_dev_set_pan_id(struct net_device *dev, u16 val);
 
 #endif /* MAC802154_H */
diff --git a/net/mac802154/mib.c b/net/mac802154/mib.c
index ab59821ec729..8e772ed30d1c 100644
--- a/net/mac802154/mib.c
+++ b/net/mac802154/mib.c
@@ -91,3 +91,34 @@ void mac802154_dev_set_ieee_addr(struct net_device *dev)
                 set_hw_addr_filt(dev, IEEE802515_AFILT_IEEEADDR_CHANGED);
         }
 }
+
+u16 mac802154_dev_get_pan_id(const struct net_device *dev)
+{
+        struct mac802154_sub_if_data *priv = netdev_priv(dev);
+        u16 ret;
+
+        BUG_ON(dev->type != ARPHRD_IEEE802154);
+
+        spin_lock_bh(&priv->mib_lock);
+        ret = priv->pan_id;
+        spin_unlock_bh(&priv->mib_lock);
+
+        return ret;
+}
+
+void mac802154_dev_set_pan_id(struct net_device *dev, u16 val)
+{
+        struct mac802154_sub_if_data *priv = netdev_priv(dev);
+
+        BUG_ON(dev->type != ARPHRD_IEEE802154);
+
+        spin_lock_bh(&priv->mib_lock);
+        priv->pan_id = val;
+        spin_unlock_bh(&priv->mib_lock);
+
+        if ((priv->hw->ops->set_hw_addr_filt) &&
+            (priv->hw->hw.hw_filt.pan_id != priv->pan_id)) {
+                priv->hw->hw.hw_filt.pan_id = priv->pan_id;
+                set_hw_addr_filt(dev, IEEE802515_AFILT_PANID_CHANGED);
+        }
+}