qcacld-3.0: Add support for start capture
Add support for start capture. Change-Id: I93a15b0bf8b9c26bd53d33378a7daefece448d68 CRs-Fixed: 3415870
Este commit está contenido en:
Srinivas Girigowda
cometido por
Madan Koyyalamudi
Madan Koyyalamudi
padre
9af1145749
commit
72b8810c2c
61
os_if/dp/inc/os_if_dp_local_pkt_capture.h
Archivo normal
61
os_if/dp/inc/os_if_dp_local_pkt_capture.h
Archivo normal
@@ -0,0 +1,61 @@
|
||||
/*
|
||||
* Copyright (c) 2023 Qualcomm Innovation Center, Inc. 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.
|
||||
*/
|
||||
|
||||
#ifndef _OS_IF_DP_LOCAL_PKT_CAPTURE_H_
|
||||
#define _OS_IF_DP_LOCAL_PKT_CAPTURE_H_
|
||||
|
||||
#include "qdf_types.h"
|
||||
#include "qca_vendor.h"
|
||||
|
||||
#ifdef WLAN_FEATURE_LOCAL_PKT_CAPTURE
|
||||
|
||||
#define FEATURE_MONITOR_MODE_VENDOR_COMMANDS \
|
||||
{ \
|
||||
.info.vendor_id = QCA_NL80211_VENDOR_ID, \
|
||||
.info.subcmd = QCA_NL80211_VENDOR_SUBCMD_SET_MONITOR_MODE, \
|
||||
.flags = WIPHY_VENDOR_CMD_NEED_WDEV | \
|
||||
WIPHY_VENDOR_CMD_NEED_NETDEV | \
|
||||
WIPHY_VENDOR_CMD_NEED_RUNNING, \
|
||||
.doit = wlan_hdd_cfg80211_set_monitor_mode, \
|
||||
vendor_command_policy(set_monitor_mode_policy, \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_MAX) \
|
||||
},
|
||||
|
||||
extern const struct nla_policy
|
||||
set_monitor_mode_policy[QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_MAX + 1];
|
||||
|
||||
/**
|
||||
* os_if_dp_set_lpc_configure() - Configure local packet capture
|
||||
* operation in the received vendor command
|
||||
* @vdev: vdev
|
||||
* @data: NL data
|
||||
* @data_len: NL data length
|
||||
*
|
||||
* Return: QDF_STATUS_SUCCESS if Success;
|
||||
* QDF_STATUS_E_* if Failure
|
||||
*/
|
||||
QDF_STATUS os_if_dp_set_lpc_configure(struct wlan_objmgr_vdev *vdev,
|
||||
const void *data, int data_len);
|
||||
#else
|
||||
static inline
|
||||
QDF_STATUS os_if_dp_set_lpc_configure(struct wlan_objmgr_vdev *vdev,
|
||||
const void *data, int data_len)
|
||||
{
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
#endif /* WLAN_FEATURE_LOCAL_PKT_CAPTURE */
|
||||
#endif
|
||||
239
os_if/dp/src/os_if_dp_local_pkt_capture.c
Archivo normal
239
os_if/dp/src/os_if_dp_local_pkt_capture.c
Archivo normal
@@ -0,0 +1,239 @@
|
||||
/*
|
||||
* Copyright (c) 2023 Qualcomm Innovation Center, Inc. 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 "qdf_types.h"
|
||||
#include <net/cfg80211.h>
|
||||
#include "wlan_cfg80211.h"
|
||||
#include "wlan_objmgr_psoc_obj.h"
|
||||
#include "wlan_objmgr_pdev_obj.h"
|
||||
#include "wlan_objmgr_vdev_obj.h"
|
||||
#include "os_if_dp_local_pkt_capture.h"
|
||||
#include "wlan_dp_ucfg_api.h"
|
||||
#include "wlan_dp_main.h"
|
||||
#include "cdp_txrx_mon.h"
|
||||
#include "wlan_policy_mgr_api.h"
|
||||
#include <ol_defines.h>
|
||||
#include "wlan_osif_priv.h"
|
||||
|
||||
/* Short name for QCA_NL80211_VENDOR_SUBCMD_SET_MONITOR_MODE command */
|
||||
#define SET_MONITOR_MODE_CONFIG_MAX \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_MAX
|
||||
#define SET_MONITOR_MODE_INVALID \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_INVALID
|
||||
#define SET_MONITOR_MODE_DATA_TX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_DATA_TX_FRAME_TYPE
|
||||
#define SET_MONITOR_MODE_DATA_RX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_DATA_RX_FRAME_TYPE
|
||||
#define SET_MONITOR_MODE_MGMT_TX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_MGMT_TX_FRAME_TYPE
|
||||
#define SET_MONITOR_MODE_MGMT_RX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_MGMT_RX_FRAME_TYPE
|
||||
#define SET_MONITOR_MODE_CTRL_TX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_CTRL_TX_FRAME_TYPE
|
||||
#define SET_MONITOR_MODE_CTRL_RX_FRAME_TYPE \
|
||||
QCA_WLAN_VENDOR_ATTR_SET_MONITOR_MODE_CTRL_RX_FRAME_TYPE
|
||||
|
||||
#define MGMT_FRAME_TYPE 0
|
||||
#define DATA_FRAME_TYPE 1
|
||||
#define CTRL_FRAME_TYPE 2
|
||||
|
||||
const struct nla_policy
|
||||
set_monitor_mode_policy[SET_MONITOR_MODE_CONFIG_MAX + 1] = {
|
||||
[SET_MONITOR_MODE_DATA_TX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
[SET_MONITOR_MODE_DATA_RX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
[SET_MONITOR_MODE_MGMT_TX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
[SET_MONITOR_MODE_MGMT_RX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
[SET_MONITOR_MODE_CTRL_TX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
[SET_MONITOR_MODE_CTRL_RX_FRAME_TYPE] = { .type = NLA_U32 },
|
||||
};
|
||||
|
||||
static
|
||||
bool os_if_local_pkt_capture_concurrency_allowed(struct wlan_objmgr_psoc *psoc)
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
static QDF_STATUS os_if_start_capture_allowed(struct wlan_objmgr_vdev *vdev)
|
||||
{
|
||||
enum QDF_OPMODE mode = wlan_vdev_mlme_get_opmode(vdev);
|
||||
struct wlan_objmgr_psoc *psoc;
|
||||
|
||||
psoc = wlan_vdev_get_psoc(vdev);
|
||||
if (!psoc) {
|
||||
osif_err("NULL psoc");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
if (!ucfg_dp_is_local_pkt_capture_enabled(psoc)) {
|
||||
osif_warn("local pkt capture feature not enabled");
|
||||
return QDF_STATUS_E_NOSUPPORT;
|
||||
}
|
||||
|
||||
if (mode != QDF_MONITOR_MODE) {
|
||||
osif_err("Operation not permitted in mode: %d", mode);
|
||||
return QDF_STATUS_E_PERM;
|
||||
}
|
||||
|
||||
/*
|
||||
* Whether STA interface is present or not, is already checked
|
||||
* while creating monitor interface
|
||||
*/
|
||||
|
||||
if (policy_mgr_is_mlo_sta_present(psoc)) {
|
||||
osif_err("MLO STA present, start capture is not permitted");
|
||||
return QDF_STATUS_E_PERM;
|
||||
}
|
||||
|
||||
if (!os_if_local_pkt_capture_concurrency_allowed(psoc)) {
|
||||
osif_err("Concurrency check failed, start capture not allowed");
|
||||
return QDF_STATUS_E_PERM;
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static
|
||||
QDF_STATUS os_if_dp_local_pkt_capture_start(struct wlan_objmgr_vdev *vdev,
|
||||
struct nlattr **tb)
|
||||
{
|
||||
QDF_STATUS status;
|
||||
struct cdp_monitor_filter filter = {0};
|
||||
uint32_t pkt_type = 0, val;
|
||||
void *soc;
|
||||
|
||||
status = os_if_start_capture_allowed(vdev);
|
||||
if (QDF_IS_STATUS_ERROR(status))
|
||||
goto error;
|
||||
|
||||
soc = cds_get_context(QDF_MODULE_ID_SOC);
|
||||
if (!soc)
|
||||
return QDF_STATUS_E_INVAL;
|
||||
|
||||
if (tb[SET_MONITOR_MODE_MGMT_TX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_MGMT_TX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_MGMT_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_MGMT_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(MGMT_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (tb[SET_MONITOR_MODE_MGMT_RX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_MGMT_RX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_MGMT_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_MGMT_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(MGMT_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (tb[SET_MONITOR_MODE_DATA_TX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_DATA_TX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_DATA_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_DATA_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(DATA_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (tb[SET_MONITOR_MODE_DATA_RX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_DATA_RX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_DATA_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_DATA_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(DATA_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (tb[SET_MONITOR_MODE_CTRL_TX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_CTRL_TX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_CTRL_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_CTRL_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(CTRL_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (tb[SET_MONITOR_MODE_CTRL_RX_FRAME_TYPE]) {
|
||||
val = nla_get_u32(tb[SET_MONITOR_MODE_CTRL_RX_FRAME_TYPE]);
|
||||
|
||||
if (val != QCA_WLAN_VENDOR_MONITOR_CTRL_FRAME_TYPE_ALL) {
|
||||
osif_err("Invalid value: %d Expected: %d",
|
||||
val,
|
||||
QCA_WLAN_VENDOR_MONITOR_CTRL_FRAME_TYPE_ALL);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
pkt_type |= BIT(CTRL_FRAME_TYPE);
|
||||
}
|
||||
|
||||
if (pkt_type == 0) {
|
||||
osif_err("Invalid config, pkt_type: %d", pkt_type);
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
osif_debug("start capture config pkt_type:0x%x", pkt_type);
|
||||
|
||||
filter.mode = MON_FILTER_PASS;
|
||||
filter.fp_mgmt = pkt_type & BIT(MGMT_FRAME_TYPE) ? FILTER_MGMT_ALL : 0;
|
||||
filter.fp_data = pkt_type & BIT(DATA_FRAME_TYPE) ? FILTER_DATA_ALL : 0;
|
||||
filter.fp_ctrl = pkt_type & BIT(CTRL_FRAME_TYPE) ? FILTER_CTRL_ALL : 0;
|
||||
|
||||
status = cdp_start_local_pkt_capture(soc, OL_TXRX_PDEV_ID, &filter);
|
||||
|
||||
error:
|
||||
return status;
|
||||
}
|
||||
|
||||
QDF_STATUS os_if_dp_set_lpc_configure(struct wlan_objmgr_vdev *vdev,
|
||||
const void *data, int data_len)
|
||||
{
|
||||
struct nlattr *tb[SET_MONITOR_MODE_CONFIG_MAX + 1];
|
||||
QDF_STATUS status = QDF_STATUS_SUCCESS;
|
||||
|
||||
if (wlan_cfg80211_nla_parse(tb, SET_MONITOR_MODE_CONFIG_MAX,
|
||||
data, data_len, set_monitor_mode_policy)) {
|
||||
osif_err("Invalid monitor attr");
|
||||
status = QDF_STATUS_E_INVAL;
|
||||
goto error;
|
||||
}
|
||||
|
||||
status = os_if_dp_local_pkt_capture_start(vdev, tb);
|
||||
|
||||
error:
|
||||
return status;
|
||||
}
|
||||
|
||||
Referencia en una nueva incidencia
Block a user