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_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
  91                       u16 pan_id)
  92 {
  93         ASSERT_RTNL();
  94
  95         /* TODO
  96          * I am not sure about to check here on broadcast pan_id.
  97          * Broadcast is a valid setting, comment from 802.15.4:
  98          * If this value is 0xffff, the device is not associated.
  99          *
 100          * This could useful to simple deassociate an device.
 101          */
 102         if (pan_id == IEEE802154_PAN_ID_BROADCAST)
 103                 return -EINVAL;
 104
 105         wpan_dev->pan_id = cpu_to_le16(pan_id);
 106         return 0;
 107 }
 108
 109 static int
 110 ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
 111                                 struct wpan_dev *wpan_dev,
 112                                 u8 min_be, u8 max_be)
 113 {
 114         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 115
 116         ASSERT_RTNL();
 117
 118         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 119                 return -EOPNOTSUPP;
 120
 121         wpan_dev->min_be = min_be;
 122         wpan_dev->max_be = max_be;
 123         return 0;
 124 }
 125
 126 static int
 127 ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 128                           u16 short_addr)
 129 {
 130         ASSERT_RTNL();
 131
 132         /* TODO
 133          * I am not sure about to check here on broadcast short_addr.
 134          * Broadcast is a valid setting, comment from 802.15.4:
 135          * A value of 0xfffe indicates that the device has
 136          * associated but has not been allocated an address. A
 137          * value of 0xffff indicates that the device does not
 138          * have a short address.
 139          *
 140          * I think we should allow to set these settings but
 141          * don't allow to allow socket communication with it.
 142          */
 143         if (short_addr == IEEE802154_ADDR_SHORT_UNSPEC ||
 144             short_addr == IEEE802154_ADDR_SHORT_BROADCAST)
 145                 return -EINVAL;
 146
 147         wpan_dev->short_addr = cpu_to_le16(short_addr);
 148         return 0;
 149 }
 150
 151 static int
 152 ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
 153                                  struct wpan_dev *wpan_dev,
 154                                  u8 max_csma_backoffs)
 155 {
 156         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 157
 158         ASSERT_RTNL();
 159
 160         if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
 161                 return -EOPNOTSUPP;
 162
 163         wpan_dev->csma_retries = max_csma_backoffs;
 164         return 0;
 165 }
 166
 167 static int
 168 ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
 169                                  struct wpan_dev *wpan_dev,
 170                                  s8 max_frame_retries)
 171 {
 172         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 173
 174         ASSERT_RTNL();
 175
 176         if (!(local->hw.flags & IEEE802154_HW_FRAME_RETRIES))
 177                 return -EOPNOTSUPP;
 178
 179         wpan_dev->frame_retries = max_frame_retries;
 180         return 0;
 181 }
 182
 183 static int
 184 ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 185                         bool mode)
 186 {
 187         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
 188
 189         ASSERT_RTNL();
 190
 191         if (!(local->hw.flags & IEEE802154_HW_LBT))
 192                 return -EOPNOTSUPP;
 193
 194         wpan_dev->lbt = mode;
 195         return 0;
 196 }
 197
 198 const struct cfg802154_ops mac802154_config_ops = {
 199         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
 200         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
 201         .add_virtual_intf = ieee802154_add_iface,
 202         .del_virtual_intf = ieee802154_del_iface,
 203         .set_channel = ieee802154_set_channel,
 204         .set_pan_id = ieee802154_set_pan_id,
 205         .set_short_addr = ieee802154_set_short_addr,
 206         .set_backoff_exponent = ieee802154_set_backoff_exponent,
 207         .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
 208         .set_max_frame_retries = ieee802154_set_max_frame_retries,
 209         .set_lbt_mode = ieee802154_set_lbt_mode,
 210 };