mib.c revision 66b69d4d7fe3026a4add368b72905b4d7878c320
1/* 2 * Copyright 2007-2012 Siemens AG 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of the GNU General Public License version 2 6 * as published by the Free Software Foundation. 7 * 8 * This program is distributed in the hope that it will be useful, 9 * but WITHOUT ANY WARRANTY; without even the implied warranty of 10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 11 * GNU General Public License for more details. 12 * 13 * You should have received a copy of the GNU General Public License along 14 * with this program; if not, write to the Free Software Foundation, Inc., 15 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. 16 * 17 * Written by: 18 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> 19 * Sergey Lapin <slapin@ossfans.org> 20 * Maxim Gorbachyov <maxim.gorbachev@siemens.com> 21 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> 22 */ 23 24#include <linux/if_arp.h> 25 26#include <net/mac802154.h> 27#include <net/wpan-phy.h> 28 29#include "mac802154.h" 30 31struct phy_chan_notify_work { 32 struct work_struct work; 33 struct net_device *dev; 34}; 35 36struct hw_addr_filt_notify_work { 37 struct work_struct work; 38 struct net_device *dev; 39 unsigned long changed; 40}; 41 42struct mac802154_priv *mac802154_slave_get_priv(struct net_device *dev) 43{ 44 struct mac802154_sub_if_data *priv = netdev_priv(dev); 45 46 BUG_ON(dev->type != ARPHRD_IEEE802154); 47 48 return priv->hw; 49} 50 51static void hw_addr_notify(struct work_struct *work) 52{ 53 struct hw_addr_filt_notify_work *nw = container_of(work, 54 struct hw_addr_filt_notify_work, work); 55 struct mac802154_priv *hw = mac802154_slave_get_priv(nw->dev); 56 int res; 57 58 res = hw->ops->set_hw_addr_filt(&hw->hw, 59 &hw->hw.hw_filt, 60 nw->changed); 61 if (res) 62 pr_debug("failed changed mask %lx\n", nw->changed); 63 64 kfree(nw); 65 66 return; 67} 68 69static void set_hw_addr_filt(struct net_device *dev, unsigned long changed) 70{ 71 struct mac802154_sub_if_data *priv = netdev_priv(dev); 72 struct hw_addr_filt_notify_work *work; 73 74 work = kzalloc(sizeof(*work), GFP_ATOMIC); 75 if (!work) 76 return; 77 78 INIT_WORK(&work->work, hw_addr_notify); 79 work->dev = dev; 80 work->changed = changed; 81 queue_work(priv->hw->dev_workqueue, &work->work); 82 83 return; 84} 85 86void mac802154_dev_set_short_addr(struct net_device *dev, u16 val) 87{ 88 struct mac802154_sub_if_data *priv = netdev_priv(dev); 89 90 BUG_ON(dev->type != ARPHRD_IEEE802154); 91 92 spin_lock_bh(&priv->mib_lock); 93 priv->short_addr = val; 94 spin_unlock_bh(&priv->mib_lock); 95 96 if ((priv->hw->ops->set_hw_addr_filt) && 97 (priv->hw->hw.hw_filt.short_addr != priv->short_addr)) { 98 priv->hw->hw.hw_filt.short_addr = priv->short_addr; 99 set_hw_addr_filt(dev, IEEE802515_AFILT_SADDR_CHANGED); 100 } 101} 102 103void mac802154_dev_set_ieee_addr(struct net_device *dev) 104{ 105 struct mac802154_sub_if_data *priv = netdev_priv(dev); 106 struct mac802154_priv *mac = priv->hw; 107 108 if (mac->ops->set_hw_addr_filt && 109 memcmp(mac->hw.hw_filt.ieee_addr, 110 dev->dev_addr, IEEE802154_ADDR_LEN)) { 111 memcpy(mac->hw.hw_filt.ieee_addr, 112 dev->dev_addr, IEEE802154_ADDR_LEN); 113 set_hw_addr_filt(dev, IEEE802515_AFILT_IEEEADDR_CHANGED); 114 } 115} 116 117u16 mac802154_dev_get_pan_id(const struct net_device *dev) 118{ 119 struct mac802154_sub_if_data *priv = netdev_priv(dev); 120 u16 ret; 121 122 BUG_ON(dev->type != ARPHRD_IEEE802154); 123 124 spin_lock_bh(&priv->mib_lock); 125 ret = priv->pan_id; 126 spin_unlock_bh(&priv->mib_lock); 127 128 return ret; 129} 130 131void mac802154_dev_set_pan_id(struct net_device *dev, u16 val) 132{ 133 struct mac802154_sub_if_data *priv = netdev_priv(dev); 134 135 BUG_ON(dev->type != ARPHRD_IEEE802154); 136 137 spin_lock_bh(&priv->mib_lock); 138 priv->pan_id = val; 139 spin_unlock_bh(&priv->mib_lock); 140 141 if ((priv->hw->ops->set_hw_addr_filt) && 142 (priv->hw->hw.hw_filt.pan_id != priv->pan_id)) { 143 priv->hw->hw.hw_filt.pan_id = priv->pan_id; 144 set_hw_addr_filt(dev, IEEE802515_AFILT_PANID_CHANGED); 145 } 146} 147 148static void phy_chan_notify(struct work_struct *work) 149{ 150 struct phy_chan_notify_work *nw = container_of(work, 151 struct phy_chan_notify_work, work); 152 struct mac802154_priv *hw = mac802154_slave_get_priv(nw->dev); 153 struct mac802154_sub_if_data *priv = netdev_priv(nw->dev); 154 int res; 155 156 res = hw->ops->set_channel(&hw->hw, priv->page, priv->chan); 157 if (res) 158 pr_debug("set_channel failed\n"); 159 160 kfree(nw); 161} 162 163void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan) 164{ 165 struct mac802154_sub_if_data *priv = netdev_priv(dev); 166 struct phy_chan_notify_work *work; 167 168 BUG_ON(dev->type != ARPHRD_IEEE802154); 169 170 spin_lock_bh(&priv->mib_lock); 171 priv->page = page; 172 priv->chan = chan; 173 spin_unlock_bh(&priv->mib_lock); 174 175 if (priv->hw->phy->current_channel != priv->chan || 176 priv->hw->phy->current_page != priv->page) { 177 work = kzalloc(sizeof(*work), GFP_ATOMIC); 178 if (!work) 179 return; 180 181 INIT_WORK(&work->work, phy_chan_notify); 182 work->dev = dev; 183 queue_work(priv->hw->dev_workqueue, &work->work); 184 } 185} 186