|
|
@@ -0,0 +1,240 @@
|
|
|
+/*
|
|
|
+ * 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 */
|
|
|
+
|
|
|
+#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;
|
|
|
+
|
|
|
+ cdp_mpdu_info->ppdu_id = ppdu_info->com_info.ppdu_id;
|
|
|
+ cdp_mpdu_info->duration = ppdu_info->rx_status.duration;
|
|
|
+ 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->timestamp = ppdu_info->rx_status.tsft;
|
|
|
+
|
|
|
+ cdp_mpdu_info->nss = ppdu_info->rx_user_status[user].nss;
|
|
|
+ cdp_mpdu_info->mcs = ppdu_info->rx_user_status[user].mcs;
|
|
|
+ for (i = 0; i < MAX_CHAIN; i++)
|
|
|
+ cdp_mpdu_info->per_chain_rssi[i] = ppdu_info->rx_status.rssi[i];
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * 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 nbuf;
|
|
|
+ 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)) {
|
|
|
+ msdu_list = &pdev->msdu_list[user];
|
|
|
+ dp_rx_free_msdu_list(msdu_list);
|
|
|
+ mpdu_ind = &pdev->mpdu_ind[user];
|
|
|
+ mpdu_info = &mpdu_ind->mpdu_info;
|
|
|
+
|
|
|
+ dp_rx_populate_cdp_indication_mpdu_info(
|
|
|
+ pdev, &pdev->ppdu_info, mpdu_info, user);
|
|
|
+
|
|
|
+ while (!qdf_nbuf_is_queue_empty(mpdu_q)) {
|
|
|
+ nbuf = qdf_nbuf_queue_remove(mpdu_q);
|
|
|
+ mpdu_ind->nbuf = nbuf;
|
|
|
+ mpdu_info->fcs_err = QDF_NBUF_CB_RX_FCS_ERR(nbuf);
|
|
|
+ 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
|
|
|
+ * @rx_enh_capture_mode: Rx enhanced capture mode
|
|
|
+ *
|
|
|
+ * 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,
|
|
|
+ uint32_t rx_enh_capture_mode)
|
|
|
+{
|
|
|
+ qdf_nbuf_t nbuf;
|
|
|
+ struct msdu_list *msdu_list;
|
|
|
+ uint32_t user_id;
|
|
|
+
|
|
|
+ if (rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_DISABLED)
|
|
|
+ return;
|
|
|
+
|
|
|
+ user_id = ppdu_info->user_id;
|
|
|
+
|
|
|
+ if ((tlv_status == HAL_TLV_STATUS_HEADER) && (
|
|
|
+ (rx_enh_capture_mode == CDP_RX_ENH_CAPTURE_MPDU_MSDU) ||
|
|
|
+ ((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;
|
|
|
+ }
|
|
|
+
|
|
|
+ dp_nbuf_set_data_and_len(nbuf, ppdu_info->data,
|
|
|
+ ppdu_info->hdr_len);
|
|
|
+
|
|
|
+ if (pdev->is_mpdu_hdr[user_id]) {
|
|
|
+ qdf_nbuf_queue_add(&pdev->mpdu_q[user_id],
|
|
|
+ nbuf);
|
|
|
+ pdev->is_mpdu_hdr[user_id] = false;
|
|
|
+ } else {
|
|
|
+ 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];
|
|
|
+ nbuf = qdf_nbuf_queue_last(&pdev->mpdu_q[user_id]);
|
|
|
+
|
|
|
+ if (nbuf) {
|
|
|
+ qdf_nbuf_append_ext_list(nbuf,
|
|
|
+ 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(nbuf) = ppdu_info->fcs_err;
|
|
|
+ pdev->is_mpdu_hdr[user_id] = true;
|
|
|
+ } else {
|
|
|
+ dp_rx_free_msdu_list(msdu_list);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * 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, int val)
|
|
|
+{
|
|
|
+ struct dp_pdev *pdev = (struct dp_pdev *)pdev_handle;
|
|
|
+
|
|
|
+ if (pdev->mcopy_mode || (val < CDP_RX_ENH_CAPTURE_DISABLED) ||
|
|
|
+ (val > CDP_RX_ENH_CAPTURE_MPDU_MSDU)) {
|
|
|
+ dp_err("Invalid mode");
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (pdev->rx_enh_capture_mode)
|
|
|
+ dp_reset_monitor_mode(pdev_handle);
|
|
|
+
|
|
|
+ pdev->rx_enh_capture_mode = val;
|
|
|
+ return dp_pdev_configure_monitor_rings(pdev);
|
|
|
+}
|
|
|
+#endif
|
Kai Chen