Bluetooth: Add legacy SMP tests

[deliverable/linux.git] / net / mac802154 / cfg.c

diff --git a/net/mac802154/cfg.c b/net/mac802154/cfg.c
index db6e5e981a835e7519dc557cc87fc52e59b11d44..7d31da503dcfcd24d00826d24b121228075ced35 100644 (file)
--- a/net/mac802154/cfg.c
+++ b/net/mac802154/cfg.c
@@ -28,7 +28,8 @@ ieee802154_add_iface_deprecated(struct wpan_phy *wpan_phy,
        struct net_device *dev;
 
        rtnl_lock();
-       dev = ieee802154_if_add(local, name, NULL, type);
+       dev = ieee802154_if_add(local, name, type,
+                               cpu_to_le64(0x0000000000000000ULL));
        rtnl_unlock();
 
        return dev;
@@ -43,8 +44,29 @@ static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
 }
 
 static int
-ieee802154_set_channel(struct wpan_phy *wpan_phy, const u8 page,
-                      const u8 channel)
+ieee802154_add_iface(struct wpan_phy *phy, const char *name,
+                    enum nl802154_iftype type, __le64 extended_addr)
+{
+       struct ieee802154_local *local = wpan_phy_priv(phy);
+       struct net_device *err;
+
+       err = ieee802154_if_add(local, name, type, extended_addr);
+       if (IS_ERR(err))
+               return PTR_ERR(err);
+
+       return 0;
+}
+
+static int
+ieee802154_del_iface(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev)
+{
+       ieee802154_if_remove(IEEE802154_WPAN_DEV_TO_SUB_IF(wpan_dev));
+
+       return 0;
+}
+
+static int
+ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel)
 {
        struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
        int ret;
@@ -64,8 +86,29 @@ ieee802154_set_channel(struct wpan_phy *wpan_phy, const u8 page,
        return ret;
 }
 
-static int ieee802154_set_pan_id(struct wpan_phy *wpan_phy,
-                                struct wpan_dev *wpan_dev, const u16 pan_id)
+static int
+ieee802154_set_cca_mode(struct wpan_phy *wpan_phy,
+                       const struct wpan_phy_cca *cca)
+{
+       struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
+       int ret;
+
+       ASSERT_RTNL();
+
+       /* check if phy support this setting */
+       if (!(local->hw.flags & IEEE802154_HW_CCA_MODE))
+               return -EOPNOTSUPP;
+
+       ret = drv_set_cca_mode(local, cca);
+       if (!ret)
+               wpan_phy->cca = *cca;
+
+       return ret;
+}
+
+static int
+ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
+                     __le16 pan_id)
 {
        ASSERT_RTNL();
 
@@ -76,16 +119,113 @@ static int ieee802154_set_pan_id(struct wpan_phy *wpan_phy,
         *
         * This could useful to simple deassociate an device.
         */
-       if (pan_id == IEEE802154_PAN_ID_BROADCAST)
+       if (pan_id == cpu_to_le16(IEEE802154_PAN_ID_BROADCAST))
+               return -EINVAL;
+
+       wpan_dev->pan_id = pan_id;
+       return 0;
+}
+
+static int
+ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
+                               struct wpan_dev *wpan_dev,
+                               u8 min_be, u8 max_be)
+{
+       struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
+
+       ASSERT_RTNL();
+
+       if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
+               return -EOPNOTSUPP;
+
+       wpan_dev->min_be = min_be;
+       wpan_dev->max_be = max_be;
+       return 0;
+}
+
+static int
+ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
+                         __le16 short_addr)
+{
+       ASSERT_RTNL();
+
+       /* TODO
+        * I am not sure about to check here on broadcast short_addr.
+        * Broadcast is a valid setting, comment from 802.15.4:
+        * A value of 0xfffe indicates that the device has
+        * associated but has not been allocated an address. A
+        * value of 0xffff indicates that the device does not
+        * have a short address.
+        *
+        * I think we should allow to set these settings but
+        * don't allow to allow socket communication with it.
+        */
+       if (short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC) ||
+           short_addr == cpu_to_le16(IEEE802154_ADDR_SHORT_BROADCAST))
                return -EINVAL;
 
-       wpan_dev->pan_id = cpu_to_le16(pan_id);
+       wpan_dev->short_addr = short_addr;
+       return 0;
+}
+
+static int
+ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
+                                struct wpan_dev *wpan_dev,
+                                u8 max_csma_backoffs)
+{
+       struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
+
+       ASSERT_RTNL();
+
+       if (!(local->hw.flags & IEEE802154_HW_CSMA_PARAMS))
+               return -EOPNOTSUPP;
+
+       wpan_dev->csma_retries = max_csma_backoffs;
+       return 0;
+}
+
+static int
+ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
+                                struct wpan_dev *wpan_dev,
+                                s8 max_frame_retries)
+{
+       struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
+
+       ASSERT_RTNL();
+
+       if (!(local->hw.flags & IEEE802154_HW_FRAME_RETRIES))
+               return -EOPNOTSUPP;
+
+       wpan_dev->frame_retries = max_frame_retries;
+       return 0;
+}
+
+static int
+ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
+                       bool mode)
+{
+       struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
+
+       ASSERT_RTNL();
+
+       if (!(local->hw.flags & IEEE802154_HW_LBT))
+               return -EOPNOTSUPP;
+
+       wpan_dev->lbt = mode;
        return 0;
 }
 
 const struct cfg802154_ops mac802154_config_ops = {
        .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
        .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
+       .add_virtual_intf = ieee802154_add_iface,
+       .del_virtual_intf = ieee802154_del_iface,
        .set_channel = ieee802154_set_channel,
+       .set_cca_mode = ieee802154_set_cca_mode,
        .set_pan_id = ieee802154_set_pan_id,
+       .set_short_addr = ieee802154_set_short_addr,
+       .set_backoff_exponent = ieee802154_set_backoff_exponent,
+       .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
+       .set_max_frame_retries = ieee802154_set_max_frame_retries,
+       .set_lbt_mode = ieee802154_set_lbt_mode,
 };