nl802154: add support to set cca ed level

This patch adds support for setting the current cca ed level value over
nl802154.

Signed-off-by: Alexander Aring <alex.aring@gmail.com>
Reviewed-by: Varka Bhadram <varkabhadram@gmail.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

3 files changed, 56 insertions, 0 deletions

diff --git a/net/ieee802154/nl802154.c b/net/ieee802154/nl802154.c
index a89d9d024126..7dbb1f4ce7df 100644
--- a/net/ieee802154/nl802154.c
+++ b/net/ieee802154/nl802154.c
@@ -790,6 +790,28 @@ static int nl802154_set_cca_mode(struct sk_buff *skb, struct genl_info *info)
         return rdev_set_cca_mode(rdev, &cca);
 }
 
+static int nl802154_set_cca_ed_level(struct sk_buff *skb, struct genl_info *info)
+{
+        struct cfg802154_registered_device *rdev = info->user_ptr[0];
+        s32 ed_level;
+        int i;
+
+        if (!(rdev->wpan_phy.flags & WPAN_PHY_FLAG_CCA_ED_LEVEL))
+                return -EOPNOTSUPP;
+
+        if (!info->attrs[NL802154_ATTR_CCA_ED_LEVEL])
+                return -EINVAL;
+
+        ed_level = nla_get_s32(info->attrs[NL802154_ATTR_CCA_ED_LEVEL]);
+
+        for (i = 0; i < rdev->wpan_phy.supported.cca_ed_levels_size; i++) {
+                if (ed_level == rdev->wpan_phy.supported.cca_ed_levels[i])
+                        return rdev_set_cca_ed_level(rdev, ed_level);
+        }
+
+        return -EINVAL;
+}
+
 static int nl802154_set_tx_power(struct sk_buff *skb, struct genl_info *info)
 {
         struct cfg802154_registered_device *rdev = info->user_ptr[0];
@@ -1123,6 +1145,14 @@ static const struct genl_ops nl802154_ops[] = {
                                   NL802154_FLAG_NEED_RTNL,
         },
         {
+                .cmd = NL802154_CMD_SET_CCA_ED_LEVEL,
+                .doit = nl802154_set_cca_ed_level,
+                .policy = nl802154_policy,
+                .flags = GENL_ADMIN_PERM,
+                .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
+                                  NL802154_FLAG_NEED_RTNL,
+        },
+        {
                 .cmd = NL802154_CMD_SET_TX_POWER,
                 .doit = nl802154_set_tx_power,
                 .policy = nl802154_policy,
diff --git a/net/ieee802154/rdev-ops.h b/net/ieee802154/rdev-ops.h
index 36456118a6ec..b2155a123f6c 100644
--- a/net/ieee802154/rdev-ops.h
+++ b/net/ieee802154/rdev-ops.h
@@ -75,6 +75,17 @@ rdev_set_cca_mode(struct cfg802154_registered_device *rdev,
 }
 
 static inline int
+rdev_set_cca_ed_level(struct cfg802154_registered_device *rdev, s32 ed_level)
+{
+        int ret;
+
+        trace_802154_rdev_set_cca_ed_level(&rdev->wpan_phy, ed_level);
+        ret = rdev->ops->set_cca_ed_level(&rdev->wpan_phy, ed_level);
+        trace_802154_rdev_return_int(&rdev->wpan_phy, ret);
+        return ret;
+}
+
+static inline int
 rdev_set_tx_power(struct cfg802154_registered_device *rdev,
                   s32 power)
 {
diff --git a/net/ieee802154/trace.h b/net/ieee802154/trace.h
index ac790bb1b4fe..73eb7605c1eb 100644
--- a/net/ieee802154/trace.h
+++ b/net/ieee802154/trace.h
@@ -123,6 +123,21 @@ TRACE_EVENT(802154_rdev_set_cca_mode,
                   WPAN_CCA_PR_ARG)
 );
 
+TRACE_EVENT(802154_rdev_set_cca_ed_level,
+        TP_PROTO(struct wpan_phy *wpan_phy, s32 ed_level),
+        TP_ARGS(wpan_phy, ed_level),
+        TP_STRUCT__entry(
+                WPAN_PHY_ENTRY
+                __field(s32, ed_level)
+        ),
+        TP_fast_assign(
+                WPAN_PHY_ASSIGN;
+                __entry->ed_level = ed_level;
+        ),
+        TP_printk(WPAN_PHY_PR_FMT ", ed_level: %d", WPAN_PHY_PR_ARG,
+                  __entry->ed_level)
+);
+
 DECLARE_EVENT_CLASS(802154_le16_template,
         TP_PROTO(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
                  __le16 le16arg),