cfg80211: Provide an API to report NAN function termination

Provide a function that reports NAN DE function termination. The function
may be terminated due to one of the following reasons: user request,
ttl expiration or failure.
If the NAN instance is tied to the owner, the notification will be
sent to the socket that started the NAN interface only

Signed-off-by: Andrei Otcheretianski <andrei.otcheretianski@intel.com>
Signed-off-by: Emmanuel Grumbach <emmanuel.grumbach@intel.com>
Signed-off-by: Luca Coelho <luciano.coelho@intel.com>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>

1 files changed, 60 insertions, 0 deletions

diff --git a/net/wireless/nl80211.c b/net/wireless/nl80211.c
index 0bbd9ed28318..92eb6f0b9f3d 100644
--- a/net/wireless/nl80211.c
+++ b/net/wireless/nl80211.c
@@ -11033,6 +11033,66 @@ nla_put_failure:
 }
 EXPORT_SYMBOL(cfg80211_nan_match);
 
+void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
+                                  u8 inst_id,
+                                  enum nl80211_nan_func_term_reason reason,
+                                  u64 cookie, gfp_t gfp)
+{
+        struct wiphy *wiphy = wdev->wiphy;
+        struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
+        struct sk_buff *msg;
+        struct nlattr *func_attr;
+        void *hdr;
+
+        if (WARN_ON(!inst_id))
+                return;
+
+        msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
+        if (!msg)
+                return;
+
+        hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
+        if (!hdr) {
+                nlmsg_free(msg);
+                return;
+        }
+
+        if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
+            (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
+                                         wdev->netdev->ifindex)) ||
+            nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
+                              NL80211_ATTR_PAD))
+                goto nla_put_failure;
+
+        if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
+                              NL80211_ATTR_PAD))
+                goto nla_put_failure;
+
+        func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
+        if (!func_attr)
+                goto nla_put_failure;
+
+        if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
+            nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
+                goto nla_put_failure;
+
+        nla_nest_end(msg, func_attr);
+        genlmsg_end(msg, hdr);
+
+        if (!wdev->owner_nlportid)
+                genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
+                                        msg, 0, NL80211_MCGRP_NAN, gfp);
+        else
+                genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
+                                wdev->owner_nlportid);
+
+        return;
+
+nla_put_failure:
+        nlmsg_free(msg);
+}
+EXPORT_SYMBOL(cfg80211_nan_func_terminated);
+
 static int nl80211_get_protocol_features(struct sk_buff *skb,
                                          struct genl_info *info)
 {