1 files changed, 44 insertions, 0 deletions

diff --git a/net/mac802154/mib.c b/net/mac802154/mib.c
index d74503b4302f..380829d84600 100644
--- a/net/mac802154/mib.c
+++ b/net/mac802154/mib.c
@@ -28,6 +28,11 @@
 
 #include "mac802154.h"
 
+struct phy_chan_notify_work {
+        struct work_struct work;
+        struct net_device *dev;
+};
+
 struct hw_addr_filt_notify_work {
         struct work_struct work;
         struct net_device *dev;
@@ -139,3 +144,42 @@ void mac802154_dev_set_pan_id(struct net_device *dev, u16 val)
                 set_hw_addr_filt(dev, IEEE802515_AFILT_PANID_CHANGED);
         }
 }
+
+static void phy_chan_notify(struct work_struct *work)
+{
+        struct phy_chan_notify_work *nw = container_of(work,
+                                          struct phy_chan_notify_work, work);
+        struct mac802154_priv *hw = mac802154_slave_get_priv(nw->dev);
+        struct mac802154_sub_if_data *priv = netdev_priv(nw->dev);
+        int res;
+
+        res = hw->ops->set_channel(&hw->hw, priv->page, priv->chan);
+        if (res)
+                pr_debug("set_channel failed\n");
+
+        kfree(nw);
+}
+
+void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
+{
+        struct mac802154_sub_if_data *priv = netdev_priv(dev);
+        struct phy_chan_notify_work *work;
+
+        BUG_ON(dev->type != ARPHRD_IEEE802154);
+
+        spin_lock_bh(&priv->mib_lock);
+        priv->page = page;
+        priv->chan = chan;
+        spin_unlock_bh(&priv->mib_lock);
+
+        if (priv->hw->phy->current_channel != priv->chan ||
+            priv->hw->phy->current_page != priv->page) {
+                work = kzalloc(sizeof(*work), GFP_ATOMIC);
+                if (!work)
+                        return;
+
+                INIT_WORK(&work->work, phy_chan_notify);
+                work->dev = dev;
+                queue_work(priv->hw->dev_workqueue, &work->work);
+        }
+}