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(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, 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