1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved.
3*5113495bSYour Name *
4*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for
5*5113495bSYour Name * any purpose with or without fee is hereby granted, provided that the
6*5113495bSYour Name * above copyright notice and this permission notice appear in all
7*5113495bSYour Name * copies.
8*5113495bSYour Name *
9*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10*5113495bSYour Name * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11*5113495bSYour Name * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12*5113495bSYour Name * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13*5113495bSYour Name * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14*5113495bSYour Name * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15*5113495bSYour Name * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16*5113495bSYour Name * PERFORMANCE OF THIS SOFTWARE.
17*5113495bSYour Name */
18*5113495bSYour Name
19*5113495bSYour Name #include <qdf_tracepoint.h>
20*5113495bSYour Name
21*5113495bSYour Name #define CREATE_TRACE_POINTS
22*5113495bSYour Name #include "qdf_tracepoint_defs.h"
23*5113495bSYour Name
24*5113495bSYour Name #ifdef WLAN_TRACEPOINTS
qdf_trace_dp_tx_ip_packet(qdf_nbuf_t nbuf,uint8_t * trans_hdr,uint8_t ip_proto,uint16_t ip_id,struct qdf_tso_seg_elem_t * tso_desc,uint64_t latency)25*5113495bSYour Name static void qdf_trace_dp_tx_ip_packet(qdf_nbuf_t nbuf, uint8_t *trans_hdr,
26*5113495bSYour Name uint8_t ip_proto, uint16_t ip_id,
27*5113495bSYour Name struct qdf_tso_seg_elem_t *tso_desc,
28*5113495bSYour Name uint64_t latency)
29*5113495bSYour Name {
30*5113495bSYour Name if (ip_proto == QDF_NBUF_TRAC_TCP_TYPE &&
31*5113495bSYour Name __qdf_trace_dp_tx_comp_tcp_pkt_enabled()) {
32*5113495bSYour Name qdf_net_tcphdr_t *tcph = (qdf_net_tcphdr_t *)trans_hdr;
33*5113495bSYour Name uint32_t tcp_seq;
34*5113495bSYour Name
35*5113495bSYour Name if (tso_desc)
36*5113495bSYour Name tcp_seq = tso_desc->seg.tso_flags.tcp_seq_num;
37*5113495bSYour Name else
38*5113495bSYour Name tcp_seq = qdf_ntohl(tcph->seq);
39*5113495bSYour Name
40*5113495bSYour Name __qdf_trace_dp_tx_comp_tcp_pkt(nbuf, tcp_seq,
41*5113495bSYour Name qdf_ntohl(tcph->ack_seq),
42*5113495bSYour Name qdf_ntohs(tcph->source),
43*5113495bSYour Name qdf_ntohs(tcph->dest),
44*5113495bSYour Name latency);
45*5113495bSYour Name } else if (ip_proto == QDF_NBUF_TRAC_UDP_TYPE &&
46*5113495bSYour Name __qdf_trace_dp_tx_comp_udp_pkt_enabled()) {
47*5113495bSYour Name qdf_net_udphdr_t *udph = (qdf_net_udphdr_t *)trans_hdr;
48*5113495bSYour Name
49*5113495bSYour Name __qdf_trace_dp_tx_comp_udp_pkt(nbuf, qdf_ntohs(ip_id),
50*5113495bSYour Name qdf_ntohs(udph->src_port),
51*5113495bSYour Name qdf_ntohs(udph->dst_port),
52*5113495bSYour Name latency);
53*5113495bSYour Name } else if (__qdf_trace_dp_tx_comp_generic_ip_pkt_enabled()) {
54*5113495bSYour Name __qdf_trace_dp_tx_comp_generic_ip_pkt(nbuf, ip_proto, ip_id,
55*5113495bSYour Name QDF_SWAP_U32(*(uint32_t *)trans_hdr),
56*5113495bSYour Name latency);
57*5113495bSYour Name }
58*5113495bSYour Name }
59*5113495bSYour Name
qdf_trace_dp_rx_ip_packet(qdf_nbuf_t nbuf,uint8_t * trans_hdr,uint8_t ip_proto,uint16_t ip_id,uint64_t latency)60*5113495bSYour Name static void qdf_trace_dp_rx_ip_packet(qdf_nbuf_t nbuf, uint8_t *trans_hdr,
61*5113495bSYour Name uint8_t ip_proto, uint16_t ip_id,
62*5113495bSYour Name uint64_t latency)
63*5113495bSYour Name {
64*5113495bSYour Name if (ip_proto == QDF_NBUF_TRAC_TCP_TYPE &&
65*5113495bSYour Name __qdf_trace_dp_rx_tcp_pkt_enabled()) {
66*5113495bSYour Name qdf_net_tcphdr_t *tcph = (qdf_net_tcphdr_t *)trans_hdr;
67*5113495bSYour Name
68*5113495bSYour Name __qdf_trace_dp_rx_tcp_pkt(nbuf, qdf_ntohl(tcph->seq),
69*5113495bSYour Name qdf_ntohl(tcph->ack_seq),
70*5113495bSYour Name qdf_ntohs(tcph->source),
71*5113495bSYour Name qdf_ntohs(tcph->dest),
72*5113495bSYour Name latency);
73*5113495bSYour Name } else if (ip_proto == QDF_NBUF_TRAC_UDP_TYPE &&
74*5113495bSYour Name __qdf_trace_dp_rx_udp_pkt_enabled()) {
75*5113495bSYour Name qdf_net_udphdr_t *udph = (qdf_net_udphdr_t *)trans_hdr;
76*5113495bSYour Name
77*5113495bSYour Name __qdf_trace_dp_rx_udp_pkt(nbuf, qdf_ntohs(ip_id),
78*5113495bSYour Name qdf_ntohs(udph->src_port),
79*5113495bSYour Name qdf_ntohs(udph->dst_port),
80*5113495bSYour Name latency);
81*5113495bSYour Name } else if (__qdf_trace_dp_rx_generic_ip_pkt_enabled()) {
82*5113495bSYour Name __qdf_trace_dp_rx_generic_ip_pkt(nbuf, ip_proto, ip_id,
83*5113495bSYour Name QDF_SWAP_U32(*(uint32_t *)trans_hdr),
84*5113495bSYour Name latency);
85*5113495bSYour Name }
86*5113495bSYour Name }
87*5113495bSYour Name
qdf_trace_dp_packet(qdf_nbuf_t nbuf,enum qdf_proto_dir dir,struct qdf_tso_seg_elem_t * tso_desc,uint64_t enq_time)88*5113495bSYour Name void qdf_trace_dp_packet(qdf_nbuf_t nbuf, enum qdf_proto_dir dir,
89*5113495bSYour Name struct qdf_tso_seg_elem_t *tso_desc, uint64_t enq_time)
90*5113495bSYour Name {
91*5113495bSYour Name uint8_t *data = qdf_nbuf_data(nbuf);
92*5113495bSYour Name uint64_t latency;
93*5113495bSYour Name uint16_t ether_type;
94*5113495bSYour Name uint8_t ip_offset = QDF_NBUF_TRAC_IP_OFFSET;
95*5113495bSYour Name
96*5113495bSYour Name if (dir == QDF_TX)
97*5113495bSYour Name latency = (qdf_ktime_to_us(qdf_ktime_real_get()) - enq_time);
98*5113495bSYour Name else
99*5113495bSYour Name latency = qdf_nbuf_get_timedelta_us(nbuf);
100*5113495bSYour Name
101*5113495bSYour Name ether_type = QDF_SWAP_U16(*(uint16_t *)(data +
102*5113495bSYour Name QDF_NBUF_TRAC_ETH_TYPE_OFFSET));
103*5113495bSYour Name
104*5113495bSYour Name if (unlikely(ether_type == QDF_ETH_TYPE_8021Q)) {
105*5113495bSYour Name ether_type = QDF_SWAP_U16(*(uint16_t *)(data +
106*5113495bSYour Name QDF_NBUF_TRAC_VLAN_ETH_TYPE_OFFSET));
107*5113495bSYour Name ip_offset = QDF_NBUF_TRAC_VLAN_IP_OFFSET;
108*5113495bSYour Name } else if (unlikely(ether_type == QDF_ETH_TYPE_8021AD)) {
109*5113495bSYour Name ether_type = QDF_SWAP_U16(*(uint16_t *)(data +
110*5113495bSYour Name QDF_NBUF_TRAC_DOUBLE_VLAN_ETH_TYPE_OFFSET));
111*5113495bSYour Name ip_offset = QDF_NBUF_TRAC_DOUBLE_VLAN_IP_OFFSET;
112*5113495bSYour Name }
113*5113495bSYour Name
114*5113495bSYour Name switch (ether_type) {
115*5113495bSYour Name case QDF_NBUF_TRAC_IPV4_ETH_TYPE:
116*5113495bSYour Name case QDF_NBUF_TRAC_IPV6_ETH_TYPE:
117*5113495bSYour Name {
118*5113495bSYour Name uint8_t *net_hdr;
119*5113495bSYour Name uint8_t *trans_hdr;
120*5113495bSYour Name uint8_t ip_proto;
121*5113495bSYour Name uint16_t ip_id = 0;
122*5113495bSYour Name
123*5113495bSYour Name net_hdr = data + ip_offset;
124*5113495bSYour Name
125*5113495bSYour Name if (ether_type == QDF_NBUF_TRAC_IPV4_ETH_TYPE) {
126*5113495bSYour Name ip_proto = ((qdf_net_iphdr_t *)net_hdr)->ip_proto;
127*5113495bSYour Name ip_id = ((qdf_net_iphdr_t *)net_hdr)->ip_id;
128*5113495bSYour Name trans_hdr = net_hdr + QDF_NBUF_TRAC_IPV4_HEADER_SIZE;
129*5113495bSYour Name } else {
130*5113495bSYour Name ip_proto = ((qdf_net_ipv6hdr_t *)net_hdr)->ipv6_nexthdr;
131*5113495bSYour Name trans_hdr = net_hdr + QDF_NBUF_TRAC_IPV6_HEADER_SIZE;
132*5113495bSYour Name }
133*5113495bSYour Name
134*5113495bSYour Name if (dir == QDF_TX)
135*5113495bSYour Name qdf_trace_dp_tx_ip_packet(nbuf, trans_hdr, ip_proto,
136*5113495bSYour Name ip_id, tso_desc, latency);
137*5113495bSYour Name else
138*5113495bSYour Name qdf_trace_dp_rx_ip_packet(nbuf, trans_hdr, ip_proto,
139*5113495bSYour Name ip_id, latency);
140*5113495bSYour Name
141*5113495bSYour Name break;
142*5113495bSYour Name }
143*5113495bSYour Name default:
144*5113495bSYour Name if (dir == QDF_TX && __qdf_trace_dp_tx_comp_pkt_enabled())
145*5113495bSYour Name __qdf_trace_dp_tx_comp_pkt(nbuf, ether_type, latency);
146*5113495bSYour Name else if (__qdf_trace_dp_rx_pkt_enabled())
147*5113495bSYour Name __qdf_trace_dp_rx_pkt(nbuf, ether_type, latency);
148*5113495bSYour Name
149*5113495bSYour Name break;
150*5113495bSYour Name }
151*5113495bSYour Name }
152*5113495bSYour Name #endif
153