2c19e70392
Modify poplate mpdu info code for enhanced monitor mode Change-Id: I2541532c8f4f240cc7093f2413a901dd67195684 CRs-Fixed: 2442973
250 行
7.1 KiB
C
250 行
7.1 KiB
C
/*
|
|
* 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->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;
|
|
cdp_mpdu_info->timestamp = ppdu_info->rx_status.tsft;
|
|
|
|
if (ppdu_info->rx_status.reception_type == HAL_RX_TYPE_MU_OFDMA) {
|
|
cdp_mpdu_info->nss = ppdu_info->rx_user_status[user].nss;
|
|
cdp_mpdu_info->mcs = ppdu_info->rx_user_status[user].mcs;
|
|
} 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];
|
|
}
|
|
|
|
/*
|
|
* 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 - 4);
|
|
|
|
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
|