cfg80211/mac80211: support reporting wakeup reason

When waking up from WoWLAN, it is useful to know
what triggered the wakeup. Support reporting the
wakeup reason(s) in cfg80211 (and a pass-through
in mac80211) to allow userspace to know.

Signed-off-by: Johannes Berg <johannes.berg@intel.com>

3 files changed, 142 insertions, 0 deletions

diff --git a/net/mac80211/pm.c b/net/mac80211/pm.c
index e45b83610e85..53801d20176d 100644
--- a/net/mac80211/pm.c
+++ b/net/mac80211/pm.c
@@ -228,3 +228,13 @@ int __ieee80211_suspend(struct ieee80211_hw *hw, struct cfg80211_wowlan *wowlan)
  * ieee80211_reconfig(), which is also needed for hardware
  * hang/firmware failure/etc. recovery.
  */
+
+void ieee80211_report_wowlan_wakeup(struct ieee80211_vif *vif,
+                                    struct cfg80211_wowlan_wakeup *wakeup,
+                                    gfp_t gfp)
+{
+        struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
+
+        cfg80211_report_wowlan_wakeup(&sdata->wdev, wakeup, gfp);
+}
+EXPORT_SYMBOL(ieee80211_report_wowlan_wakeup);
diff --git a/net/wireless/nl80211.c b/net/wireless/nl80211.c
index b5978ab4ad7a..d359734b6972 100644
--- a/net/wireless/nl80211.c
+++ b/net/wireless/nl80211.c
@@ -9323,6 +9323,103 @@ void cfg80211_report_obss_beacon(struct wiphy *wiphy,
 }
 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
 
+#ifdef CONFIG_PM
+void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
+                                   struct cfg80211_wowlan_wakeup *wakeup,
+                                   gfp_t gfp)
+{
+        struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
+        struct sk_buff *msg;
+        void *hdr;
+        int err, size = 200;
+
+        trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
+
+        if (wakeup)
+                size += wakeup->packet_present_len;
+
+        msg = nlmsg_new(size, gfp);
+        if (!msg)
+                return;
+
+        hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
+        if (!hdr)
+                goto free_msg;
+
+        if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
+            nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
+                goto free_msg;
+
+        if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
+                                        wdev->netdev->ifindex))
+                goto free_msg;
+
+        if (wakeup) {
+                struct nlattr *reasons;
+
+                reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
+
+                if (wakeup->disconnect &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
+                        goto free_msg;
+                if (wakeup->magic_pkt &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
+                        goto free_msg;
+                if (wakeup->gtk_rekey_failure &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
+                        goto free_msg;
+                if (wakeup->eap_identity_req &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
+                        goto free_msg;
+                if (wakeup->four_way_handshake &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
+                        goto free_msg;
+                if (wakeup->rfkill_release &&
+                    nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
+                        goto free_msg;
+
+                if (wakeup->pattern_idx >= 0 &&
+                    nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
+                                wakeup->pattern_idx))
+                        goto free_msg;
+
+                if (wakeup->packet) {
+                        u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
+                        u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
+
+                        if (!wakeup->packet_80211) {
+                                pkt_attr =
+                                        NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
+                                len_attr =
+                                        NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
+                        }
+
+                        if (wakeup->packet_len &&
+                            nla_put_u32(msg, len_attr, wakeup->packet_len))
+                                goto free_msg;
+
+                        if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
+                                    wakeup->packet))
+                                goto free_msg;
+                }
+
+                nla_nest_end(msg, reasons);
+        }
+
+        err = genlmsg_end(msg, hdr);
+        if (err < 0)
+                goto free_msg;
+
+        genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
+                                nl80211_mlme_mcgrp.id, gfp);
+        return;
+
+ free_msg:
+        nlmsg_free(msg);
+}
+EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
+#endif
+
 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
                                 enum nl80211_tdls_operation oper,
                                 u16 reason_code, gfp_t gfp)
diff --git a/net/wireless/trace.h b/net/wireless/trace.h
index 8bc553199686..c9cafb0ea95f 100644
--- a/net/wireless/trace.h
+++ b/net/wireless/trace.h
@@ -2333,6 +2333,41 @@ TRACE_EVENT(cfg80211_return_u32,
         TP_printk("ret: %u", __entry->ret)
 );
 
+TRACE_EVENT(cfg80211_report_wowlan_wakeup,
+        TP_PROTO(struct wiphy *wiphy, struct wireless_dev *wdev,
+                 struct cfg80211_wowlan_wakeup *wakeup),
+        TP_ARGS(wiphy, wdev, wakeup),
+        TP_STRUCT__entry(
+                WIPHY_ENTRY
+                WDEV_ENTRY
+                __field(bool, disconnect)
+                __field(bool, magic_pkt)
+                __field(bool, gtk_rekey_failure)
+                __field(bool, eap_identity_req)
+                __field(bool, four_way_handshake)
+                __field(bool, rfkill_release)
+                __field(s32, pattern_idx)
+                __field(u32, packet_len)
+                __dynamic_array(u8, packet, wakeup->packet_present_len)
+        ),
+        TP_fast_assign(
+                WIPHY_ASSIGN;
+                WDEV_ASSIGN;
+                __entry->disconnect = wakeup->disconnect;
+                __entry->magic_pkt = wakeup->magic_pkt;
+                __entry->gtk_rekey_failure = wakeup->gtk_rekey_failure;
+                __entry->eap_identity_req = wakeup->eap_identity_req;
+                __entry->four_way_handshake = wakeup->four_way_handshake;
+                __entry->rfkill_release = wakeup->rfkill_release;
+                __entry->pattern_idx = wakeup->pattern_idx;
+                __entry->packet_len = wakeup->packet_len;
+                if (wakeup->packet && wakeup->packet_present_len)
+                        memcpy(__get_dynamic_array(packet), wakeup->packet,
+                               wakeup->packet_present_len);
+        ),
+        TP_printk(WIPHY_PR_FMT ", " WDEV_PR_FMT, WIPHY_PR_ARG, WDEV_PR_ARG)
+);
+
 #endif /* !__RDEV_OPS_TRACE || TRACE_HEADER_MULTI_READ */
 
 #undef TRACE_INCLUDE_PATH