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