net/mac802154/cfg.c

   1 /* This program is free software; you can redistribute it and/or modify
   2  * it under the terms of the GNU General Public License version 2
   3  * as published by the Free Software Foundation.
   4  *
   5  * This program is distributed in the hope that it will be useful,
   6  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   7  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   8  * GNU General Public License for more details.
   9  *
  10  * Authors:
  11  * Alexander Aring <aar@pengutronix.de>
  12  *
  13  * Based on: net/mac80211/cfg.c
  14  */
  15
  16 #include <net/rtnetlink.h>
  17 #include <net/cfg802154.h>
  18
  19 #include "ieee802154_i.h"
  20 #include "driver-ops.h"
  21 #include "cfg.h"
  22
  23 static struct net_device *
  24 ieee802154_add_iface_deprecated(struct wpan_phy *wpan_phy,
  25                                 const char *name, int type)
  26 {
  27         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  28         struct net_device *dev;
  29
  30         rtnl_lock();
  31         dev = ieee802154_if_add(local, name, NULL, type);
  32         rtnl_unlock();
  33
  34         return dev;
  35 }
  36
  37 static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
  38                                             struct net_device *dev)
  39 {
  40         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  41
  42         ieee802154_if_remove(sdata);
  43 }
  44
  45 static int
  46 ieee802154_set_channel(struct wpan_phy *wpan_phy, const u8 page,
  47                        const u8 channel)
  48 {
  49         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  50         int ret;
  51
  52         ASSERT_RTNL();
  53
  54         /* check if phy support this setting */
  55         if (!(wpan_phy->channels_supported[page] & BIT(channel)))
  56                 return -EINVAL;
  57
  58         ret = drv_set_channel(local, page, channel);
  59         if (!ret) {
  60                 wpan_phy->current_page = page;
  61                 wpan_phy->current_channel = channel;
  62         }
  63
  64         return ret;
  65 }
  66
  67 const struct cfg802154_ops mac802154_config_ops = {
  68         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
  69         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
  70         .set_channel = ieee802154_set_channel,
  71 };