Commit 66b69d4d authored by alex.bluesman.smirnov@gmail.com's avatar alex.bluesman.smirnov@gmail.com Committed by David S. Miller
Browse files

mac802154: page and channel setter 



A new method to set page and channel values for a transceiver
was added to the MIB.

Signed-off-by: default avatarAlexander Smirnov <alex.bluesman.smirnov@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 48e44d50

net/mac802154/mac802154.h

+1 −0
Original line number Diff line number Diff line
@@ -112,5 +112,6 @@ void mac802154_dev_set_short_addr(struct net_device *dev, u16 val); 
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);

void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan);



#endif /* MAC802154_H */

net/mac802154/mib.c

+44 −0
Original line number Diff line number Diff line
@@ -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);

	}

}