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"
iwl_trace_data(struct sk_buff * skb)16 static 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 
iwl_rx_trace_len(const struct iwl_trans * trans,void * rxbuf,size_t len,size_t * out_hdr_offset)49 static 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, ...) \
81 static 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, ...) \
86 static inline void trace_ ## name(proto) {}
87 #endif
88 
89 #define DEV_ENTRY	__string(dev, dev_name(dev))
90 #define DEV_ASSIGN	__assign_str(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
99 DECLARE_TRACEPOINT(iwlwifi_dev_rx);
100 DECLARE_TRACEPOINT(iwlwifi_dev_rx_data);
101 #endif
102 
103 void __trace_iwlwifi_dev_rx(struct iwl_trans *trans, void *pkt, size_t len);
104 
maybe_trace_iwlwifi_dev_rx(struct iwl_trans * trans,void * pkt,size_t len)105 static 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 */
115