qcacmn: Add handlers for wmi_pdev_cp_fwstats_eventid

Add common target_if event handler for wmi_pdev_cp_fwstats_eventid
from the control path stats infrastructure of firmware and register
with the wmi.

CRs-Fixed: 2856380
Change-Id: Ia16e34c4dc1e12b817258c5e6d617a8cb560cf5b
This commit is contained in:
Rajasekaran Kalidoss 2021-01-16 06:17:12 +05:30 committed by snandini
parent 2c411d6e74
commit 89296baefb
2 changed files with 270 additions and 0 deletions

View File

@ -120,6 +120,27 @@ target_if_cp_stats_unregister_legacy_event_handler(
}
#endif /* WLAN_SUPPORT_LEGACY_CP_STATS_HANDLERS */
#ifdef WLAN_SUPPORT_INFRA_CTRL_PATH_STATS
/**
* get_infra_cp_stats_id() - convert from to wmi_ctrl_path_stats_id
* @type: type from enum infra_cp_stats_id
*
* Return: wmi_ctrl_path_stats_id code for success or -EINVAL
* for failure
*/
uint32_t get_infra_cp_stats_id(enum infra_cp_stats_id type);
/**
* get_infra_cp_stats_action() - convert action codes from
* enum infra_cp_stats_action to wmi_ctrl_path_stats_action
* @action: action code from enum infra_cp_stats_action
*
* Return: wmi_ctrl_path_stats_action code for success or -EINVAL
* for failure
*/
uint32_t get_infra_cp_stats_action(enum infra_cp_stats_action action);
#endif /* WLAN_SUPPORT_INFRA_CTRL_PATH_STATS */
#else
static inline QDF_STATUS
target_if_cp_stats_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)

View File

@ -33,28 +33,276 @@
#include <wlan_osif_priv.h>
#include <wlan_cp_stats_utils_api.h>
#ifdef WLAN_SUPPORT_INFRA_CTRL_PATH_STATS
uint32_t get_infra_cp_stats_id(enum infra_cp_stats_id type)
{
switch (type) {
case TYPE_REQ_CTRL_PATH_PDEV_TX_STAT:
return WMI_REQUEST_CTRL_PATH_PDEV_TX_STAT;
case TYPE_REQ_CTRL_PATH_VDEV_EXTD_STAT:
return WMI_REQUEST_CTRL_PATH_VDEV_EXTD_STAT;
case TYPE_REQ_CTRL_PATH_MEM_STAT:
return WMI_REQUEST_CTRL_PATH_MEM_STAT;
case TYPE_REQ_CTRL_PATH_TWT_STAT:
return WMI_REQUEST_CTRL_PATH_TWT_STAT;
default:
return -EINVAL;
}
}
uint32_t get_infra_cp_stats_action(enum infra_cp_stats_action action)
{
switch (action) {
case ACTION_REQ_CTRL_PATH_STAT_GET:
return WMI_REQUEST_CTRL_PATH_STAT_GET;
case ACTION_REQ_CTRL_PATH_STAT_RESET:
return WMI_REQUEST_CTRL_PATH_STAT_RESET;
case ACTION_REQ_CTRL_PATH_STAT_START:
return WMI_REQUEST_CTRL_PATH_STAT_START;
case ACTION_REQ_CTRL_PATH_STAT_STOP:
return WMI_REQUEST_CTRL_PATH_STAT_STOP;
default:
return -EINVAL;
}
}
#ifdef WLAN_SUPPORT_TWT
/**
* target_if_infra_cp_stats_twt_event_free() - Free event buffer
* @ev: pointer to infra cp stats event structure
*
* Return: None
*/
static
void target_if_infra_cp_stats_twt_event_free(struct infra_cp_stats_event *ev)
{
qdf_mem_free(ev->twt_infra_cp_stats);
ev->twt_infra_cp_stats = NULL;
}
/**
* target_if_infra_cp_stats_twt_event_alloc() - Allocate event buffer for TWT
* parameters
* @ev: pointer to infra cp stats event structure
*
* Return: QDF_STATUS_SUCCESS on Success, other QDF_STATUS error codes on
* failure
*/
static QDF_STATUS
target_if_infra_cp_stats_twt_event_alloc(struct infra_cp_stats_event *ev)
{
ev->twt_infra_cp_stats =
qdf_mem_malloc(sizeof(*ev->twt_infra_cp_stats) *
INFRA_CP_STATS_MAX_RESP_TWT_DIALOG_ID);
if (!ev->twt_infra_cp_stats) {
cp_stats_err("mem alloc failed for ev.twt_infra_cp_stats");
return QDF_STATUS_E_NOMEM;
}
return QDF_STATUS_SUCCESS;
}
#else
static inline
void target_if_infra_cp_stats_twt_event_free(struct infra_cp_stats_event *ev)
{
}
static inline QDF_STATUS
target_if_infra_cp_stats_twt_event_alloc(struct infra_cp_stats_event *ev)
{
return QDF_STATUS_SUCCESS;
}
static inline
void target_if_infra_cp_stats_free_stats_event(struct infra_cp_stats_event *ev)
{
}
#endif /* WLAN_SUPPORT_TWT */
/**
* target_if_extract_infra_cp_stats_event() - Extract data from stats event
* @wmi_hdl: WMI Handle
* @data: pointer to event data buffer from firmware
* @data_len: length of the data buffer
* @ev: pointer of output structure to be filled with extracted values
*
* Return: QDF_STATUS_SUCCESS on Success, other QDF_STATUS error codes
* on failure
*/
static QDF_STATUS
target_if_extract_infra_cp_stats_event(struct wmi_unified *wmi_hdl,
uint8_t *data, uint32_t data_len,
struct infra_cp_stats_event *ev)
{
QDF_STATUS status;
uint32_t more_flag = 0;
status = wmi_unified_extract_cp_stats_more_pending(wmi_hdl, data,
&more_flag);
status = wmi_unified_extract_infra_cp_stats(wmi_hdl, data,
data_len, ev);
cp_stats_debug("request_id %d", ev->request_id);
return QDF_STATUS_SUCCESS;
}
/**
* target_if_infra_cp_stats_event_handler() - Handle
* wmi_pdev_cp_fwstats_eventid
* @scn: opaque scn handle
* @data: event buffer received from fw
* @datalen: length of event buffer
*
* Return: 0 for success or non zero error codes for failure
*/
static
int target_if_infra_cp_stats_event_handler(ol_scn_t scn, uint8_t *data,
uint32_t datalen)
{
QDF_STATUS status;
struct infra_cp_stats_event ev = {0};
struct wlan_objmgr_psoc *psoc;
struct wmi_unified *wmi_handle;
struct wlan_lmac_if_cp_stats_rx_ops *rx_ops;
if (!scn || !data) {
cp_stats_err("scn: 0x%pK, data: 0x%pK", scn, data);
return -EINVAL;
}
psoc = target_if_get_psoc_from_scn_hdl(scn);
if (!psoc) {
cp_stats_err("null psoc");
return -EINVAL;
}
rx_ops = target_if_cp_stats_get_rx_ops(psoc);
if (!rx_ops || !rx_ops->process_stats_event) {
cp_stats_err("callback not registered");
return -EINVAL;
}
wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
if (!wmi_handle) {
cp_stats_err("wmi_handle is null");
return -EINVAL;
}
status = target_if_infra_cp_stats_twt_event_alloc(&ev);
if (QDF_IS_STATUS_ERROR(status)) {
cp_stats_err("Alloc TWT event mem failed");
goto end;
}
status = target_if_extract_infra_cp_stats_event(wmi_handle, data,
datalen, &ev);
if (QDF_IS_STATUS_ERROR(status)) {
cp_stats_err("extract event failed");
goto end;
}
status = rx_ops->process_infra_stats_event(psoc, &ev);
end:
target_if_infra_cp_stats_twt_event_free(&ev);
return qdf_status_to_os_return(status);
}
#else
static
int target_if_infra_cp_stats_event_handler(ol_scn_t scn, uint8_t *data,
uint32_t datalen)
{
return 0;
}
#endif /* WLAN_SUPPORT_INFRA_CTRL_PATH_STATS */
static QDF_STATUS
target_if_cp_stats_register_event_handler(struct wlan_objmgr_psoc *psoc)
{
struct wmi_unified *wmi_handle;
QDF_STATUS ret_val;
if (!psoc) {
cp_stats_err("PSOC is NULL!");
return QDF_STATUS_E_INVAL;
}
wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
if (!wmi_handle) {
cp_stats_err("wmi_handle is null");
return QDF_STATUS_E_INVAL;
}
ret_val = wmi_unified_register_event_handler(wmi_handle,
wmi_pdev_cp_fwstats_eventid,
target_if_infra_cp_stats_event_handler,
WMI_RX_WORK_CTX);
if (QDF_IS_STATUS_ERROR(ret_val))
cp_stats_err("Failed to register for pdev_cp_fwstats_event");
return QDF_STATUS_SUCCESS;
}
static QDF_STATUS
target_if_cp_stats_unregister_event_handler(struct wlan_objmgr_psoc *psoc)
{
struct wmi_unified *wmi_handle;
if (!psoc) {
cp_stats_err("PSOC is NULL!");
return QDF_STATUS_E_INVAL;
}
wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
if (!wmi_handle) {
cp_stats_err("wmi_handle is null");
return QDF_STATUS_E_INVAL;
}
wmi_unified_unregister_event_handler(wmi_handle,
wmi_pdev_cp_fwstats_eventid);
return QDF_STATUS_SUCCESS;
}
#ifdef WLAN_SUPPORT_INFRA_CTRL_PATH_STATS
/**
* target_if_infra_cp_stats_req() - API to send stats request to wmi
* @psoc: pointer to psoc object
* @req: pointer to object containing stats request parameters
*
* Return: QDF_STATUS_SUCCESS on success, else other qdf error values
*/
static
QDF_STATUS target_if_infra_cp_stats_req(struct wlan_objmgr_psoc *psoc,
struct infra_cp_stats_cmd_info *req)
{
struct wmi_unified *wmi_handle;
wmi_handle = get_wmi_unified_hdl_from_psoc(psoc);
if (!wmi_handle) {
cp_stats_err("wmi_handle is null.");
return QDF_STATUS_E_NULL_VALUE;
}
return wmi_unified_infra_cp_stats_request_send(wmi_handle, req);
}
static void target_if_register_infra_cp_stats_txops(
struct wlan_lmac_if_cp_stats_tx_ops *tx_ops)
{
tx_ops->send_req_infra_cp_stats = target_if_infra_cp_stats_req;
}
#else
static void target_if_register_infra_cp_stats_txops(
struct wlan_lmac_if_cp_stats_tx_ops *tx_ops)
{
}
#endif /* WLAN_SUPPORT_INFRA_CTRL_PATH_STATS */
QDF_STATUS
target_if_cp_stats_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
{
@ -70,6 +318,7 @@ target_if_cp_stats_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops)
cp_stats_err("lmac tx ops is NULL!");
return QDF_STATUS_E_FAILURE;
}
target_if_register_infra_cp_stats_txops(cp_stats_tx_ops);
cp_stats_tx_ops->cp_stats_attach =
target_if_cp_stats_register_event_handler;