qcacmn: WMI interface changes to configure TWT
Add WMI interface changes required to configure TWT Change-Id: I307f65f8049caf8365fb496fd69f91600ddbd832 CRs-Fixed: 2212556
This commit is contained in:
Kiran Venkatappa
committed by
nshrivas
nshrivas
parent
6c56b09a43
commit
99556ec2cc
407
wmi/src/wmi_unified_twt_tlv.c
Normal file
407
wmi/src/wmi_unified_twt_tlv.c
Normal file
@@ -0,0 +1,407 @@
|
||||
|
||||
/*
|
||||
* Copyright (c) 2018 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 <osdep.h>
|
||||
#include "wmi.h"
|
||||
#include "wmi_unified_priv.h"
|
||||
#include "wmi_unified_twt_param.h"
|
||||
|
||||
static QDF_STATUS send_twt_enable_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_enable_param *params)
|
||||
{
|
||||
wmi_twt_enable_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_enable_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_enable_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_enable_cmd_fixed_param));
|
||||
|
||||
cmd->pdev_id =
|
||||
wmi_handle->ops->convert_pdev_id_host_to_target(
|
||||
params->pdev_id);
|
||||
cmd->sta_cong_timer_ms = params->sta_cong_timer_ms;
|
||||
cmd->mbss_support = params->mbss_support;
|
||||
cmd->default_slot_size = params->default_slot_size;
|
||||
cmd->congestion_thresh_setup = params->congestion_thresh_setup;
|
||||
cmd->congestion_thresh_teardown = params->congestion_thresh_teardown;
|
||||
cmd->congestion_thresh_critical = params->congestion_thresh_critical;
|
||||
cmd->interference_thresh_teardown =
|
||||
params->interference_thresh_teardown;
|
||||
cmd->interference_thresh_setup = params->interference_thresh_setup;
|
||||
cmd->min_no_sta_setup = params->min_no_sta_setup;
|
||||
cmd->min_no_sta_teardown = params->min_no_sta_teardown;
|
||||
cmd->no_of_bcast_mcast_slots = params->no_of_bcast_mcast_slots;
|
||||
cmd->min_no_twt_slots = params->min_no_twt_slots;
|
||||
cmd->max_no_sta_twt = params->max_no_sta_twt;
|
||||
cmd->mode_check_interval = params->mode_check_interval;
|
||||
cmd->add_sta_slot_interval = params->add_sta_slot_interval;
|
||||
cmd->remove_sta_slot_interval = params->remove_sta_slot_interval;
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_ENABLE_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_ENABLE_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
static QDF_STATUS send_twt_disable_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_disable_param *params)
|
||||
{
|
||||
wmi_twt_disable_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_disable_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_disable_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_disable_cmd_fixed_param));
|
||||
|
||||
cmd->pdev_id =
|
||||
wmi_handle->ops->convert_pdev_id_host_to_target(
|
||||
params->pdev_id);
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_DISABLE_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_DISABLE_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static QDF_STATUS send_twt_add_dialog_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_add_dialog_param *params)
|
||||
{
|
||||
wmi_twt_add_dialog_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_add_dialog_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_add_dialog_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_add_dialog_cmd_fixed_param));
|
||||
|
||||
cmd->vdev_id = params->vdev_id;
|
||||
WMI_CHAR_ARRAY_TO_MAC_ADDR(params->peer_macaddr, &cmd->peer_macaddr);
|
||||
cmd->dialog_id = params->dialog_id;
|
||||
cmd->wake_intvl_us = params->wake_intvl_us;
|
||||
cmd->wake_intvl_mantis = params->wake_intvl_mantis;
|
||||
cmd->wake_dura_us = params->wake_dura_us;
|
||||
cmd->sp_offset_us = params->sp_offset_us;
|
||||
TWT_FLAGS_SET_CMD(cmd->flags, params->twt_cmd);
|
||||
TWT_FLAGS_SET_BROADCAST(cmd->flags, params->flag_bcast);
|
||||
TWT_FLAGS_SET_TRIGGER(cmd->flags, params->flag_trigger);
|
||||
TWT_FLAGS_SET_FLOW_TYPE(cmd->flags, params->flag_flow_type);
|
||||
TWT_FLAGS_SET_PROTECTION(cmd->flags, params->flag_protection);
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_ADD_DIALOG_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_ADD_DIALOG_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static QDF_STATUS send_twt_del_dialog_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_del_dialog_param *params)
|
||||
{
|
||||
wmi_twt_del_dialog_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_del_dialog_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_del_dialog_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_del_dialog_cmd_fixed_param));
|
||||
|
||||
cmd->vdev_id = params->vdev_id;
|
||||
cmd->dialog_id = params->dialog_id;
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_DEL_DIALOG_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_DEL_DIALOG_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static QDF_STATUS send_twt_pause_dialog_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_pause_dialog_cmd_param *params)
|
||||
{
|
||||
wmi_twt_pause_dialog_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_pause_dialog_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_pause_dialog_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_pause_dialog_cmd_fixed_param));
|
||||
|
||||
cmd->vdev_id = params->vdev_id;
|
||||
cmd->dialog_id = params->dialog_id;
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_PAUSE_DIALOG_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_PAUSE_DIALOG_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static QDF_STATUS send_twt_resume_dialog_cmd_tlv(wmi_unified_t wmi_handle,
|
||||
struct wmi_twt_resume_dialog_cmd_param *params)
|
||||
{
|
||||
wmi_twt_resume_dialog_cmd_fixed_param *cmd;
|
||||
wmi_buf_t buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
|
||||
if (!buf) {
|
||||
WMI_LOGE("Failed to allocate memory");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
cmd = (wmi_twt_resume_dialog_cmd_fixed_param *) wmi_buf_data(buf);
|
||||
WMITLV_SET_HDR(&cmd->tlv_header,
|
||||
WMITLV_TAG_STRUC_wmi_twt_resume_dialog_cmd_fixed_param,
|
||||
WMITLV_GET_STRUCT_TLVLEN
|
||||
(wmi_twt_resume_dialog_cmd_fixed_param));
|
||||
|
||||
cmd->vdev_id = params->vdev_id;
|
||||
cmd->dialog_id = params->dialog_id;
|
||||
cmd->sp_offset_us = params->sp_offset_us;
|
||||
|
||||
status = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
|
||||
WMI_TWT_RESUME_DIALOG_CMDID);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
WMI_LOGE("Failed to send WMI_TWT_RESUME_DIALOG_CMDID");
|
||||
wmi_buf_free(buf);
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_enable_comp_event_tlv(wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_enable_complete_event_param *params)
|
||||
{
|
||||
WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_enable_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf = (WMI_TWT_ENABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
params->pdev_id =
|
||||
wmi_handle->ops->convert_pdev_id_target_to_host(ev->pdev_id);
|
||||
params->status = ev->status;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_disable_comp_event_tlv(wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_disable_complete_event *params)
|
||||
{
|
||||
WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_disable_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf = (WMI_TWT_DISABLE_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
#if 0
|
||||
params->pdev_id =
|
||||
wmi_handle->ops->convert_pdev_id_target_to_host(ev->pdev_id);
|
||||
params->status = ev->status;
|
||||
#endif
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_add_dialog_comp_event_tlv(
|
||||
wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_add_dialog_complete_event_param *params)
|
||||
{
|
||||
WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_add_dialog_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf = (WMI_TWT_ADD_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
params->vdev_id = ev->vdev_id;
|
||||
params->status = ev->status;
|
||||
params->dialog_id = ev->dialog_id;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_del_dialog_comp_event_tlv(
|
||||
wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_del_dialog_complete_event_param *params)
|
||||
{
|
||||
WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_del_dialog_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf = (WMI_TWT_DEL_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
params->vdev_id = ev->vdev_id;
|
||||
params->dialog_id = ev->dialog_id;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_pause_dialog_comp_event_tlv(
|
||||
wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_pause_dialog_complete_event_param *params)
|
||||
{
|
||||
WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_pause_dialog_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf = (WMI_TWT_PAUSE_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
params->vdev_id = ev->vdev_id;
|
||||
params->status = ev->status;
|
||||
params->dialog_id = ev->dialog_id;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS extract_twt_resume_dialog_comp_event_tlv(
|
||||
wmi_unified_t wmi_handle,
|
||||
uint8_t *evt_buf,
|
||||
struct wmi_twt_resume_dialog_complete_event_param *params)
|
||||
{
|
||||
WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *param_buf;
|
||||
wmi_twt_resume_dialog_complete_event_fixed_param *ev;
|
||||
|
||||
param_buf =
|
||||
(WMI_TWT_RESUME_DIALOG_COMPLETE_EVENTID_param_tlvs *)evt_buf;
|
||||
if (!param_buf) {
|
||||
WMI_LOGE("evt_buf is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ev = param_buf->fixed_param;
|
||||
|
||||
params->vdev_id = ev->vdev_id;
|
||||
params->status = ev->status;
|
||||
params->dialog_id = ev->dialog_id;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
void wmi_twt_attach_tlv(wmi_unified_t wmi_handle)
|
||||
{
|
||||
struct wmi_ops *ops = wmi_handle->ops;
|
||||
|
||||
ops->send_twt_enable_cmd = send_twt_enable_cmd_tlv;
|
||||
ops->send_twt_disable_cmd = send_twt_disable_cmd_tlv;
|
||||
ops->send_twt_add_dialog_cmd = send_twt_add_dialog_cmd_tlv;
|
||||
ops->send_twt_del_dialog_cmd = send_twt_del_dialog_cmd_tlv;
|
||||
ops->send_twt_pause_dialog_cmd = send_twt_pause_dialog_cmd_tlv;
|
||||
ops->send_twt_resume_dialog_cmd = send_twt_resume_dialog_cmd_tlv;
|
||||
ops->extract_twt_enable_comp_event = extract_twt_enable_comp_event_tlv;
|
||||
ops->extract_twt_disable_comp_event =
|
||||
extract_twt_disable_comp_event_tlv;
|
||||
ops->extract_twt_add_dialog_comp_event =
|
||||
extract_twt_add_dialog_comp_event_tlv;
|
||||
ops->extract_twt_del_dialog_comp_event =
|
||||
extract_twt_del_dialog_comp_event_tlv;
|
||||
ops->extract_twt_pause_dialog_comp_event =
|
||||
extract_twt_pause_dialog_comp_event_tlv;
|
||||
ops->extract_twt_resume_dialog_comp_event =
|
||||
extract_twt_resume_dialog_comp_event_tlv;
|
||||
}
|
||||
Reference in New Issue
Block a user