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                                 cpu_to_le64(0x0000000000000000ULL));
  33         rtnl_unlock();
  34
  35         return dev;
  36 }
  37
  38 static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
  39                                             struct net_device *dev)
  40 {
  41         struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
  42
  43         ieee802154_if_remove(sdata);
  44 }
  45
  46 static int
  47 ieee802154_add_iface(struct wpan_phy *phy, const char *name,
  48                      enum nl802154_iftype type, __le64 extended_addr)
  49 {
  50         struct ieee802154_local *local = wpan_phy_priv(phy);
  51         struct net_device *err;
  52
  53         err = ieee802154_if_add(local, name, type, extended_addr);
  54         if (IS_ERR(err))
  55                 return PTR_ERR(err);
  56
  57         return 0;
  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         /* check if phy support this setting */
  77         if (!(wpan_phy->channels_supported[page] & BIT(channel)))
  78                 return -EINVAL;
  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         /* check if phy support this setting */
  99         if (!(local->hw.flags & IEEE802154_HW_CCA_MODE))
 100                 return -EOPNOTSUPP;
 101
 102         ret = drv_set_cca_mode(local, cca);
 103         if (!ret)
 104                 wpan_phy->cca = *cca;
 105
 106         return ret;
 107 }
 108
 109 static int
 110 ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 111                       __le16 pan_id)
 112 {
 113         ASSERT_RTNL();
 114
 115         /* TODO
 116          * I am not sure about to check here on broadcast pan_id.
 117          * Broadcast is a valid setting, comment from 802.15.4:
 118          * If this value is 0xffff, the device is not associated.
 119          *
 120          * This could useful to simple deassociate an device.
 121          */
 122         if (pan_id == cpu_to_le16(IEEE802154_PAN_ID_BROADCAST))
 123                 return -EINVAL;
 124
 125         wpan_dev->pan_id = pan_id;
 126         return 0;
 127 }
 128
 129 static int
 130 ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
 131                                 struct wpan_dev *wpan_dev,
 132                                 u8 min_be, u8 max_be)
 133 {
 134         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 135
 136         ASSERT_RTNL();
 137
 138         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 139                 return -EOPNOTSUPP;
 140
 141         wpan_dev->min_be = min_be;
 142         wpan_dev->max_be = max_be;
 143         return 0;
 144 }
 145
 146 static int
 147 ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 148                           __le16 short_addr)
 149 {
 150         ASSERT_RTNL();
 151
 152         /* TODO
 153          * I am not sure about to check here on broadcast short_addr.
 154          * Broadcast is a valid setting, comment from 802.15.4:
 155          * A value of 0xfffe indicates that the device has
 156          * associated but has not been allocated an address. A
 157          * value of 0xffff indicates that the device does not
 158          * have a short address.
 159          *
 160          * I think we should allow to set these settings but
 161          * don't allow to allow socket communication with it.
 162          */
 163         if (short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC) ||
 164             short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST))
 165                 return -EINVAL;
 166
 167         wpan_dev->short_addr = short_addr;
 168         return 0;
 169 }
 170
 171 static int
 172 ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
 173                                  struct wpan_dev *wpan_dev,
 174                                  u8 max_csma_backoffs)
 175 {
 176         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 177
 178         ASSERT_RTNL();
 179
 180         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 181                 return -EOPNOTSUPP;
 182
 183         wpan_dev->csma_retries = max_csma_backoffs;
 184         return 0;
 185 }
 186
 187 static int
 188 ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
 189                                  struct wpan_dev *wpan_dev,
 190                                  s8 max_frame_retries)
 191 {
 192         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 193
 194         ASSERT_RTNL();
 195
 196         if (!(local->hw.flags & IEEE802154_HW_FRAME_RETRIES))
 197                 return -EOPNOTSUPP;
 198
 199         wpan_dev->frame_retries = max_frame_retries;
 200         return 0;
 201 }
 202
 203 static int
 204 ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 205                         bool mode)
 206 {
 207         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 208
 209         ASSERT_RTNL();
 210
 211         if (!(local->hw.flags & IEEE802154_HW_LBT))
 212                 return -EOPNOTSUPP;
 213
 214         wpan_dev->lbt = mode;
 215         return 0;
 216 }
 217
 218 const struct cfg802154_ops mac802154_config_ops = {
 219         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
 220         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
 221         .add_virtual_intf = ieee802154_add_iface,
 222         .del_virtual_intf = ieee802154_del_iface,
 223         .set_channel = ieee802154_set_channel,
 224         .set_cca_mode = ieee802154_set_cca_mode,
 225         .set_pan_id = ieee802154_set_pan_id,
 226         .set_short_addr = ieee802154_set_short_addr,
 227         .set_backoff_exponent = ieee802154_set_backoff_exponent,
 228         .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
 229         .set_max_frame_retries = ieee802154_set_max_frame_retries,
 230         .set_lbt_mode = ieee802154_set_lbt_mode,
 231 };