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, 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_add_iface(struct wpan_phy *phy, const char *name,
  47                      enum nl802154_iftype type)
  48 {
  49         struct ieee802154_local *local = wpan_phy_priv(phy);
  50         struct net_device *err;
  51
  52         err = ieee802154_if_add(local, name, type);
  53         if (IS_ERR(err))
  54                 return PTR_ERR(err);
  55
  56         return 0;
  57 }
  58
  59 static int
  60 ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel)
  61 {
  62         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
  63         int ret;
  64
  65         ASSERT_RTNL();
  66
  67         /* check if phy support this setting */
  68         if (!(wpan_phy->channels_supported[page] & BIT(channel)))
  69                 return -EINVAL;
  70
  71         ret = drv_set_channel(local, page, channel);
  72         if (!ret) {
  73                 wpan_phy->current_page = page;
  74                 wpan_phy->current_channel = channel;
  75         }
  76
  77         return ret;
  78 }
  79
  80 static int
  81 ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
  82                       u16 pan_id)
  83 {
  84         ASSERT_RTNL();
  85
  86         /* TODO
  87          * I am not sure about to check here on broadcast pan_id.
  88          * Broadcast is a valid setting, comment from 802.15.4:
  89          * If this value is 0xffff, the device is not associated.
  90          *
  91          * This could useful to simple deassociate an device.
  92          */
  93         if (pan_id == IEEE802154_PAN_ID_BROADCAST)
  94                 return -EINVAL;
  95
  96         wpan_dev->pan_id = cpu_to_le16(pan_id);
  97         return 0;
  98 }
  99
 100 static int
 101 ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
 102                                 struct wpan_dev *wpan_dev,
 103                                 u8 min_be, u8 max_be)
 104 {
 105         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 106
 107         ASSERT_RTNL();
 108
 109         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 110                 return -EOPNOTSUPP;
 111
 112         wpan_dev->min_be = min_be;
 113         wpan_dev->max_be = max_be;
 114         return 0;
 115 }
 116
 117 static int
 118 ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 119                           u16 short_addr)
 120 {
 121         ASSERT_RTNL();
 122
 123         /* TODO
 124          * I am not sure about to check here on broadcast short_addr.
 125          * Broadcast is a valid setting, comment from 802.15.4:
 126          * A value of 0xfffe indicates that the device has
 127          * associated but has not been allocated an address. A
 128          * value of 0xffff indicates that the device does not
 129          * have a short address.
 130          *
 131          * I think we should allow to set these settings but
 132          * don't allow to allow socket communication with it.
 133          */
 134         if (short_addr == IEEE802154_ADDR_SHORT_UNSPEC ||
 135             short_addr == IEEE802154_ADDR_SHORT_BROADCAST)
 136                 return -EINVAL;
 137
 138         wpan_dev->short_addr = cpu_to_le16(short_addr);
 139         return 0;
 140 }
 141
 142 static int
 143 ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
 144                                  struct wpan_dev *wpan_dev,
 145                                  u8 max_csma_backoffs)
 146 {
 147         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 148
 149         ASSERT_RTNL();
 150
 151         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 152                 return -EOPNOTSUPP;
 153
 154         wpan_dev->csma_retries = max_csma_backoffs;
 155         return 0;
 156 }
 157
 158 static int
 159 ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
 160                                  struct wpan_dev *wpan_dev,
 161                                  s8 max_frame_retries)
 162 {
 163         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 164
 165         ASSERT_RTNL();
 166
 167         if (!(local->hw.flags & IEEE802154_HW_FRAME_RETRIES))
 168                 return -EOPNOTSUPP;
 169
 170         wpan_dev->frame_retries = max_frame_retries;
 171         return 0;
 172 }
 173
 174 static int
 175 ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 176                         bool mode)
 177 {
 178         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 179
 180         ASSERT_RTNL();
 181
 182         if (!(local->hw.flags & IEEE802154_HW_LBT))
 183                 return -EOPNOTSUPP;
 184
 185         wpan_dev->lbt = mode;
 186         return 0;
 187 }
 188
 189 const struct cfg802154_ops mac802154_config_ops = {
 190         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
 191         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
 192         .add_virtual_intf = ieee802154_add_iface,
 193         .set_channel = ieee802154_set_channel,
 194         .set_pan_id = ieee802154_set_pan_id,
 195         .set_short_addr = ieee802154_set_short_addr,
 196         .set_backoff_exponent = ieee802154_set_backoff_exponent,
 197         .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
 198         .set_max_frame_retries = ieee802154_set_max_frame_retries,
 199         .set_lbt_mode = ieee802154_set_lbt_mode,
 200 };