| |
| /* |
| * 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" |
| #include "wmi_unified_twt_api.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; |
| } |