1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411 |
- /*
- * Copyright (c) 2013-2018 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"
- #define TX_DESC_ID_LOW_MASK 0xffff
- #define TX_DESC_ID_LOW_SHIFT 0
- #define TX_DESC_ID_HIGH_MASK 0xffff0000
- #define TX_DESC_ID_HIGH_SHIFT 16
- 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) {
- printk("Invalid parg in %s\n", __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) {
- printk("Invalid log_buf in %s\n", __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;
- #ifdef HELIUMPLUS
- log_hdr->type_specific_data = plarg->type_specific_data;
- #endif
- 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;
- #ifdef HELIUMPLUS
- plarg.type_specific_data = pl_hdr->type_specific_data;
- #endif
- 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;
- }
- static struct txctl_frm_hdr frm_hdr;
- #ifndef HELIUMPLUS
- static void process_ieee_hdr(void *data)
- {
- uint8_t dir;
- struct ieee80211_frame *wh = (struct ieee80211_frame *)(data);
- frm_hdr.framectrl = *(uint16_t *) (wh->i_fc);
- frm_hdr.seqctrl = *(uint16_t *) (wh->i_seq);
- dir = (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK);
- if (dir == IEEE80211_FC1_DIR_TODS) {
- frm_hdr.bssid_tail =
- (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr1
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.sa_tail =
- (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr2
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.da_tail =
- (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr3
- [IEEE80211_ADDR_LEN
- - 1]);
- } else if (dir == IEEE80211_FC1_DIR_FROMDS) {
- frm_hdr.bssid_tail =
- (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr2
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.sa_tail =
- (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr3
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.da_tail =
- (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr1
- [IEEE80211_ADDR_LEN
- - 1]);
- } else {
- frm_hdr.bssid_tail =
- (wh->i_addr3[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr3
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.sa_tail =
- (wh->i_addr2[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr2
- [IEEE80211_ADDR_LEN
- - 1]);
- frm_hdr.da_tail =
- (wh->i_addr1[IEEE80211_ADDR_LEN - 2] << 8) | (wh->
- i_addr1
- [IEEE80211_ADDR_LEN
- - 1]);
- }
- }
- /**
- * fill_ieee80211_hdr_data() - fill ieee802.11 data header
- * @txrx_pdev: txrx pdev
- * @pl_msdu_info: msdu info
- * @data: data received from event
- *
- * Return: none
- */
- /* TODO: Platform specific function */
- static void
- fill_ieee80211_hdr_data(struct cdp_pdev *pdev,
- struct ath_pktlog_msdu_info *pl_msdu_info, void *data)
- {
- uint32_t i;
- uint32_t *htt_tx_desc;
- struct ol_tx_desc_t *tx_desc;
- uint8_t msdu_id_offset = MSDU_ID_INFO_ID_OFFSET;
- uint16_t tx_desc_id;
- uint32_t *msdu_id_info = (uint32_t *)
- ((void *)data + sizeof(struct ath_pktlog_hdr));
- uint32_t *msdu_id = (uint32_t *) ((char *)msdu_id_info +
- msdu_id_offset);
- uint8_t *addr, *vap_addr;
- uint8_t vdev_id;
- qdf_nbuf_t netbuf;
- uint32_t len;
- struct ol_txrx_pdev_t *txrx_pdev = (struct ol_txrx_pdev_t *)pdev;
- pl_msdu_info->num_msdu = *msdu_id_info;
- pl_msdu_info->priv_size = sizeof(uint32_t) *
- pl_msdu_info->num_msdu + sizeof(uint32_t);
- if (pl_msdu_info->num_msdu > MAX_PKT_INFO_MSDU_ID) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
- "%s: Invalid num_msdu count",
- __func__);
- qdf_assert(0);
- return;
- }
- for (i = 0; i < pl_msdu_info->num_msdu; i++) {
- /*
- * Handle big endianness
- * Increment msdu_id once after retrieving
- * lower 16 bits and uppper 16 bits
- */
- if (!(i % 2)) {
- tx_desc_id = ((*msdu_id & TX_DESC_ID_LOW_MASK)
- >> TX_DESC_ID_LOW_SHIFT);
- } else {
- tx_desc_id = ((*msdu_id & TX_DESC_ID_HIGH_MASK)
- >> TX_DESC_ID_HIGH_SHIFT);
- msdu_id += 1;
- }
- if (tx_desc_id >= txrx_pdev->tx_desc.pool_size) {
- QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_DEBUG,
- "%s: drop due to invalid msdu id = %x",
- __func__, tx_desc_id);
- return;
- }
- tx_desc = ol_tx_desc_find(txrx_pdev, tx_desc_id);
- qdf_assert(tx_desc);
- netbuf = tx_desc->netbuf;
- htt_tx_desc = (uint32_t *) tx_desc->htt_tx_desc;
- qdf_assert(htt_tx_desc);
- qdf_nbuf_peek_header(netbuf, &addr, &len);
- if (len < (2 * IEEE80211_ADDR_LEN)) {
- qdf_print("TX frame does not have a valid address");
- return;
- }
- /* Adding header information for the TX data frames */
- vdev_id = (uint8_t) (*(htt_tx_desc +
- HTT_TX_VDEV_ID_WORD) >>
- HTT_TX_VDEV_ID_SHIFT) &
- HTT_TX_VDEV_ID_MASK;
- vap_addr = wma_get_vdev_address_by_vdev_id(vdev_id);
- frm_hdr.da_tail = (addr[IEEE80211_ADDR_LEN - 2] << 8) |
- (addr[IEEE80211_ADDR_LEN - 1]);
- frm_hdr.sa_tail =
- (addr[2 * IEEE80211_ADDR_LEN - 2] << 8) |
- (addr[2 * IEEE80211_ADDR_LEN - 1]);
- if (vap_addr) {
- frm_hdr.bssid_tail =
- (vap_addr[IEEE80211_ADDR_LEN - 2] << 8) |
- (vap_addr[IEEE80211_ADDR_LEN - 1]);
- } else {
- frm_hdr.bssid_tail = 0x0000;
- }
- pl_msdu_info->priv.msdu_len[i] = *(htt_tx_desc +
- HTT_TX_MSDU_LEN_DWORD)
- & HTT_TX_MSDU_LEN_MASK;
- /*
- * Add more information per MSDU
- * e.g., protocol information
- */
- }
- }
- #endif
- #ifdef HELIUMPLUS
- A_STATUS process_tx_info(struct cdp_pdev *txrx_pdev, void *data)
- {
- /*
- * Must include to process different types
- * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
- */
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!txrx_pdev) {
- printk("Invalid pdev in %s\n", __func__);
- return A_ERROR;
- }
- if (!pl_dev) {
- pr_err("Invalid pktlog handle in %s\n", __func__);
- qdf_assert(pl_dev);
- return A_ERROR;
- }
- qdf_assert(data);
- 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.flags |= PKTLOG_HDR_SIZE_16;
- 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;
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
- size_t log_size = sizeof(frm_hdr) + pl_hdr.size;
- void *txdesc_hdr_ctl = (void *)
- pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
- qdf_assert(txdesc_hdr_ctl);
- qdf_assert(pl_hdr.size < (370 * sizeof(u_int32_t)));
- qdf_mem_copy(txdesc_hdr_ctl, &frm_hdr, sizeof(frm_hdr));
- qdf_mem_copy((char *)txdesc_hdr_ctl + sizeof(frm_hdr),
- ((void *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- pl_hdr.size = log_size;
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- txdesc_hdr_ctl);
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
- struct ath_pktlog_tx_status txstat_log;
- size_t log_size = pl_hdr.size;
- txstat_log.ds_status = (void *)
- pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- qdf_assert(txstat_log.ds_status);
- qdf_mem_copy(txstat_log.ds_status,
- ((void *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- /* TODO: MCL specific API */
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- txstat_log.ds_status);
- }
- return A_OK;
- }
- #else
- A_STATUS process_tx_info(struct cdp_pdev *txrx_pdev, void *data)
- {
- /*
- * Must include to process different types
- * TX_CTL, TX_STATUS, TX_MSDU_ID, TX_FRM_HDR
- */
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_info *pl_info;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!txrx_pdev) {
- qdf_print("Invalid pdev in %s", __func__);
- return A_ERROR;
- }
- if (!pl_dev) {
- pr_err("Invalid pktlog handle in %s\n", __func__);
- qdf_assert(pl_dev);
- return A_ERROR;
- }
- qdf_assert(data);
- 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);
- pl_info = pl_dev->pl_info;
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_FRM_HDR) {
- /* Valid only for the TX CTL */
- process_ieee_hdr(fw_data->data + sizeof(pl_hdr));
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_VIRT_ADDR) {
- uint32_t desc_id = (uint32_t) *((uint32_t *)(fw_data->data +
- sizeof(pl_hdr)));
- uint32_t vdev_id = desc_id;
- /* if the pkt log msg is for the bcn frame the vdev id
- * is piggybacked in desc_id and the MSB of the desc ID
- * would be set to FF
- */
- #define BCN_DESC_ID 0xFF
- if ((desc_id >> 24) == BCN_DESC_ID) {
- void *data;
- uint32_t buf_size;
- vdev_id &= 0x00FFFFFF;
- /* TODO: MCL specific API */
- data = wma_get_beacon_buffer_by_vdev_id(vdev_id,
- &buf_size);
- if (data) {
- /* TODO: platform specific API */
- process_ieee_hdr(data);
- qdf_mem_free(data);
- }
- } else {
- /*
- * TODO: get the hdr content for mgmt frames from
- * Tx mgmt desc pool
- */
- }
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_CTRL) {
- struct ath_pktlog_txctl txctl_log;
- size_t log_size = sizeof(txctl_log.priv);
- txctl_log.txdesc_hdr_ctl = (void *)pktlog_getbuf(pl_dev,
- pl_info,
- log_size,
- &pl_hdr);
- if (!txctl_log.txdesc_hdr_ctl) {
- printk
- ("failed to get buf for txctl_log.txdesc_hdr_ctl\n");
- return A_ERROR;
- }
- /*
- * frm hdr is currently Valid only for local frames
- * Add capability to include the fmr hdr for remote frames
- */
- txctl_log.priv.frm_hdr = frm_hdr;
- qdf_assert(txctl_log.priv.txdesc_ctl);
- qdf_assert(pl_hdr.size < sizeof(txctl_log.priv.txdesc_ctl));
- pl_hdr.size = (pl_hdr.size > sizeof(txctl_log.priv.txdesc_ctl))
- ? sizeof(txctl_log.priv.txdesc_ctl) :
- pl_hdr.size;
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- qdf_mem_copy((void *)&txctl_log.priv.txdesc_ctl,
- ((void *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- qdf_assert(txctl_log.txdesc_hdr_ctl);
- qdf_mem_copy(txctl_log.txdesc_hdr_ctl, &txctl_log.priv,
- sizeof(txctl_log.priv));
- pl_hdr.size = log_size;
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- txctl_log.txdesc_hdr_ctl);
- /* Add Protocol information and HT specific information */
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_STAT) {
- struct ath_pktlog_tx_status txstat_log;
- size_t log_size = pl_hdr.size;
- txstat_log.ds_status = (void *)
- pktlog_getbuf(pl_dev, pl_info, log_size, &pl_hdr);
- qdf_assert(txstat_log.ds_status);
- qdf_mem_copy(txstat_log.ds_status,
- ((void *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- txstat_log.ds_status);
- }
- if (pl_hdr.log_type == PKTLOG_TYPE_TX_MSDU_ID) {
- struct ath_pktlog_msdu_info pl_msdu_info;
- size_t log_size;
- qdf_mem_set(&pl_msdu_info, sizeof(pl_msdu_info), 0);
- log_size = sizeof(pl_msdu_info.priv);
- if (pl_dev->mt_pktlog_enabled == false)
- fill_ieee80211_hdr_data(txrx_pdev,
- &pl_msdu_info, fw_data->data);
- pl_msdu_info.ath_msdu_info = pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- qdf_mem_copy((void *)&pl_msdu_info.priv.msdu_id_info,
- ((void *)fw_data->data +
- sizeof(struct ath_pktlog_hdr)),
- sizeof(pl_msdu_info.priv.msdu_id_info));
- qdf_mem_copy(pl_msdu_info.ath_msdu_info, &pl_msdu_info.priv,
- sizeof(pl_msdu_info.priv));
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- pl_msdu_info.ath_msdu_info);
- }
- return A_OK;
- }
- #endif
- /* TODO: hardware dependent function */
- A_STATUS process_rx_info_remote(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_info *pl_info;
- struct htt_host_rx_desc_base *rx_desc;
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_rx_info rxstat_log;
- size_t log_size;
- struct ol_rx_remote_data *r_data = (struct ol_rx_remote_data *)data;
- qdf_nbuf_t msdu;
- if (!pdev || !r_data || !pl_dev) {
- qdf_print("%s: Invalid handle", __func__);
- return A_ERROR;
- }
- pl_info = pl_dev->pl_info;
- msdu = r_data->msdu;
- while (msdu) {
- rx_desc =
- (struct htt_host_rx_desc_base *)(qdf_nbuf_data(msdu)) - 1;
- log_size =
- sizeof(*rx_desc) - sizeof(struct htt_host_fw_desc_base);
- /*
- * Construct the pktlog header pl_hdr
- * Because desc is DMA'd to the host memory
- */
- pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
- pl_hdr.missed_cnt = 0;
- #if defined(HELIUMPLUS)
- pl_hdr.macId = r_data->mac_id;
- pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
- pl_hdr.flags |= PKTLOG_HDR_SIZE_16;
- #else
- pl_hdr.log_type = PKTLOG_TYPE_RX_STAT;
- #endif
- pl_hdr.size = sizeof(*rx_desc) -
- sizeof(struct htt_host_fw_desc_base);
- #if defined(HELIUMPLUS)
- pl_hdr.timestamp =
- rx_desc->ppdu_end.rx_pkt_end.phy_timestamp_1_lower_32;
- pl_hdr.type_specific_data = 0xDEADAA;
- #else
- pl_hdr.timestamp = rx_desc->ppdu_end.tsf_timestamp;
- #endif /* !defined(HELIUMPLUS) */
- rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- qdf_mem_copy(rxstat_log.rx_desc, (void *)rx_desc +
- sizeof(struct htt_host_fw_desc_base), pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- rxstat_log.rx_desc);
- msdu = qdf_nbuf_next(msdu);
- }
- return A_OK;
- }
- #ifdef HELIUMPLUS
- A_STATUS process_rx_info(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_info *pl_info;
- struct ath_pktlog_rx_info rxstat_log;
- struct ath_pktlog_hdr pl_hdr;
- size_t log_size;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!pdev) {
- printk("Invalid pdev in %s", __func__);
- return A_ERROR;
- }
- pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
- if (!pl_dev) {
- printk("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_info = pl_dev->pl_info;
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- log_size = pl_hdr.size;
- rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- qdf_mem_copy(rxstat_log.rx_desc,
- (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
- return A_OK;
- }
- #else
- A_STATUS process_rx_info(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_info *pl_info;
- struct ath_pktlog_rx_info rxstat_log;
- struct ath_pktlog_hdr pl_hdr;
- size_t log_size;
- uint32_t *pl_tgt_hdr;
- struct ol_fw_data *fw_data;
- uint32_t len;
- if (!pdev) {
- printk("Invalid pdev in %s", __func__);
- return A_ERROR;
- }
- pl_dev = ((struct ol_txrx_pdev_t *)pdev)->pl_dev;
- if (!pl_dev) {
- printk("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_info = pl_dev->pl_info;
- pl_tgt_hdr = (uint32_t *)fw_data->data;
- qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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);
- if (sizeof(struct ath_pktlog_hdr) + pl_hdr.size > len) {
- qdf_assert(0);
- return A_ERROR;
- }
- log_size = pl_hdr.size;
- rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- qdf_mem_copy(rxstat_log.rx_desc,
- (void *)fw_data->data + sizeof(struct ath_pktlog_hdr),
- pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
- return A_OK;
- }
- #endif
- #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_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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);
- 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);
- 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);
- 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_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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_set(&pl_hdr, sizeof(pl_hdr), 0);
- 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
- #ifdef QCA_WIFI_QCA6290
- int process_rx_desc_remote(void *pdev, void *data)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_rx_info rxstat_log;
- size_t log_size;
- struct ath_pktlog_info *pl_info;
- qdf_nbuf_t log_nbuf = (qdf_nbuf_t)data;
- pl_info = pl_dev->pl_info;
- qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
- pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
- pl_hdr.missed_cnt = 0;
- pl_hdr.log_type = 22; /*PKTLOG_TYPE_RX_STATBUF*/
- pl_hdr.size = qdf_nbuf_len(log_nbuf);
- pl_hdr.timestamp = 0;
- log_size = pl_hdr.size;
- rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (rxstat_log.rx_desc == NULL) {
- QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
- "%s: Rx descriptor is NULL", __func__);
- return -EFAULT;
- }
- qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL,
- rxstat_log.rx_desc);
- return 0;
- }
- int
- process_pktlog_lite(void *context, void *log_data, uint16_t log_type)
- {
- struct pktlog_dev_t *pl_dev = get_pktlog_handle();
- struct ath_pktlog_info *pl_info;
- struct ath_pktlog_hdr pl_hdr;
- struct ath_pktlog_rx_info rxstat_log;
- size_t log_size;
- qdf_nbuf_t log_nbuf = (qdf_nbuf_t)log_data;
- pl_info = pl_dev->pl_info;
- qdf_mem_set(&pl_hdr, sizeof(pl_hdr), 0);
- pl_hdr.flags = (1 << PKTLOG_FLG_FRM_TYPE_REMOTE_S);
- pl_hdr.missed_cnt = 0;
- pl_hdr.log_type = log_type;
- pl_hdr.size = qdf_nbuf_len(log_nbuf);
- pl_hdr.timestamp = 0;
- log_size = pl_hdr.size;
- rxstat_log.rx_desc = (void *)pktlog_getbuf(pl_dev, pl_info,
- log_size, &pl_hdr);
- if (rxstat_log.rx_desc == NULL) {
- QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_DEBUG,
- "%s: Rx descriptor is NULL", __func__);
- return -EFAULT;
- }
- qdf_mem_copy(rxstat_log.rx_desc, qdf_nbuf_data(log_nbuf), pl_hdr.size);
- cds_pkt_stats_to_logger_thread(&pl_hdr, NULL, rxstat_log.rx_desc);
- return 0;
- }
- #else
- int process_rx_desc_remote(void *pdev, void *data)
- {
- return 0;
- }
- int
- process_pktlog_lite(void *context, void *log_data, uint16_t log_type)
- {
- return 0;
- }
- #endif
- #endif /*REMOVE_PKT_LOG */
|