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