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        Intel Corporation
7  *****************************************************************************/
8 
9 #ifndef __IWLWIFI_DEVICE_TRACE
10 #include <linux/skbuff.h>
11 #include <linux/ieee80211.h>
12 #include <net/cfg80211.h>
13 #include "iwl-trans.h"
14 #if !defined(__IWLWIFI_DEVICE_TRACE)
15 static inline bool iwl_trace_data(struct sk_buff *skb)
16 {
17 	struct ieee80211_hdr *hdr = (void *)skb->data;
18 	__le16 fc = hdr->frame_control;
19 	int offs = 24; /* start with normal header length */
20 
21 	if (!ieee80211_is_data(fc))
22 		return false;
23 
24 	/* Try to determine if the frame is EAPOL. This might have false
25 	 * positives (if there's no RFC 1042 header and we compare to some
26 	 * payload instead) but since we're only doing tracing that's not
27 	 * a problem.
28 	 */
29 
30 	if (ieee80211_has_a4(fc))
31 		offs += 6;
32 	if (ieee80211_is_data_qos(fc))
33 		offs += 2;
34 	/* don't account for crypto - these are unencrypted */
35 
36 	/* also account for the RFC 1042 header, of course */
37 	offs += 6;
38 
39 	return skb->len <= offs + 2 ||
40 		*(__be16 *)(skb->data + offs) != cpu_to_be16(ETH_P_PAE);
41 }
42 
43 static inline size_t iwl_rx_trace_len(const struct iwl_trans *trans,
44 				      void *rxbuf, size_t len,
45 				      size_t *out_hdr_offset)
46 {
47 	struct iwl_cmd_header *cmd = (void *)((u8 *)rxbuf + sizeof(__le32));
48 	struct ieee80211_hdr *hdr = NULL;
49 	size_t hdr_offset;
50 
51 	if (cmd->cmd != trans->rx_mpdu_cmd)
52 		return len;
53 
54 	hdr_offset = sizeof(struct iwl_cmd_header) +
55 		     trans->rx_mpdu_cmd_hdr_size;
56 
57 	if (out_hdr_offset)
58 		*out_hdr_offset = hdr_offset;
59 
60 	hdr = (void *)((u8 *)cmd + hdr_offset);
61 	if (!ieee80211_is_data(hdr->frame_control))
62 		return len;
63 	/* maybe try to identify EAPOL frames? */
64 	return sizeof(__le32) + sizeof(*cmd) + trans->rx_mpdu_cmd_hdr_size +
65 		ieee80211_hdrlen(hdr->frame_control);
66 }
67 #endif
68 
69 #define __IWLWIFI_DEVICE_TRACE
70 
71 #include <linux/tracepoint.h>
72 #include <linux/device.h>
73 
74 
75 #if !defined(CONFIG_IWLWIFI_DEVICE_TRACING) || defined(__CHECKER__)
76 #undef TRACE_EVENT
77 #define TRACE_EVENT(name, proto, ...) \
78 static inline void trace_ ## name(proto) {}
79 #undef DECLARE_EVENT_CLASS
80 #define DECLARE_EVENT_CLASS(...)
81 #undef DEFINE_EVENT
82 #define DEFINE_EVENT(evt_class, name, proto, ...) \
83 static inline void trace_ ## name(proto) {}
84 #endif
85 
86 #define DEV_ENTRY	__string(dev, dev_name(dev))
87 #define DEV_ASSIGN	__assign_str(dev, dev_name(dev))
88 
89 #include "iwl-devtrace-io.h"
90 #include "iwl-devtrace-ucode.h"
91 #include "iwl-devtrace-msg.h"
92 #include "iwl-devtrace-data.h"
93 #include "iwl-devtrace-iwlwifi.h"
94 
95 #endif /* __IWLWIFI_DEVICE_TRACE */
96