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" |
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 | |
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(fc: 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(fc: 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, 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 |
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 | |
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 | |