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,
  26                                 unsigned char name_assign_type, int type)
  27 {
  28         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  29         struct net_device *dev;
  30
  31         rtnl_lock();
  32         dev = ieee802154_if_add(local, name, name_assign_type, type,
  33                                 cpu_to_le64(0x0000000000000000ULL));
  34         rtnl_unlock();
  35
  36         return dev;
  37 }
  38
  39 static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
  40                                             struct net_device *dev)
  41 {
  42         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  43
  44         ieee802154_if_remove(sdata);
  45 }
  46
  47 static int
  48 ieee802154_add_iface(struct wpan_phy *phy, const char *name,
  49                      unsigned char name_assign_type,
  50                      enum nl802154_iftype type, __le64 extended_addr)
  51 {
  52         struct ieee802154_local *local = wpan_phy_priv(phy);
  53         struct net_device *err;
  54
  55         err = ieee802154_if_add(local, name, name_assign_type, type,
  56                                 extended_addr);
  57         return PTR_ERR_OR_ZERO(err);
  58 }
  59
  60 static int
  61 ieee802154_del_iface(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev)
  62 {
  63         ieee802154_if_remove(IEEE802154_WPAN_DEV_TO_SUB_IF(wpan_dev));
  64
  65         return 0;
  66 }
  67
  68 static int
  69 ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel)
  70 {
  71         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  72         int ret;
  73
  74         ASSERT_RTNL();
  75
  76         if (wpan_phy->current_page == page &&
  77             wpan_phy->current_channel == channel)
  78                 return 0;
  79
  80         ret = drv_set_channel(local, page, channel);
  81         if (!ret) {
  82                 wpan_phy->current_page = page;
  83                 wpan_phy->current_channel = channel;
  84         }
  85
  86         return ret;
  87 }
  88
  89 static int
  90 ieee802154_set_cca_mode(struct wpan_phy *wpan_phy,
  91                         const struct wpan_phy_cca *cca)
  92 {
  93         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  94         int ret;
  95
  96         ASSERT_RTNL();
  97
  98         if (wpan_phy_cca_cmp(&wpan_phy->cca, cca))
  99                 return 0;
 100
 101         ret = drv_set_cca_mode(local, cca);
 102         if (!ret)
 103                 wpan_phy->cca = *cca;
 104
 105         return ret;
 106 }
 107
 108 static int
 109 ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 110                       __le16 pan_id)
 111 {
 112         ASSERT_RTNL();
 113
 114         if (wpan_dev->pan_id == pan_id)
 115                 return 0;
 116
 117         wpan_dev->pan_id = pan_id;
 118         return 0;
 119 }
 120
 121 static int
 122 ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
 123                                 struct wpan_dev *wpan_dev,
 124                                 u8 min_be, u8 max_be)
 125 {
 126         ASSERT_RTNL();
 127
 128         if (wpan_dev->min_be == min_be &&
 129             wpan_dev->max_be == max_be)
 130                 return 0;
 131
 132         wpan_dev->min_be = min_be;
 133         wpan_dev->max_be = max_be;
 134         return 0;
 135 }
 136
 137 static int
 138 ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 139                           __le16 short_addr)
 140 {
 141         ASSERT_RTNL();
 142
 143         if (wpan_dev->short_addr == short_addr)
 144                 return 0;
 145
 146         wpan_dev->short_addr = short_addr;
 147         return 0;
 148 }
 149
 150 static int
 151 ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
 152                                  struct wpan_dev *wpan_dev,
 153                                  u8 max_csma_backoffs)
 154 {
 155         ASSERT_RTNL();
 156
 157         if (wpan_dev->csma_retries == max_csma_backoffs)
 158                 return 0;
 159
 160         wpan_dev->csma_retries = max_csma_backoffs;
 161         return 0;
 162 }
 163
 164 static int
 165 ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
 166                                  struct wpan_dev *wpan_dev,
 167                                  s8 max_frame_retries)
 168 {
 169         ASSERT_RTNL();
 170
 171         if (wpan_dev->frame_retries == max_frame_retries)
 172                 return 0;
 173
 174         wpan_dev->frame_retries = max_frame_retries;
 175         return 0;
 176 }
 177
 178 static int
 179 ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 180                         bool mode)
 181 {
 182         ASSERT_RTNL();
 183
 184         if (wpan_dev->lbt == mode)
 185                 return 0;
 186
 187         wpan_dev->lbt = mode;
 188         return 0;
 189 }
 190
 191 const struct cfg802154_ops mac802154_config_ops = {
 192         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
 193         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
 194         .add_virtual_intf = ieee802154_add_iface,
 195         .del_virtual_intf = ieee802154_del_iface,
 196         .set_channel = ieee802154_set_channel,
 197         .set_cca_mode = ieee802154_set_cca_mode,
 198         .set_pan_id = ieee802154_set_pan_id,
 199         .set_short_addr = ieee802154_set_short_addr,
 200         .set_backoff_exponent = ieee802154_set_backoff_exponent,
 201         .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
 202         .set_max_frame_retries = ieee802154_set_max_frame_retries,
 203         .set_lbt_mode = ieee802154_set_lbt_mode,
 204 };