1/* SPDX-License-Identifier: GPL-2.0-only */
  2/******************************************************************************
  3 *
  4 * Copyright(c) 2009 - 2014 Intel Corporation. All rights reserved.
  5 * Copyright(C) 2016        Intel Deutschland GmbH
  6 * Copyright(c) 2018, 2023  Intel Corporation
  7 *****************************************************************************/
  8
  9#ifndef __IWLWIFI_DEVICE_TRACE
 10#define __IWLWIFI_DEVICE_TRACE
 11#include <linux/skbuff.h>
 12#include <linux/ieee80211.h>
 13#include <net/cfg80211.h>
 14#include <net/mac80211.h>
 15#include "iwl-trans.h"
 16static inline bool iwl_trace_data(struct sk_buff *skb)
 17{
 18	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 19	struct ieee80211_hdr *hdr = (void *)skb->data;
 20	__le16 fc = hdr->frame_control;
 21	int offs = 24; /* start with normal header length */
 22
 23	if (!ieee80211_is_data(fc))
 24		return false;
 25
 26	/* If upper layers wanted TX status it's an important frame */
 27	if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)
 28		return false;
 29
 30	/* Try to determine if the frame is EAPOL. This might have false
 31	 * positives (if there's no RFC 1042 header and we compare to some
 32	 * payload instead) but since we're only doing tracing that's not
 33	 * a problem.
 34	 */
 35
 36	if (ieee80211_has_a4(fc))
 37		offs += 6;
 38	if (ieee80211_is_data_qos(fc))
 39		offs += 2;
 40	/* don't account for crypto - these are unencrypted */
 41
 42	/* also account for the RFC 1042 header, of course */
 43	offs += 6;
 44
 45	return skb->len <= offs + 2 ||
 46		*(__be16 *)(skb->data + offs) != cpu_to_be16(ETH_P_PAE);
 47}
 48
 49static inline size_t iwl_rx_trace_len(const struct iwl_trans *trans,
 50				      void *rxbuf, size_t len,
 51				      size_t *out_hdr_offset)
 52{
 53	struct iwl_cmd_header *cmd = (void *)((u8 *)rxbuf + sizeof(__le32));
 54	struct ieee80211_hdr *hdr = NULL;
 55	size_t hdr_offset;
 56
 57	if (cmd->cmd != trans->rx_mpdu_cmd)
 58		return len;
 59
 60	hdr_offset = sizeof(struct iwl_cmd_header) +
 61		     trans->rx_mpdu_cmd_hdr_size;
 62
 63	if (out_hdr_offset)
 64		*out_hdr_offset = hdr_offset;
 65
 66	hdr = (void *)((u8 *)cmd + hdr_offset);
 67	if (!ieee80211_is_data(hdr->frame_control))
 68		return len;
 69	/* maybe try to identify EAPOL frames? */
 70	return sizeof(__le32) + sizeof(*cmd) + trans->rx_mpdu_cmd_hdr_size +
 71		ieee80211_hdrlen(hdr->frame_control);
 72}
 73
 74#include <linux/tracepoint.h>
 75#include <linux/device.h>
 76
 77
 78#if !defined(CONFIG_IWLWIFI_DEVICE_TRACING) || defined(__CHECKER__)
 79#undef TRACE_EVENT
 80#define TRACE_EVENT(name, proto, ...) \
 81static inline void trace_ ## name(proto) {}
 82#undef DECLARE_EVENT_CLASS
 83#define DECLARE_EVENT_CLASS(...)
 84#undef DEFINE_EVENT
 85#define DEFINE_EVENT(evt_class, name, proto, ...) \
 86static inline void trace_ ## name(proto) {}
 87#endif
 88
 89#define DEV_ENTRY	__string(dev, dev_name(dev))
 90#define DEV_ASSIGN	__assign_str(dev, dev_name(dev))
 91
 92#include "iwl-devtrace-io.h"
 93#include "iwl-devtrace-ucode.h"
 94#include "iwl-devtrace-msg.h"
 95#include "iwl-devtrace-data.h"
 96#include "iwl-devtrace-iwlwifi.h"
 97
 98#ifdef CONFIG_IWLWIFI_DEVICE_TRACING
 99DECLARE_TRACEPOINT(iwlwifi_dev_rx);
100DECLARE_TRACEPOINT(iwlwifi_dev_rx_data);
101#endif
102
103void __trace_iwlwifi_dev_rx(struct iwl_trans *trans, void *pkt, size_t len);
104
105static inline void maybe_trace_iwlwifi_dev_rx(struct iwl_trans *trans,
106					      void *pkt, size_t len)
107{
108#ifdef CONFIG_IWLWIFI_DEVICE_TRACING
109	if (tracepoint_enabled(iwlwifi_dev_rx) ||
110	    tracepoint_enabled(iwlwifi_dev_rx_data))
111		__trace_iwlwifi_dev_rx(trans, pkt, len);
112#endif
113}
114#endif /* __IWLWIFI_DEVICE_TRACE */