1*5113495bSYour Name /**
2*5113495bSYour Name * Copyright (c) 2013-2020, The Linux Foundation. All rights reserved.
3*5113495bSYour Name *
4*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for any
5*5113495bSYour Name * purpose with or without fee is hereby granted, provided that the above
6*5113495bSYour Name * copyright notice and this permission notice appear in all copies.
7*5113495bSYour Name *
8*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9*5113495bSYour Name * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10*5113495bSYour Name * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11*5113495bSYour Name * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12*5113495bSYour Name * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13*5113495bSYour Name * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14*5113495bSYour Name * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15*5113495bSYour Name */
16*5113495bSYour Name
17*5113495bSYour Name /* WIFI3 - Refers to platforms - 6290/6390/6490 */
18*5113495bSYour Name #include "pktlog_wifi3.h"
19*5113495bSYour Name
20*5113495bSYour Name #ifndef REMOVE_PKT_LOG
21*5113495bSYour Name A_STATUS
process_offload_pktlog_wifi3(struct cdp_pdev * pdev,void * data)22*5113495bSYour Name process_offload_pktlog_wifi3(struct cdp_pdev *pdev, void *data)
23*5113495bSYour Name {
24*5113495bSYour Name struct pktlog_dev_t *pl_dev = get_pktlog_handle();
25*5113495bSYour Name struct ath_pktlog_info *pl_info;
26*5113495bSYour Name struct ath_pktlog_hdr pl_hdr;
27*5113495bSYour Name uint32_t *pl_tgt_hdr;
28*5113495bSYour Name void *txdesc_hdr_ctl = NULL;
29*5113495bSYour Name size_t log_size = 0;
30*5113495bSYour Name
31*5113495bSYour Name if (!pl_dev) {
32*5113495bSYour Name QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
33*5113495bSYour Name "Invalid context in %s\n", __func__);
34*5113495bSYour Name return A_ERROR;
35*5113495bSYour Name }
36*5113495bSYour Name
37*5113495bSYour Name if (!data) {
38*5113495bSYour Name QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
39*5113495bSYour Name "Invalid data in %s\n", __func__);
40*5113495bSYour Name return A_ERROR;
41*5113495bSYour Name }
42*5113495bSYour Name
43*5113495bSYour Name pl_tgt_hdr = (uint32_t *)data;
44*5113495bSYour Name
45*5113495bSYour Name pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
46*5113495bSYour Name ATH_PKTLOG_HDR_FLAGS_MASK) >>
47*5113495bSYour Name ATH_PKTLOG_HDR_FLAGS_SHIFT;
48*5113495bSYour Name pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
49*5113495bSYour Name ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
50*5113495bSYour Name ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
51*5113495bSYour Name pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
52*5113495bSYour Name ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
53*5113495bSYour Name ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
54*5113495bSYour Name pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
55*5113495bSYour Name ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
56*5113495bSYour Name pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
57*5113495bSYour Name
58*5113495bSYour Name pktlog_hdr_set_specific_data(&pl_hdr,
59*5113495bSYour Name *(pl_tgt_hdr +
60*5113495bSYour Name ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET));
61*5113495bSYour Name if (pl_hdr.size > MAX_PKTLOG_RECV_BUF_SIZE) {
62*5113495bSYour Name pl_dev->invalid_packets++;
63*5113495bSYour Name return A_ERROR;
64*5113495bSYour Name }
65*5113495bSYour Name
66*5113495bSYour Name /*
67*5113495bSYour Name * Must include to process different types
68*5113495bSYour Name * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
69*5113495bSYour Name */
70*5113495bSYour Name pl_info = pl_dev->pl_info;
71*5113495bSYour Name log_size = pl_hdr.size;
72*5113495bSYour Name txdesc_hdr_ctl =
73*5113495bSYour Name (void *)pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
74*5113495bSYour Name if (!txdesc_hdr_ctl) {
75*5113495bSYour Name QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_ERROR,
76*5113495bSYour Name "Failed to allocate pktlog descriptor");
77*5113495bSYour Name return A_NO_MEMORY;
78*5113495bSYour Name }
79*5113495bSYour Name qdf_assert(txdesc_hdr_ctl);
80*5113495bSYour Name qdf_assert(pl_hdr->size < PKTLOG_MAX_TX_WORDS * sizeof(u_int32_t));
81*5113495bSYour Name qdf_mem_copy(txdesc_hdr_ctl,
82*5113495bSYour Name ((void *)data + sizeof(struct ath_pktlog_hdr)),
83*5113495bSYour Name pl_hdr.size);
84*5113495bSYour Name cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, txdesc_hdr_ctl);
85*5113495bSYour Name
86*5113495bSYour Name return A_OK;
87*5113495bSYour Name }
88*5113495bSYour Name
process_rx_desc_remote_wifi3(void * pdev,void * data)89*5113495bSYour Name int process_rx_desc_remote_wifi3(void *pdev, void *data)
90*5113495bSYour Name {
91*5113495bSYour Name struct pktlog_dev_t *pl_dev = get_pktlog_handle();
92*5113495bSYour Name struct ath_pktlog_hdr pl_hdr;
93*5113495bSYour Name struct ath_pktlog_rx_info rxstat_log;
94*5113495bSYour Name size_t log_size;
95*5113495bSYour Name struct ath_pktlog_info *pl_info;
96*5113495bSYour Name qdf_nbuf_t log_nbuf = (qdf_nbuf_t)data;
97*5113495bSYour Name
98*5113495bSYour Name if (!pl_dev) {
99*5113495bSYour Name qdf_err("Pktlog handle is NULL");
100*5113495bSYour Name return -EINVAL;
101*5113495bSYour Name }
102*5113495bSYour Name
103*5113495bSYour Name pl_info = pl_dev->pl_info;
104*5113495bSYour Name qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
105*5113495bSYour Name pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
106*5113495bSYour Name pl_hdr.missed_cnt = 0;
107*5113495bSYour Name pl_hdr.log_type = PKTLOG_TYPE_RX_STATBUF;
108*5113495bSYour Name pl_hdr.size = qdf_nbuf_len(log_nbuf);
109*5113495bSYour Name pl_hdr.timestamp = 0;
110*5113495bSYour Name log_size = pl_hdr.size;
111*5113495bSYour Name rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
112*5113495bSYour Name log_size, &pl_hdr);
113*5113495bSYour Name
114*5113495bSYour Name if (!rxstat_log.rx_desc) {
115*5113495bSYour Name QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
116*5113495bSYour Name "%s: Rx descriptor is NULL", __func__);
117*5113495bSYour Name return -EINVAL;
118*5113495bSYour Name }
119*5113495bSYour Name
120*5113495bSYour Name qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
121*5113495bSYour Name cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
122*5113495bSYour Name rxstat_log.rx_desc);
123*5113495bSYour Name return 0;
124*5113495bSYour Name }
125*5113495bSYour Name
126*5113495bSYour Name int
process_pktlog_lite_wifi3(void * context,void * log_data,uint16_t log_type)127*5113495bSYour Name process_pktlog_lite_wifi3(void *context, void *log_data,
128*5113495bSYour Name uint16_t log_type)
129*5113495bSYour Name {
130*5113495bSYour Name struct pktlog_dev_t *pl_dev = get_pktlog_handle();
131*5113495bSYour Name struct ath_pktlog_info *pl_info;
132*5113495bSYour Name struct ath_pktlog_hdr pl_hdr;
133*5113495bSYour Name struct ath_pktlog_rx_info rxstat_log;
134*5113495bSYour Name size_t log_size;
135*5113495bSYour Name qdf_nbuf_t log_nbuf = (qdf_nbuf_t)log_data;
136*5113495bSYour Name
137*5113495bSYour Name if (!pl_dev) {
138*5113495bSYour Name qdf_err("Pktlog handle is NULL");
139*5113495bSYour Name return -EINVAL;
140*5113495bSYour Name }
141*5113495bSYour Name
142*5113495bSYour Name pl_info = pl_dev->pl_info;
143*5113495bSYour Name qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
144*5113495bSYour Name pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
145*5113495bSYour Name pl_hdr.missed_cnt = 0;
146*5113495bSYour Name pl_hdr.log_type = log_type;
147*5113495bSYour Name pl_hdr.size = qdf_nbuf_len(log_nbuf);
148*5113495bSYour Name pl_hdr.timestamp = 0;
149*5113495bSYour Name log_size = pl_hdr.size;
150*5113495bSYour Name rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
151*5113495bSYour Name log_size, &pl_hdr);
152*5113495bSYour Name if (!rxstat_log.rx_desc) {
153*5113495bSYour Name QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
154*5113495bSYour Name "%s: Rx descriptor is NULL", __func__);
155*5113495bSYour Name return -EINVAL;
156*5113495bSYour Name }
157*5113495bSYour Name
158*5113495bSYour Name qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
159*5113495bSYour Name
160*5113495bSYour Name cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
161*5113495bSYour Name return 0;
162*5113495bSYour Name }
163*5113495bSYour Name #endif /* REMOVE_PKT_LOG */
164