123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649 |
- /*
- * Copyright (c) 2017-2019 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.
- */
- #include "hal_hw_headers.h"
- #include "dp_types.h"
- #include "dp_rx.h"
- #include "dp_peer.h"
- #include "hal_rx.h"
- #include "hal_api.h"
- #include "qdf_trace.h"
- #include "qdf_nbuf.h"
- #include "hal_api_mon.h"
- #include "dp_rx_mon.h"
- #include "dp_internal.h"
- #include "qdf_mem.h" /* qdf_mem_malloc,free */
- #include "wlan_cfg.h"
- #ifdef WLAN_RX_PKT_CAPTURE_ENH
- static inline void
- dp_rx_free_msdu_list(struct msdu_list *msdu_list)
- {
- qdf_nbuf_list_free(msdu_list->head);
- msdu_list->head = NULL;
- msdu_list->tail = NULL;
- msdu_list->sum_len = 0;
- }
- /**
- * dp_nbuf_set_data_and_len() - set nbuf data and len
- * @buf: Network buf instance
- * @data: pointer to nbuf data
- * @len: nbuf data length
- *
- * Return: none
- */
- static inline void
- dp_nbuf_set_data_and_len(qdf_nbuf_t buf, unsigned char *data,
- int len)
- {
- qdf_nbuf_set_data_pointer(buf, data);
- qdf_nbuf_set_len(buf, len);
- qdf_nbuf_set_tail_pointer(buf, len);
- }
- /*
- * dp_rx_populate_cdp_indication_mpdu_info() - Populate cdp rx indication
- * MPDU info structure
- * @pdev: pdev ctx
- * @ppdu_info: ppdu info structure from monitor status ring
- * @cdp_mpdu_info: cdp rx indication MPDU info structure
- * @user: user ID
- *
- * Return: none
- */
- void
- dp_rx_populate_cdp_indication_mpdu_info(
- struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- struct cdp_rx_indication_mpdu_info *cdp_mpdu_info,
- uint32_t user)
- {
- int i;
- struct mon_rx_user_status *rx_user_status;
- cdp_mpdu_info->ppdu_id = ppdu_info->com_info.ppdu_id;
- cdp_mpdu_info->channel = ppdu_info->rx_status.chan_num;
- cdp_mpdu_info->duration = ppdu_info->rx_status.duration;
- cdp_mpdu_info->timestamp = ppdu_info->rx_status.tsft;
- cdp_mpdu_info->bw = ppdu_info->rx_status.bw;
- if ((ppdu_info->rx_status.sgi == VHT_SGI_NYSM) &&
- (ppdu_info->rx_status.preamble_type == HAL_RX_PKT_TYPE_11AC))
- cdp_mpdu_info->gi = CDP_SGI_0_4_US;
- else
- cdp_mpdu_info->gi = ppdu_info->rx_status.sgi;
- cdp_mpdu_info->ldpc = ppdu_info->rx_status.ldpc;
- cdp_mpdu_info->preamble = ppdu_info->rx_status.preamble_type;
- cdp_mpdu_info->ppdu_type = ppdu_info->rx_status.reception_type;
- cdp_mpdu_info->rssi_comb = ppdu_info->rx_status.rssi_comb;
- cdp_mpdu_info->nf = ppdu_info->rx_status.chan_noise_floor;
- if (ppdu_info->rx_status.reception_type == HAL_RX_TYPE_MU_OFDMA) {
- rx_user_status = &ppdu_info->rx_user_status[user];
- cdp_mpdu_info->nss = rx_user_status->nss;
- cdp_mpdu_info->mcs = rx_user_status->mcs;
- cdp_mpdu_info->ofdma_info_valid =
- rx_user_status->ofdma_info_valid;
- cdp_mpdu_info->ofdma_ru_start_index =
- rx_user_status->dl_ofdma_ru_start_index;
- cdp_mpdu_info->ofdma_ru_width =
- rx_user_status->dl_ofdma_ru_width;
- } else {
- cdp_mpdu_info->nss = ppdu_info->rx_status.nss;
- cdp_mpdu_info->mcs = ppdu_info->rx_status.mcs;
- }
- cdp_mpdu_info->rate = ppdu_info->rx_status.rate;
- for (i = 0; i < MAX_CHAIN; i++)
- cdp_mpdu_info->per_chain_rssi[i] = ppdu_info->rx_status.rssi[i];
- }
- #ifdef WLAN_SUPPORT_RX_FLOW_TAG
- /**
- * dp_rx_mon_enh_capture_set_flow_tag() - Tags the actual nbuf with
- * cached flow tag data read from TLV
- * @pdev: pdev structure
- * @ppdu_info: ppdu info structure from monitor status ring
- * @user_id: user ID on which the PPDU is received
- * @nbuf: packet buffer on which metadata have to be updated
- *
- * Return: None
- */
- void dp_rx_mon_enh_capture_set_flow_tag(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id, qdf_nbuf_t nbuf)
- {
- struct dp_soc *soc = pdev->soc;
- uint16_t fse_metadata;
- if (user_id >= MAX_MU_USERS)
- return;
- if (qdf_likely(!wlan_cfg_is_rx_flow_tag_enabled(soc->wlan_cfg_ctx)))
- return;
- if (ppdu_info->rx_msdu_info[user_id].is_flow_idx_invalid)
- return;
- if (ppdu_info->rx_msdu_info[user_id].is_flow_idx_timeout)
- return;
- fse_metadata =
- (uint16_t)ppdu_info->rx_msdu_info[user_id].fse_metadata & 0xFFFF;
- /* update the skb->cb with the user-specified tag/metadata */
- qdf_nbuf_set_rx_flow_tag(nbuf, fse_metadata);
- QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
- "Setting flow tag %u for userID %u", fse_metadata, user_id);
- ppdu_info->rx_msdu_info[user_id].fse_metadata = 0;
- ppdu_info->rx_msdu_info[user_id].flow_idx = 0;
- ppdu_info->rx_msdu_info[user_id].is_flow_idx_timeout = false;
- ppdu_info->rx_msdu_info[user_id].is_flow_idx_invalid = false;
- }
- /**
- * dp_rx_mon_enh_capture_set_flow_tag_in_trailer - update msdu trailer
- * with flow tag
- * @nbuf: packet buffer on which metadata have to be updated
- * @trailer: pointer to rx monitor-lite trailer
- *
- * Return: None
- */
- static inline void dp_rx_mon_enh_capture_set_flow_tag_in_trailer(
- qdf_nbuf_t nbuf, void *trailer)
- {
- uint16_t flow_tag = qdf_nbuf_get_rx_flow_tag(nbuf);
- struct dp_rx_mon_enh_trailer_data *nbuf_trailer =
- (struct dp_rx_mon_enh_trailer_data *)trailer;
- if (!flow_tag)
- return;
- nbuf_trailer->flow_tag = flow_tag;
- }
- #else
- void dp_rx_mon_enh_capture_set_flow_tag(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id, qdf_nbuf_t nbuf)
- {
- }
- static inline void dp_rx_mon_enh_capture_set_flow_tag_in_trailer(
- qdf_nbuf_t nbuf, void *trailer)
- {
- }
- #endif /* WLAN_SUPPORT_RX_FLOW_TAG */
- #ifdef WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG
- /*
- * dp_rx_mon_enh_capture_set_protocol_tag() - Tags the actual nbuf with
- * cached protocol tag data read from TLV
- * @pdev: pdev structure
- * @ppdu_info: ppdu info structure from monitor status ring
- * @user_id: user ID on which the PPDU is received
- * @nbuf: packet buffer on which metadata have to be updated
- *
- * Return: none
- */
- static void
- dp_rx_mon_enh_capture_set_protocol_tag(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id,
- qdf_nbuf_t nbuf)
- {
- uint32_t cce_metadata = 0;
- uint16_t protocol_tag = 0;
- if (user_id >= MAX_MU_USERS)
- return;
- /**
- * Since skb->cb is memset to 0, we can skip setting protocol tag to 0
- * in all the error paths.
- */
- cce_metadata = ppdu_info->rx_msdu_info[user_id].cce_metadata;
- /**
- * Received CCE metadata should be
- * within the valid limits
- */
- if (qdf_unlikely((cce_metadata < RX_PROTOCOL_TAG_START_OFFSET) ||
- (cce_metadata >= (RX_PROTOCOL_TAG_START_OFFSET
- + RX_PROTOCOL_TAG_MAX))))
- return;
- /**
- * The CCE metadata received is just the
- * packet_type + RX_PROTOCOL_TAG_START_OFFSET
- */
- cce_metadata -= RX_PROTOCOL_TAG_START_OFFSET;
- /**
- * Update the QDF packet with the user specified tag/metadata
- * by looking up tag value for received protocol type.
- */
- protocol_tag = pdev->rx_proto_tag_map[cce_metadata].tag;
- QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_DEBUG,
- "Setting ProtoID:%d Tag %u in mon nbuf",
- cce_metadata, protocol_tag);
- qdf_nbuf_set_rx_protocol_tag(nbuf, protocol_tag);
- }
- /*
- * dp_rx_mon_enh_capture_tag_protocol_type() - Support protocol tagging
- * for packets captured in enhanced capture mode
- * @pdev: pdev structure
- * @ppdu_info: ppdu info structure from monitor status ring
- * @user_id: user ID on which the PPDU is received
- * @nbuf: packet buffer on which tag should be updated
- *
- * Return: none
- */
- static void
- dp_rx_mon_enh_capture_tag_protocol_type(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id, qdf_nbuf_t nbuf)
- {
- /**
- * Since skb->cb is memset to 0, we can skip setting protocol tag to 0
- * in all the error paths.
- */
- if (!pdev->is_rx_protocol_tagging_enabled)
- return;
- /**
- * It is assumed that we have already received RX Header/ MSDU
- * Start TLV for this MSDU.
- */
- dp_rx_mon_enh_capture_set_protocol_tag(pdev, ppdu_info,
- user_id, nbuf);
- /* Reset MSDU tag variables on completion of every MSDU tag */
- ppdu_info->rx_msdu_info[user_id].cce_metadata = 0;
- }
- /*
- * dp_rx_mon_enh_capture_set_protocol_tag_in_trailer - update msdu trailer
- * with protocol tag
- * @nbuf: packet buffer on which metadata have to be updated
- * @trailer: pointer to rx monitor-lite trailer
- *
- * Return: void
- */
- static inline
- void dp_rx_mon_enh_capture_set_protocol_tag_in_trailer(qdf_nbuf_t nbuf,
- void *trailer)
- {
- uint16_t protocol_tag = qdf_nbuf_get_rx_protocol_tag(nbuf);
- struct dp_rx_mon_enh_trailer_data *nbuf_trailer =
- (struct dp_rx_mon_enh_trailer_data *)trailer;
- if (protocol_tag != 0)
- nbuf_trailer->protocol_tag = protocol_tag;
- }
- #else
- static void
- dp_rx_mon_enh_capture_tag_protocol_type(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id, qdf_nbuf_t nbuf)
- {
- }
- static void
- dp_rx_mon_enh_capture_set_protocol_tag(struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id, qdf_nbuf_t nbuf)
- {
- }
- static inline
- void dp_rx_mon_enh_capture_set_protocol_tag_in_trailer(qdf_nbuf_t nbuf,
- void *trailer)
- {
- }
- #endif /* WLAN_SUPPORT_RX_PROTOCOL_TYPE_TAG */
- /*
- * dp_rx_mon_enh_capture_update_trailer() - Update trailer with custom data
- * @pdev: pdev structure
- * @nbuf: packet buffer on which metadata have to be updated
- *
- * Return: return number of bytes updated in the tail
- */
- static inline
- uint16_t dp_rx_mon_enh_capture_update_trailer(struct dp_pdev *pdev,
- qdf_nbuf_t nbuf)
- {
- uint64_t trailer;
- uint8_t *dest;
- struct dp_soc *soc = pdev->soc;
- struct dp_rx_mon_enh_trailer_data *nbuf_trailer =
- (struct dp_rx_mon_enh_trailer_data *)&trailer;
- if (qdf_unlikely(qdf_nbuf_len(nbuf) < sizeof(trailer)))
- return 0;
- trailer = RX_MON_CAP_ENH_TRAILER;
- if (wlan_cfg_is_rx_mon_protocol_flow_tag_enabled(soc->wlan_cfg_ctx)) {
- dp_rx_mon_enh_capture_set_protocol_tag_in_trailer(nbuf,
- nbuf_trailer);
- dp_rx_mon_enh_capture_set_flow_tag_in_trailer(nbuf,
- nbuf_trailer);
- }
- /**
- * Overwrite last 8 bytes of data with trailer. This is ok since we
- * do not care about the data in this debug mode.
- */
- qdf_nbuf_trim_tail(nbuf, sizeof(trailer));
- dest = qdf_nbuf_put_tail(nbuf, sizeof(trailer));
- if (qdf_likely(dest)) {
- qdf_mem_copy(dest, &trailer, sizeof(trailer));
- } else {
- dp_err("Unable to add tail room");
- return 0;
- }
- return sizeof(trailer);
- }
- /**
- * dp_rx_enh_capture_is_peer_enabled() - Is peer based enh capture enabled.
- * @soc: core txrx main context
- * @ppdu_info: Structure for rx ppdu info
- * @user_id: user id for MU Rx packet
- *
- * Return: none
- */
- static inline bool
- dp_rx_enh_capture_is_peer_enabled(struct dp_soc *soc,
- struct hal_rx_ppdu_info *ppdu_info,
- uint32_t user_id)
- {
- struct dp_peer *peer;
- struct dp_ast_entry *ast_entry;
- uint32_t ast_index;
- ast_index = ppdu_info->rx_user_status[user_id].ast_index;
- if (ast_index < wlan_cfg_get_max_ast_idx(soc->wlan_cfg_ctx)) {
- ast_entry = soc->ast_table[ast_index];
- if (ast_entry) {
- peer = ast_entry->peer;
- if (peer && (peer->peer_ids[0] != HTT_INVALID_PEER))
- return peer->rx_cap_enabled;
- }
- }
- return false;
- }
- /*
- * dp_rx_handle_enh_capture() - Deliver Rx enhanced capture data
- * @pdev: pdev ctx
- * @ppdu_info: ppdu info structure from monitor status ring
- *
- * Return: QDF status
- */
- QDF_STATUS
- dp_rx_handle_enh_capture(struct dp_soc *soc, struct dp_pdev *pdev,
- struct hal_rx_ppdu_info *ppdu_info)
- {
- qdf_nbuf_t mpdu_head;
- uint32_t user;
- qdf_nbuf_queue_t *mpdu_q;
- struct cdp_rx_indication_mpdu *mpdu_ind;
- struct cdp_rx_indication_mpdu_info *mpdu_info;
- struct msdu_list *msdu_list;
- user = 0;
- mpdu_q = &pdev->mpdu_q[user];
- while (!qdf_nbuf_is_queue_empty(mpdu_q) && user < MAX_MU_USERS) {
- msdu_list = &pdev->msdu_list[user];
- dp_rx_free_msdu_list(msdu_list);
- pdev->is_mpdu_hdr[user] = true;
- if (pdev->rx_enh_capture_peer &&
- !dp_rx_enh_capture_is_peer_enabled(
- soc, ppdu_info, user)) {
- qdf_nbuf_queue_free(mpdu_q);
- } else {
- mpdu_ind = &pdev->mpdu_ind;
- mpdu_info = &mpdu_ind->mpdu_info;
- dp_rx_populate_cdp_indication_mpdu_info(
- pdev, &pdev->ppdu_info, mpdu_info, user);
- while ((mpdu_head = qdf_nbuf_queue_remove(mpdu_q))) {
- mpdu_ind->nbuf = mpdu_head;
- mpdu_info->fcs_err =
- QDF_NBUF_CB_RX_FCS_ERR(mpdu_head);
- dp_wdi_event_handler(WDI_EVENT_RX_MPDU,
- soc, mpdu_ind,
- HTT_INVALID_PEER,
- WDI_NO_VAL,
- pdev->pdev_id);
- }
- }
- user++;
- mpdu_q = &pdev->mpdu_q[user];
- }
- return QDF_STATUS_SUCCESS;
- }
- /*
- * dp_rx_mon_enh_capture_process() - Rx enhanced capture mode
- * processing.
- * @pdev: pdev structure
- * @tlv_status: processed TLV status
- * @status_nbuf: monitor status ring buffer
- * @ppdu_info: ppdu info structure from monitor status ring
- * @nbuf_used: nbuf need a clone
- *
- * Return: none
- */
- void
- dp_rx_mon_enh_capture_process(struct dp_pdev *pdev, uint32_t tlv_status,
- qdf_nbuf_t status_nbuf,
- struct hal_rx_ppdu_info *ppdu_info,
- bool *nbuf_used)
- {
- qdf_nbuf_t nbuf;
- struct msdu_list *msdu_list;
- uint32_t user_id;
- struct dp_soc *soc;
- qdf_nbuf_t mpdu_head;
- if (pdev->rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_DISABLED)
- return;
- user_id = ppdu_info->user_id;
- if (user_id >= MAX_MU_USERS)
- return;
- if ((tlv_status == HAL_TLV_STATUS_HEADER) && (
- (pdev->rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_MPDU_MSDU) ||
- ((pdev->rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_MPDU) &&
- pdev->is_mpdu_hdr[user_id]))) {
- if (*nbuf_used) {
- nbuf = qdf_nbuf_clone(status_nbuf);
- } else {
- *nbuf_used = true;
- nbuf = status_nbuf;
- }
- if (!nbuf)
- return;
- /* Truncate 4 bytes containing PPDU ID */
- dp_nbuf_set_data_and_len(nbuf, ppdu_info->data,
- ppdu_info->hdr_len - 4);
- if (pdev->is_mpdu_hdr[user_id]) {
- soc = pdev->soc;
- mpdu_head = qdf_nbuf_alloc(soc->osdev,
- RX_ENH_CB_BUF_SIZE + RX_ENH_CB_BUF_RESERVATION,
- RX_ENH_CB_BUF_RESERVATION,
- RX_ENH_CB_BUF_ALIGNMENT,
- FALSE);
- if (mpdu_head == NULL)
- return;
- qdf_nbuf_queue_add(&pdev->mpdu_q[user_id],
- mpdu_head);
- pdev->is_mpdu_hdr[user_id] = false;
- }
- msdu_list = &pdev->msdu_list[user_id];
- if (!msdu_list->head)
- msdu_list->head = nbuf;
- else
- msdu_list->tail->next = nbuf;
- msdu_list->tail = nbuf;
- msdu_list->sum_len += qdf_nbuf_len(nbuf);
- }
- if (tlv_status == HAL_TLV_STATUS_MPDU_END) {
- msdu_list = &pdev->msdu_list[user_id];
- mpdu_head = qdf_nbuf_queue_last(&pdev->mpdu_q[user_id]);
- if (mpdu_head) {
- qdf_nbuf_append_ext_list(mpdu_head,
- msdu_list->head,
- msdu_list->sum_len);
- msdu_list->head = NULL;
- msdu_list->tail = NULL;
- msdu_list->sum_len = 0;
- QDF_NBUF_CB_RX_FCS_ERR(mpdu_head)
- = ppdu_info->fcs_err;
- } else {
- dp_rx_free_msdu_list(msdu_list);
- }
- pdev->is_mpdu_hdr[user_id] = true;
- }
- /* Tag the MSDU/MPDU if a cce_metadata is valid */
- if ((tlv_status == HAL_TLV_STATUS_MSDU_END) &&
- (pdev->rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_MPDU_MSDU)) {
- bool is_rx_mon_protocol_flow_tag_en;
- /**
- * Proceed only if this is a data frame.
- * We could also rx probes, etc.
- */
- if (!(ppdu_info->nac_info.fc_valid &&
- (IEEE80211_FC0_TYPE_DATA ==
- (ppdu_info->nac_info.frame_control &
- IEEE80211_FC0_TYPE_MASK))))
- return;
- msdu_list = &pdev->msdu_list[user_id];
- qdf_assert_always(msdu_list->head);
- /**
- * Directly move the last MSDU and fetch the same.
- * The earlier MSDUs should already be tagged as the
- * packets are tagged at the end of every RX
- * MSDU.
- */
- nbuf = msdu_list->tail;
- is_rx_mon_protocol_flow_tag_en =
- wlan_cfg_is_rx_mon_protocol_flow_tag_enabled(
- pdev->soc->wlan_cfg_ctx);
- if (is_rx_mon_protocol_flow_tag_en) {
- /* Set the protocol tag value from CCE metadata */
- dp_rx_mon_enh_capture_tag_protocol_type(pdev, ppdu_info,
- user_id, nbuf);
- /* Set the flow tag from FSE metadata */
- dp_rx_mon_enh_capture_set_flow_tag(pdev, ppdu_info,
- user_id, nbuf);
- }
- if (!pdev->is_rx_enh_capture_trailer_enabled)
- return;
- /**
- * Update necessary information in trailer (for debug purpose)
- */
- dp_rx_mon_enh_capture_update_trailer(pdev, nbuf);
- }
- }
- /*
- * dp_config_enh_rx_capture()- API to enable/disable enhanced rx capture
- * @pdev_handle: DP_PDEV handle
- * @val: user provided value
- *
- * Return: 0 for success. nonzero for failure.
- */
- QDF_STATUS
- dp_config_enh_rx_capture(struct cdp_pdev *pdev_handle, uint32_t val)
- {
- struct dp_pdev *pdev = (struct dp_pdev *)pdev_handle;
- uint8_t rx_cap_mode = (val & CDP_RX_ENH_CAPTURE_MODE_MASK);
- uint32_t rx_enh_capture_peer;
- bool is_mpdu_hdr = false;
- uint8_t user_id;
- rx_enh_capture_peer =
- (val & CDP_RX_ENH_CAPTURE_PEER_MASK)
- >> CDP_RX_ENH_CAPTURE_PEER_LSB;
- if (pdev->mcopy_mode || (rx_cap_mode < CDP_RX_ENH_CAPTURE_DISABLED) ||
- (rx_cap_mode > CDP_RX_ENH_CAPTURE_MPDU_MSDU)) {
- dp_err("Invalid mode: %d", rx_cap_mode);
- return QDF_STATUS_E_INVAL;
- }
- if (rx_enh_capture_peer > CDP_RX_ENH_CAPTURE_PEER_ENABLED) {
- dp_err("Invalid peer filter %d", rx_enh_capture_peer);
- return QDF_STATUS_E_INVAL;
- }
- if (pdev->rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_DISABLED &&
- rx_cap_mode != CDP_RX_ENH_CAPTURE_DISABLED) {
- pdev->rx_enh_monitor_vdev = pdev->monitor_vdev;
- }
- dp_reset_monitor_mode(pdev_handle);
- if (pdev->rx_enh_capture_mode != CDP_RX_ENH_CAPTURE_DISABLED &&
- rx_cap_mode == CDP_RX_ENH_CAPTURE_DISABLED) {
- pdev->monitor_vdev = pdev->rx_enh_monitor_vdev;
- }
- pdev->rx_enh_capture_mode = rx_cap_mode;
- pdev->rx_enh_capture_peer = rx_enh_capture_peer;
- if (rx_cap_mode != CDP_RX_ENH_CAPTURE_DISABLED)
- is_mpdu_hdr = true;
- for (user_id = 0; user_id < MAX_MU_USERS; user_id++)
- pdev->is_mpdu_hdr[user_id] = is_mpdu_hdr;
- /* Use a bit from val to enable MSDU trailer for internal debug use */
- pdev->is_rx_enh_capture_trailer_enabled =
- (val & RX_ENH_CAPTURE_TRAILER_ENABLE_MASK) ? true : false;
- return dp_pdev_configure_monitor_rings(pdev);
- }
- #endif /* WLAN_RX_PKT_CAPTURE_ENH */
|