qcacmn: Restore WMI_DFS_RADAR_EVENTID for Rome FW

Currently WMI handler for WMI_PHYERR_EVENTID is used to handle DFS and
spectral scan phy errors; but Rome FW still uses WMI_PHYERR_EVENTID
and WMI_DFS_RADAR_EVENTID and does not have spectral scan phy errors.

Restore WMI_PHYERR_EVENTID and WMI_DFS_RADAR_EVENTID as Rome FW
requirement.

Change-Id: I7a5c4f723bedfdeb477ac36ac1290809ca06fb13
CRs-Fixed: 2160418
This commit is contained in:
bings
2017-12-18 16:39:28 +08:00
committed by snandini
parent faf9682f94
commit 0344d1c399

View File

@@ -1,5 +1,5 @@
/*
* Copyright (c) 2017 The Linux Foundation. All rights reserved.
* Copyright (c) 2017-2018 The Linux Foundation. All rights reserved.
*
*
* Permission to use, copy, modify, and/or distribute this software for
@@ -34,6 +34,7 @@
#include <wmi_unified_param.h>
#include <wmi_unified_dfs_api.h>
#include "wlan_dfs_tgt_api.h"
#include "target_type.h"
static inline struct wlan_lmac_if_dfs_rx_ops *
target_if_dfs_get_rx_ops(struct wlan_objmgr_psoc *psoc)
@@ -41,6 +42,30 @@ target_if_dfs_get_rx_ops(struct wlan_objmgr_psoc *psoc)
return &psoc->soc_cb.rx_ops.dfs_rx_ops;
}
/**
* target_if_is_dfs_3() - Is dfs3 support or not
* @target_type: target type being used.
*
* Return: true if dfs3 is supported, false otherwise.
*/
static bool target_if_is_dfs_3(uint32_t target_type)
{
bool is_dfs_3;
switch (target_type) {
case TARGET_TYPE_AR6320:
is_dfs_3 = false;
break;
case TARGET_TYPE_ADRASTEA:
is_dfs_3 = true;
break;
default:
is_dfs_3 = true;
}
return is_dfs_3;
}
static int target_if_dfs_cac_complete_event_handler(
ol_scn_t scn, uint8_t *data, uint32_t datalen)
{
@@ -173,12 +198,109 @@ static QDF_STATUS target_if_dfs_reg_phyerr_events(struct wlan_objmgr_psoc *psoc)
return QDF_STATUS_SUCCESS;
}
#ifdef QCA_MCL_DFS_SUPPORT
/**
* target_if_radar_event_handler() - handle radar event when
* phyerr filter offload is enabled.
* @scn: Handle to HIF context
* @data: radar event buffer
* @datalen: radar event buffer length
*
* Return: 0 on success; error code otherwise
*/
static int target_if_radar_event_handler(
ol_scn_t scn, uint8_t *data, uint32_t datalen)
{
struct radar_event_info wlan_radar_event;
struct wlan_objmgr_psoc *psoc;
struct wlan_objmgr_pdev *pdev;
struct wlan_lmac_if_dfs_rx_ops *dfs_rx_ops;
if (!scn || !data) {
target_if_err("scn: %pK, data: %pK", scn, data);
return -EINVAL;
}
psoc = target_if_get_psoc_from_scn_hdl(scn);
if (!psoc) {
target_if_err("null psoc");
return -EINVAL;
}
dfs_rx_ops = target_if_dfs_get_rx_ops(psoc);
if (!dfs_rx_ops || !dfs_rx_ops->dfs_process_phyerr_filter_offload) {
target_if_err("Invalid dfs_rx_ops: %pK", dfs_rx_ops);
return -EINVAL;
}
if (QDF_IS_STATUS_ERROR(wmi_extract_wlan_radar_event_info(
GET_WMI_HDL_FROM_PSOC(psoc), data,
&wlan_radar_event, datalen))) {
target_if_err("failed to extract wlan radar event");
return -EFAULT;
}
pdev = wlan_objmgr_get_pdev_by_id(psoc, wlan_radar_event.pdev_id,
WLAN_DFS_ID);
if (!pdev) {
target_if_err("null pdev");
return -EINVAL;
}
dfs_rx_ops->dfs_process_phyerr_filter_offload(pdev,
&wlan_radar_event);
wlan_objmgr_pdev_release_ref(pdev, WLAN_DFS_ID);
return 0;
}
/**
* target_if_reg_phyerr_events() - register dfs phyerr radar event.
* @psoc: pointer to psoc.
* @pdev: pointer to pdev.
*
* Return: QDF_STATUS.
*/
static QDF_STATUS target_if_reg_phyerr_events_dfs2(
struct wlan_objmgr_psoc *psoc,
struct wlan_objmgr_pdev *pdev)
{
int ret = -1;
struct wlan_lmac_if_dfs_rx_ops *dfs_rx_ops;
bool is_phyerr_filter_offload;
dfs_rx_ops = target_if_dfs_get_rx_ops(psoc);
if (dfs_rx_ops && dfs_rx_ops->dfs_is_phyerr_filter_offload)
if (QDF_IS_STATUS_SUCCESS(
dfs_rx_ops->dfs_is_phyerr_filter_offload(pdev,
&is_phyerr_filter_offload)))
if (is_phyerr_filter_offload)
ret = wmi_unified_register_event(
GET_WMI_HDL_FROM_PSOC(psoc),
wmi_dfs_radar_event_id,
target_if_radar_event_handler);
if (ret) {
target_if_err("failed to register wmi_dfs_radar_event_id");
return QDF_STATUS_E_FAILURE;
}
return QDF_STATUS_SUCCESS;
}
#else
static QDF_STATUS target_if_reg_phyerr_events_dfs2(
struct wlan_objmgr_psoc *psoc,
struct wlan_objmgr_pdev *pdev)
{
return QDF_STATUS_SUCCESS;
}
#endif
static QDF_STATUS target_if_dfs_register_event_handler(
struct wlan_objmgr_pdev *pdev,
bool dfs_offload)
{
QDF_STATUS status = QDF_STATUS_SUCCESS;
struct wlan_objmgr_psoc *psoc = NULL;
void *wmi_handle;
struct target_psoc_info *tgt_psoc_info = NULL;
psoc = wlan_pdev_get_psoc(pdev);
if (!psoc) {
@@ -186,11 +308,21 @@ static QDF_STATUS target_if_dfs_register_event_handler(
return QDF_STATUS_E_FAILURE;
}
if (!dfs_offload)
return target_if_dfs_reg_phyerr_events(psoc);
if (!dfs_offload) {
tgt_psoc_info = wlan_psoc_get_tgt_if_handle(psoc);
if (!tgt_psoc_info) {
target_if_err("null tgt_psoc_info");
return QDF_STATUS_E_FAILURE;
}
if (target_if_is_dfs_3(tgt_psoc_info->target_type))
return target_if_dfs_reg_phyerr_events(psoc);
else
return target_if_reg_phyerr_events_dfs2(psoc, pdev);
}
/* dfs offload case, send offload enable command first */
status = wmi_unified_dfs_phyerr_offload_en_cmd(pdev->tgt_if_handle,
wmi_handle = GET_WMI_HDL_FROM_PDEV(pdev);
status = wmi_unified_dfs_phyerr_offload_en_cmd(wmi_handle,
WMI_HOST_PDEV_ID_SOC);
if (QDF_IS_STATUS_SUCCESS(status))
status = target_if_dfs_reg_offload_events(psoc);
@@ -207,7 +339,7 @@ static QDF_STATUS target_process_bang_radar_cmd(
int i;
wmi_unified_t wmi_handle;
wmi_handle = (wmi_unified_t) pdev->tgt_if_handle;
wmi_handle = (wmi_unified_t) GET_WMI_HDL_FROM_PDEV(pdev);
wmi_utest.vdev_id = dfs_unit_test->vdev_id;
wmi_utest.module_id = WLAN_MODULE_PHYERR_DFS;
@@ -222,7 +354,7 @@ static QDF_STATUS target_process_bang_radar_cmd(
wmi_utest.args[IDX_PDEV_ID] = wmi_handle->ops->
convert_pdev_id_host_to_target(pdev->pdev_objmgr.wlan_pdev_id);
status = wmi_unified_unit_test_cmd(pdev->tgt_if_handle, &wmi_utest);
status = wmi_unified_unit_test_cmd(wmi_handle, &wmi_utest);
if (!QDF_IS_STATUS_SUCCESS(status))
target_if_err("dfs: unit_test_cmd send failed %d", status);
@@ -252,6 +384,75 @@ static QDF_STATUS target_if_dfs_is_pdev_5ghz(struct wlan_objmgr_pdev *pdev,
return QDF_STATUS_SUCCESS;
}
#ifdef QCA_MCL_DFS_SUPPORT
/**
* target_if_dfs_set_phyerr_filter_offload() - config phyerr filter offload.
* @pdev: Pointer to DFS pdev object.
* @dfs_phyerr_filter_offload: Phyerr filter offload value.
*
* Return: QDF_STATUS
*/
static QDF_STATUS target_if_dfs_set_phyerr_filter_offload(
struct wlan_objmgr_pdev *pdev,
bool dfs_phyerr_filter_offload)
{
int ret;
void *wmi_handle;
struct wlan_objmgr_psoc *psoc = NULL;
psoc = wlan_pdev_get_psoc(pdev);
if (!psoc) {
target_if_err("null psoc");
return QDF_STATUS_E_FAILURE;
}
wmi_handle = GET_WMI_HDL_FROM_PSOC(psoc);
ret = wmi_unified_dfs_phyerr_filter_offload_en_cmd(
wmi_handle,
dfs_phyerr_filter_offload);
if (ret) {
target_if_err("phyerr filter offload %d set fail",
dfs_phyerr_filter_offload);
return QDF_STATUS_E_FAILURE;
}
return QDF_STATUS_SUCCESS;
}
#else
static QDF_STATUS target_if_dfs_set_phyerr_filter_offload(
struct wlan_objmgr_pdev *pdev,
bool dfs_phyerr_filter_offload)
{
return QDF_STATUS_SUCCESS;
}
#endif
/**
* target_if_dfs_get_caps - get dfs caps.
* @pdev: Pointer to DFS pdev object.
* @dfs_caps: Pointer to dfs_caps structure.
*
* Return: QDF_STATUS
*/
static QDF_STATUS target_if_dfs_get_caps(struct wlan_objmgr_pdev *pdev,
struct wlan_dfs_caps *dfs_caps)
{
if (!dfs_caps) {
target_if_err("null dfs_caps");
return QDF_STATUS_E_FAILURE;
}
dfs_caps->wlan_chip_is_bb_tlv = 1;
dfs_caps->wlan_dfs_combined_rssi_ok = 0;
dfs_caps->wlan_dfs_ext_chan_ok = 0;
dfs_caps->wlan_dfs_use_enhancement = 0;
dfs_caps->wlan_strong_signal_diversiry = 0;
dfs_caps->wlan_fastdiv_val = 0;
return QDF_STATUS_SUCCESS;
}
QDF_STATUS target_if_register_dfs_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
{
struct wlan_lmac_if_dfs_tx_ops *dfs_tx_ops;
@@ -265,8 +466,13 @@ QDF_STATUS target_if_register_dfs_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
dfs_tx_ops->dfs_reg_ev_handler = &target_if_dfs_register_event_handler;
dfs_tx_ops->dfs_process_emulate_bang_radar_cmd =
&target_process_bang_radar_cmd;
&target_process_bang_radar_cmd;
dfs_tx_ops->dfs_is_pdev_5ghz = &target_if_dfs_is_pdev_5ghz;
dfs_tx_ops->dfs_set_phyerr_filter_offload =
&target_if_dfs_set_phyerr_filter_offload;
dfs_tx_ops->dfs_get_caps = &target_if_dfs_get_caps;
return QDF_STATUS_SUCCESS;
}