123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716 |
- /*
- * Copyright (c) 2013-2020 The Linux Foundation. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for
- * any purpose with or without fee is hereby granted, provided that the
- * above copyright notice and this permission notice appear in all
- * copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
- * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
- * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
- * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
- * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
- * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
- * PERFORMANCE OF THIS SOFTWARE.
- */
- /*
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
- #ifndef REMOVE_PKT_LOG
- #include "ol_txrx_types.h"
- #include "ol_htt_tx_api.h"
- #include "ol_tx_desc.h"
- #include "qdf_mem.h"
- #include "htt.h"
- #include "htt_internal.h"
- #include "pktlog_ac_i.h"
- #include "wma_api.h"
- #include "wlan_logging_sock_svc.h"
- #ifdef PKTLOG_HAS_SPECIFIC_DATA
- static inline void
- pktlog_hdr_set_specific_data(struct ath_pktlog_hdr *log_hdr,
- uint32_t type_specific_data)
- {
- log_hdr->type_specific_data = type_specific_data;
- }
- static inline uint32_t
- pktlog_hdr_get_specific_data(struct ath_pktlog_hdr *log_hdr)
- {
- return log_hdr->type_specific_data;
- }
- static inline void
- pktlog_arg_set_specific_data(struct ath_pktlog_arg *plarg,
- uint32_t type_specific_data)
- {
- plarg->type_specific_data = type_specific_data;
- }
- static inline uint32_t
- pktlog_arg_get_specific_data(struct ath_pktlog_arg *plarg)
- {
- return plarg->type_specific_data;
- }
- #else
- static inline void
- pktlog_hdr_set_specific_data(struct ath_pktlog_hdr *log_hdr,
- uint32_t type_specific_data)
- {
- }
- static inline uint32_t
- pktlog_hdr_get_specific_data(struct ath_pktlog_hdr *log_hdr)
- {
- return 0;
- }
- static inline void
- pktlog_arg_set_specific_data(struct ath_pktlog_arg *plarg,
- uint32_t type_specific_data)
- {
- }
- static inline uint32_t
- pktlog_arg_get_specific_data(struct ath_pktlog_arg *plarg)
- {
- return 0;
- }
- #endif /* PKTLOG_HAS_SPECIFIC_DATA */
- void pktlog_getbuf_intsafe(struct ath_pktlog_arg *plarg)
- {
- struct ath_pktlog_buf *log_buf;
- int32_t buf_size;
- struct ath_pktlog_hdr *log_hdr;
- int32_t cur_wr_offset;
- char *log_ptr;
- struct ath_pktlog_info *pl_info;
- uint16_t log_type;
- size_t log_size;
- uint32_t flags;
- #ifdef HELIUMPLUS
- uint8_t mac_id;
- #endif
- if (!plarg) {
- qdf_nofl_info("Invalid parg in %s", __func__);
- return;
- }
- pl_info = plarg->pl_info;
- #ifdef HELIUMPLUS
- mac_id = plarg->macId;
- log_type = plarg->log_type;
- #else
- log_type = plarg->log_type;
- #endif
- log_size = plarg->log_size;
- log_buf = pl_info->buf;
- flags = plarg->flags;
- if (!log_buf) {
- qdf_nofl_info("Invalid log_buf in %s", __func__);
- return;
- }
- buf_size = pl_info->buf_size;
- cur_wr_offset = log_buf->wr_offset;
- /* Move read offset to the next entry if there is a buffer overlap */
- if (log_buf->rd_offset >= 0) {
- if ((cur_wr_offset <= log_buf->rd_offset)
- && (cur_wr_offset + sizeof(struct ath_pktlog_hdr)) >
- log_buf->rd_offset) {
- PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf,
- buf_size);
- }
- } else {
- log_buf->rd_offset = cur_wr_offset;
- }
- log_hdr = (struct ath_pktlog_hdr *)(log_buf->log_data + cur_wr_offset);
- log_hdr->flags = flags;
- #ifdef HELIUMPLUS
- log_hdr->macId = mac_id;
- log_hdr->log_type = log_type;
- #else
- log_hdr->log_type = log_type;
- #endif
- log_hdr->size = (uint16_t) log_size;
- log_hdr->missed_cnt = plarg->missed_cnt;
- log_hdr->timestamp = plarg->timestamp;
- pktlog_hdr_set_specific_data(log_hdr,
- pktlog_arg_get_specific_data(plarg));
- cur_wr_offset += sizeof(*log_hdr);
- if ((buf_size - cur_wr_offset) < log_size) {
- while ((cur_wr_offset <= log_buf->rd_offset)
- && (log_buf->rd_offset < buf_size)) {
- PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf,
- buf_size);
- }
- cur_wr_offset = 0;
- }
- while ((cur_wr_offset <= log_buf->rd_offset)
- && (cur_wr_offset + log_size) > log_buf->rd_offset) {
- PKTLOG_MOV_RD_IDX(log_buf->rd_offset, log_buf, buf_size);
- }
- log_ptr = &(log_buf->log_data[cur_wr_offset]);
- cur_wr_offset += log_hdr->size;
- log_buf->wr_offset = ((buf_size - cur_wr_offset) >=
- sizeof(struct ath_pktlog_hdr)) ? cur_wr_offset :
- 0;
- plarg->buf = log_ptr;
- }
- char *pktlog_getbuf(struct pktlog_dev_t *pl_dev,
- struct ath_pktlog_info *pl_info,
- size_t log_size, struct ath_pktlog_hdr *pl_hdr)
- {
- struct ath_pktlog_arg plarg = { 0, };
- uint8_t flags = 0;
- plarg.pl_info = pl_info;
- #ifdef HELIUMPLUS
- plarg.macId = pl_hdr->macId;
- plarg.log_type = pl_hdr->log_type;
- #else
- plarg.log_type = pl_hdr->log_type;
- #endif
- plarg.log_size = log_size;
- plarg.flags = pl_hdr->flags;
- plarg.missed_cnt = pl_hdr->missed_cnt;
- plarg.timestamp = pl_hdr->timestamp;
- pktlog_arg_set_specific_data(&plarg,
- pktlog_hdr_get_specific_data(pl_hdr));
- if (flags & PHFLAGS_INTERRUPT_CONTEXT) {
- /*
- * We are already in interrupt context, no need to make it
- * intsafe. call the function directly.
- */
- pktlog_getbuf_intsafe(&plarg);
- } else {
- PKTLOG_LOCK(pl_info);
- pktlog_getbuf_intsafe(&plarg);
- PKTLOG_UNLOCK(pl_info);
- }
- return plarg.buf;
- }
- #ifdef HELIUMPLUS
- A_STATUS process_rate_find(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- size_t log_size;
- uint32_t len;
- struct ol_fw_data *fw_data;
- /*
- * Will be uncommented when the rate control find
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- struct ath_pktlog_rc_find rcf_log;
- uint32_t *pl_tgt_hdr;
- if (!pdev || !data || !pl_dev) {
- qdf_print("%s: Invalid handle", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
- ATH_PKTLOG_HDR_MAC_ID_MASK) >>
- ATH_PKTLOG_HDR_MAC_ID_SHIFT;
- pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- pl_info = pl_dev->pl_info;
- log_size = pl_hdr.size;
- rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(rcf_log.rcFind,
- ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
- return A_OK;
- }
- #else
- A_STATUS process_rate_find(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- size_t log_size;
- uint32_t len;
- struct ol_fw_data *fw_data;
- /*
- * Will be uncommented when the rate control find
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- struct ath_pktlog_rc_find rcf_log;
- uint32_t *pl_tgt_hdr;
- if (!pdev || !data || !pl_dev) {
- qdf_print("%s: Invalid handle", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- pl_info = pl_dev->pl_info;
- log_size = pl_hdr.size;
- rcf_log.rcFind = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(rcf_log.rcFind,
- ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcf_log.rcFind);
- return A_OK;
- }
- #endif
- #ifdef HELIUMPLUS
- A_STATUS process_sw_event(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- size_t log_size;
- uint32_t len;
- struct ol_fw_data *fw_data;
- /*
- * Will be uncommented when the rate control find
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- struct ath_pktlog_sw_event sw_event;
- uint32_t *pl_tgt_hdr;
- if (!pdev) {
- qdf_print("Invalid pdev in %s", __func__);
- return A_ERROR;
- }
- if (!data) {
- qdf_print("Invalid data in %s", __func__);
- return A_ERROR;
- }
- if (!pl_dev) {
- qdf_print("Invalid pl_dev in %s", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
- ATH_PKTLOG_HDR_MAC_ID_MASK) >>
- ATH_PKTLOG_HDR_MAC_ID_SHIFT;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- pl_hdr.type_specific_data =
- *(pl_tgt_hdr + ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET);
- pl_info = pl_dev->pl_info;
- log_size = pl_hdr.size;
- sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(sw_event.sw_event,
- ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, sw_event.sw_event);
- return A_OK;
- }
- #else
- A_STATUS process_sw_event(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- size_t log_size;
- uint32_t len;
- struct ol_fw_data *fw_data;
- /*
- * Will be uncommented when the rate control find
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- struct ath_pktlog_sw_event sw_event;
- uint32_t *pl_tgt_hdr;
- if (!pdev) {
- qdf_print("Invalid pdev in %s", __func__);
- return A_ERROR;
- }
- if (!data) {
- qdf_print("Invalid data in %s", __func__);
- return A_ERROR;
- }
- if (!pl_dev) {
- qdf_print("Invalid pl_dev in %s", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- pktlog_hdr_set_specific_data(&pl_hdr,
- *(pl_tgt_hdr +
- ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET));
- pl_info = pl_dev->pl_info;
- log_size = pl_hdr.size;
- sw_event.sw_event = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(sw_event.sw_event,
- ((char *)fw_data->data + sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, sw_event.sw_event);
- return A_OK;
- }
- #endif
- #ifdef HELIUMPLUS
- A_STATUS process_rate_update(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- size_t log_size;
- struct ath_pktlog_info *pl_info;
- struct ath_pktlog_rc_update rcu_log;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!pdev || !data || !pl_dev) {
- qdf_print("%s: Invalid handle", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MAC_ID_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.macId = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MAC_ID_OFFSET) &
- ATH_PKTLOG_HDR_MAC_ID_MASK) >>
- ATH_PKTLOG_HDR_MAC_ID_SHIFT;
- pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- log_size = pl_hdr.size;
- pl_info = pl_dev->pl_info;
- /*
- * Will be uncommented when the rate control update
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(rcu_log.txRateCtrl,
- ((char *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
- return A_OK;
- }
- #else
- A_STATUS process_rate_update(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- size_t log_size;
- struct ath_pktlog_info *pl_info;
- struct ath_pktlog_rc_update rcu_log;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!pdev || !data || !pl_dev) {
- qdf_print("%s: Invalid handle", __func__);
- return A_ERROR;
- }
- fw_data = (struct ol_fw_data *)data;
- len = fw_data->len;
- if (len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_FLAGS_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_MISSED_CNT_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_LOG_TYPE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_SIZE_OFFSET + 1)) ||
- len < (sizeof(uint32_t) *
- (ATH_PKTLOG_HDR_TYPE_SPECIFIC_DATA_OFFSET + 1))) {
- qdf_print("Invalid msdu len in %s", __func__);
- qdf_assert(0);
- return A_ERROR;
- }
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- /*
- * Makes the short words (16 bits) portable b/w little endian
- * and big endian
- */
- qdf_mem_zero(&pl_hdr, sizeof(pl_hdr));
- pl_hdr.flags = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_FLAGS_OFFSET) &
- ATH_PKTLOG_HDR_FLAGS_MASK) >>
- ATH_PKTLOG_HDR_FLAGS_SHIFT;
- pl_hdr.missed_cnt = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_MISSED_CNT_OFFSET) &
- ATH_PKTLOG_HDR_MISSED_CNT_MASK) >>
- ATH_PKTLOG_HDR_MISSED_CNT_SHIFT;
- pl_hdr.log_type = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_LOG_TYPE_OFFSET) &
- ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- pl_hdr.size = (*(pl_tgt_hdr + ATH_PKTLOG_HDR_SIZE_OFFSET) &
- ATH_PKTLOG_HDR_SIZE_MASK) >> ATH_PKTLOG_HDR_SIZE_SHIFT;
- pl_hdr.timestamp = *(pl_tgt_hdr + ATH_PKTLOG_HDR_TIMESTAMP_OFFSET);
- log_size = pl_hdr.size;
- pl_info = pl_dev->pl_info;
- /*
- * Will be uncommented when the rate control update
- * for pktlog is implemented in the firmware.
- * Currently derived from the TX PPDU status
- */
- rcu_log.txRateCtrl = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy(rcu_log.txRateCtrl,
- ((char *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rcu_log.txRateCtrl);
- return A_OK;
- }
- #endif
- #endif /*REMOVE_PKT_LOG */
|