net/mac802154/mib.c

   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  * Written by:
  14  * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
  15  * Sergey Lapin <slapin@ossfans.org>
  16  * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
  17  * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
  18  */
  19
  20 #include <linux/if_arp.h>
  21
  22 #include <net/mac802154.h>
  23 #include <net/ieee802154_netdev.h>
  24 #include <net/cfg802154.h>
  25
  26 #include "ieee802154_i.h"
  27 #include "driver-ops.h"
  28
  29 struct hw_addr_filt_notify_work {
  30         struct work_struct work;
  31         struct net_device *dev;
  32         unsigned long changed;
  33 };
  34
  35 static struct ieee802154_local *mac802154_slave_get_priv(struct net_device *dev)
  36 {
  37         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  38
  39         BUG_ON(dev->type != ARPHRD_IEEE802154);
  40
  41         return sdata->local;
  42 }
  43
  44 static void hw_addr_notify(struct work_struct *work)
  45 {
  46         struct hw_addr_filt_notify_work *nw = container_of(work,
  47                         struct hw_addr_filt_notify_work, work);
  48         struct ieee802154_local *local = mac802154_slave_get_priv(nw->dev);
  49         int res;
  50
  51         res = local->ops->set_hw_addr_filt(&local->hw, &local->hw.hw_filt,
  52                                            nw->changed);
  53         if (res)
  54                 pr_debug("failed changed mask %lx\n", nw->changed);
  55
  56         kfree(nw);
  57 }
  58
  59 static void set_hw_addr_filt(struct net_device *dev, unsigned long changed)
  60 {
  61         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  62         struct hw_addr_filt_notify_work *work;
  63
  64         work = kzalloc(sizeof(*work), GFP_ATOMIC);
  65         if (!work)
  66                 return;
  67
  68         INIT_WORK(&work->work, hw_addr_notify);
  69         work->dev = dev;
  70         work->changed = changed;
  71         queue_work(sdata->local->workqueue, &work->work);
  72 }
  73
  74 void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val)
  75 {
  76         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  77
  78         BUG_ON(dev->type != ARPHRD_IEEE802154);
  79
  80         spin_lock_bh(&sdata->mib_lock);
  81         sdata->short_addr = val;
  82         spin_unlock_bh(&sdata->mib_lock);
  83 }
  84
  85 __le16 mac802154_dev_get_short_addr(const struct net_device *dev)
  86 {
  87         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  88         __le16 ret;
  89
  90         BUG_ON(dev->type != ARPHRD_IEEE802154);
  91
  92         spin_lock_bh(&sdata->mib_lock);
  93         ret = sdata->short_addr;
  94         spin_unlock_bh(&sdata->mib_lock);
  95
  96         return ret;
  97 }
  98
  99 __le16 mac802154_dev_get_pan_id(const struct net_device *dev)
 100 {
 101         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 102         __le16 ret;
 103
 104         BUG_ON(dev->type != ARPHRD_IEEE802154);
 105
 106         spin_lock_bh(&sdata->mib_lock);
 107         ret = sdata->pan_id;
 108         spin_unlock_bh(&sdata->mib_lock);
 109
 110         return ret;
 111 }
 112
 113 void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val)
 114 {
 115         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 116
 117         BUG_ON(dev->type != ARPHRD_IEEE802154);
 118
 119         spin_lock_bh(&sdata->mib_lock);
 120         sdata->pan_id = val;
 121         spin_unlock_bh(&sdata->mib_lock);
 122
 123         if ((sdata->local->ops->set_hw_addr_filt) &&
 124             (sdata->local->hw.hw_filt.pan_id != sdata->pan_id)) {
 125                 sdata->local->hw.hw_filt.pan_id = sdata->pan_id;
 126                 set_hw_addr_filt(dev, IEEE802154_AFILT_PANID_CHANGED);
 127         }
 128 }
 129
 130 u8 mac802154_dev_get_dsn(const struct net_device *dev)
 131 {
 132         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 133
 134         BUG_ON(dev->type != ARPHRD_IEEE802154);
 135
 136         return sdata->dsn++;
 137 }
 138
 139 void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
 140 {
 141         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 142         struct ieee802154_local *local = sdata->local;
 143         int res;
 144
 145         BUG_ON(dev->type != ARPHRD_IEEE802154);
 146
 147         res = drv_set_channel(local, page, chan);
 148         if (res) {
 149                 pr_debug("set_channel failed\n");
 150         } else {
 151                 mutex_lock(&local->phy->pib_lock);
 152                 local->phy->current_channel = chan;
 153                 local->phy->current_page = page;
 154                 mutex_unlock(&local->phy->pib_lock);
 155         }
 156 }
 157
 158
 159 int mac802154_get_params(struct net_device *dev,
 160                          struct ieee802154_llsec_params *params)
 161 {
 162         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 163         int res;
 164
 165         BUG_ON(dev->type != ARPHRD_IEEE802154);
 166
 167         mutex_lock(&sdata->sec_mtx);
 168         res = mac802154_llsec_get_params(&sdata->sec, params);
 169         mutex_unlock(&sdata->sec_mtx);
 170
 171         return res;
 172 }
 173
 174 int mac802154_set_params(struct net_device *dev,
 175                          const struct ieee802154_llsec_params *params,
 176                          int changed)
 177 {
 178         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 179         int res;
 180
 181         BUG_ON(dev->type != ARPHRD_IEEE802154);
 182
 183         mutex_lock(&sdata->sec_mtx);
 184         res = mac802154_llsec_set_params(&sdata->sec, params, changed);
 185         mutex_unlock(&sdata->sec_mtx);
 186
 187         return res;
 188 }
 189
 190
 191 int mac802154_add_key(struct net_device *dev,
 192                       const struct ieee802154_llsec_key_id *id,
 193                       const struct ieee802154_llsec_key *key)
 194 {
 195         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 196         int res;
 197
 198         BUG_ON(dev->type != ARPHRD_IEEE802154);
 199
 200         mutex_lock(&sdata->sec_mtx);
 201         res = mac802154_llsec_key_add(&sdata->sec, id, key);
 202         mutex_unlock(&sdata->sec_mtx);
 203
 204         return res;
 205 }
 206
 207 int mac802154_del_key(struct net_device *dev,
 208                       const struct ieee802154_llsec_key_id *id)
 209 {
 210         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 211         int res;
 212
 213         BUG_ON(dev->type != ARPHRD_IEEE802154);
 214
 215         mutex_lock(&sdata->sec_mtx);
 216         res = mac802154_llsec_key_del(&sdata->sec, id);
 217         mutex_unlock(&sdata->sec_mtx);
 218
 219         return res;
 220 }
 221
 222
 223 int mac802154_add_dev(struct net_device *dev,
 224                       const struct ieee802154_llsec_device *llsec_dev)
 225 {
 226         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 227         int res;
 228
 229         BUG_ON(dev->type != ARPHRD_IEEE802154);
 230
 231         mutex_lock(&sdata->sec_mtx);
 232         res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev);
 233         mutex_unlock(&sdata->sec_mtx);
 234
 235         return res;
 236 }
 237
 238 int mac802154_del_dev(struct net_device *dev, __le64 dev_addr)
 239 {
 240         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 241         int res;
 242
 243         BUG_ON(dev->type != ARPHRD_IEEE802154);
 244
 245         mutex_lock(&sdata->sec_mtx);
 246         res = mac802154_llsec_dev_del(&sdata->sec, dev_addr);
 247         mutex_unlock(&sdata->sec_mtx);
 248
 249         return res;
 250 }
 251
 252
 253 int mac802154_add_devkey(struct net_device *dev,
 254                          __le64 device_addr,
 255                          const struct ieee802154_llsec_device_key *key)
 256 {
 257         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 258         int res;
 259
 260         BUG_ON(dev->type != ARPHRD_IEEE802154);
 261
 262         mutex_lock(&sdata->sec_mtx);
 263         res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key);
 264         mutex_unlock(&sdata->sec_mtx);
 265
 266         return res;
 267 }
 268
 269 int mac802154_del_devkey(struct net_device *dev,
 270                          __le64 device_addr,
 271                          const struct ieee802154_llsec_device_key *key)
 272 {
 273         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 274         int res;
 275
 276         BUG_ON(dev->type != ARPHRD_IEEE802154);
 277
 278         mutex_lock(&sdata->sec_mtx);
 279         res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key);
 280         mutex_unlock(&sdata->sec_mtx);
 281
 282         return res;
 283 }
 284
 285
 286 int mac802154_add_seclevel(struct net_device *dev,
 287                            const struct ieee802154_llsec_seclevel *sl)
 288 {
 289         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 290         int res;
 291
 292         BUG_ON(dev->type != ARPHRD_IEEE802154);
 293
 294         mutex_lock(&sdata->sec_mtx);
 295         res = mac802154_llsec_seclevel_add(&sdata->sec, sl);
 296         mutex_unlock(&sdata->sec_mtx);
 297
 298         return res;
 299 }
 300
 301 int mac802154_del_seclevel(struct net_device *dev,
 302                            const struct ieee802154_llsec_seclevel *sl)
 303 {
 304         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 305         int res;
 306
 307         BUG_ON(dev->type != ARPHRD_IEEE802154);
 308
 309         mutex_lock(&sdata->sec_mtx);
 310         res = mac802154_llsec_seclevel_del(&sdata->sec, sl);
 311         mutex_unlock(&sdata->sec_mtx);
 312
 313         return res;
 314 }
 315
 316
 317 void mac802154_lock_table(struct net_device *dev)
 318 {
 319         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 320
 321         BUG_ON(dev->type != ARPHRD_IEEE802154);
 322
 323         mutex_lock(&sdata->sec_mtx);
 324 }
 325
 326 void mac802154_get_table(struct net_device *dev,
 327                          struct ieee802154_llsec_table **t)
 328 {
 329         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 330
 331         BUG_ON(dev->type != ARPHRD_IEEE802154);
 332
 333         *t = &sdata->sec.table;
 334 }
 335
 336 void mac802154_unlock_table(struct net_device *dev)
 337 {
 338         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
 339
 340         BUG_ON(dev->type != ARPHRD_IEEE802154);
 341
 342         mutex_unlock(&sdata->sec_mtx);
 343 }