| |
| /* |
| * Copyright (c) 2019 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 <wma_coex.h> |
| #include <wma.h> |
| #include "wmi_unified.h" |
| |
| /** |
| * wma_mws_coex_state_host_event_handler - Coex state Event Handler |
| * @handle: pointer to scn handle |
| * @event: Coex state event |
| * @len: Length of cmd |
| * |
| * Return: 0 on success, else error on failure |
| */ |
| static int wma_mws_coex_state_host_event_handler(void *handle, uint8_t *event, |
| uint32_t len) |
| { |
| WMI_VDEV_GET_MWS_COEX_STATE_EVENTID_param_tlvs *param_tlvs; |
| wmi_vdev_get_mws_coex_state_fixed_param *param_buf; |
| struct mws_coex_state coex_state; |
| struct mac_context *mac = cds_get_context(QDF_MODULE_ID_PE); |
| |
| wma_debug("Enter"); |
| param_tlvs = |
| (WMI_VDEV_GET_MWS_COEX_STATE_EVENTID_param_tlvs *)event; |
| if (!param_tlvs) { |
| wma_err("Invalid stats event"); |
| return -EINVAL; |
| } |
| |
| param_buf = param_tlvs->fixed_param; |
| if (!param_buf || !mac || !mac->sme.mws_coex_info_state_resp_callback) { |
| wma_debug("NULL mac ptr or HDD callback is null"); |
| return -EINVAL; |
| } |
| |
| if (!param_buf) { |
| wma_debug("NULL mws coes state event fixed param"); |
| return -EINVAL; |
| } |
| |
| coex_state.vdev_id = param_buf->vdev_id; |
| coex_state.coex_scheme_bitmap = param_buf->coex_scheme_bitmap; |
| coex_state.active_conflict_count = param_buf->active_conflict_count; |
| coex_state.potential_conflict_count = |
| param_buf->potential_conflict_count; |
| coex_state.chavd_group0_bitmap = param_buf->chavd_group0_bitmap; |
| coex_state.chavd_group1_bitmap = param_buf->chavd_group1_bitmap; |
| coex_state.chavd_group2_bitmap = param_buf->chavd_group2_bitmap; |
| coex_state.chavd_group3_bitmap = param_buf->chavd_group3_bitmap; |
| mac->sme.mws_coex_info_state_resp_callback(&coex_state, |
| mac->sme.mws_coex_info_ctx, |
| WMI_MWS_COEX_STATE); |
| wma_debug("vdev_id = %u coex_scheme_bitmap = %u active_conflict_count = %u potential_conflict_count = %u chavd_group0_bitmap = %u chavd_group1_bitmap = %u chavd_group2_bitmap = %u chavd_group3_bitmap = %u", |
| param_buf->vdev_id, param_buf->coex_scheme_bitmap, |
| param_buf->active_conflict_count, |
| param_buf->potential_conflict_count, |
| param_buf->chavd_group0_bitmap, |
| param_buf->chavd_group1_bitmap, |
| param_buf->chavd_group2_bitmap, |
| param_buf->chavd_group3_bitmap); |
| |
| wma_debug("Exit"); |
| return 0; |
| } |
| |
| /** |
| * wma_mws_coex_state_dpwb_event_handler - DPWB state Event Handler |
| * @handle: handle to scn |
| * @event: DPWB state event |
| * @len: Length of cmd |
| * |
| * Return: 0 on success, else error on failure |
| */ |
| static int wma_mws_coex_state_dpwb_event_handler(void *handle, uint8_t *event, |
| uint32_t len) |
| { |
| WMI_VDEV_GET_MWS_COEX_DPWB_STATE_EVENTID_param_tlvs *param_tlvs; |
| wmi_vdev_get_mws_coex_dpwb_state_fixed_param *param_buf; |
| struct mws_coex_dpwb_state coex_dpwb; |
| struct mac_context *mac = cds_get_context(QDF_MODULE_ID_PE); |
| |
| wma_debug("Enter"); |
| param_tlvs = |
| (WMI_VDEV_GET_MWS_COEX_DPWB_STATE_EVENTID_param_tlvs *)event; |
| if (!param_tlvs) { |
| wma_err("Invalid coex mws event"); |
| return -EINVAL; |
| } |
| |
| param_buf = param_tlvs->fixed_param; |
| if (!param_buf || !mac || !mac->sme.mws_coex_info_state_resp_callback) { |
| wma_debug("NULL mac ptr or HDD callback is null"); |
| return -EINVAL; |
| } |
| |
| if (!param_buf) { |
| wma_err("NULL mws dpwb info event fixed param"); |
| return -EINVAL; |
| } |
| |
| coex_dpwb.vdev_id = param_buf->vdev_id; |
| coex_dpwb.current_dpwb_state = param_buf->current_dpwb_state; |
| coex_dpwb.pnp1_value = param_buf->pnp1_value; |
| coex_dpwb.lte_dutycycle = param_buf->lte_dutycycle; |
| coex_dpwb.sinr_wlan_on = param_buf->sinr_wlan_on; |
| coex_dpwb.sinr_wlan_off = param_buf->sinr_wlan_off; |
| coex_dpwb.bler_count = param_buf->bler_count; |
| coex_dpwb.block_count = param_buf->block_count; |
| coex_dpwb.wlan_rssi_level = param_buf->wlan_rssi_level; |
| coex_dpwb.wlan_rssi = param_buf->wlan_rssi; |
| coex_dpwb.is_tdm_running = param_buf->is_tdm_running; |
| mac->sme.mws_coex_info_state_resp_callback(&coex_dpwb, |
| mac->sme.mws_coex_info_ctx, |
| WMI_MWS_COEX_DPWB_STATE); |
| wma_debug("vdev_id = %u current_dpwb_state = %d pnp1_value = %d lte_dutycycle = %d sinr_wlan_on = %d sinr_wlan_off = %d bler_count = %u block_count = %u wlan_rssi_level = %u wlan_rssi = %d is_tdm_running = %u", |
| param_buf->vdev_id, param_buf->current_dpwb_state, |
| param_buf->pnp1_value, |
| param_buf->lte_dutycycle, param_buf->sinr_wlan_on, |
| param_buf->sinr_wlan_off, param_buf->bler_count, |
| param_buf->block_count, param_buf->wlan_rssi_level, |
| param_buf->wlan_rssi, param_buf->is_tdm_running); |
| |
| wma_debug("Exit"); |
| return 0; |
| } |
| |
| /** |
| * wma_mws_coex_tdm_event_handler - TDM state Event Handler |
| * @handle: handle to scn |
| * @event: TDM state event |
| * @len: Length of cmd |
| * |
| * Return: 0 on success, else error on failure |
| */ |
| static int wma_mws_coex_tdm_event_handler(void *handle, uint8_t *event, |
| uint32_t len) |
| { |
| WMI_VDEV_GET_MWS_COEX_TDM_STATE_EVENTID_param_tlvs *param_tlvs; |
| wmi_vdev_get_mws_coex_tdm_state_fixed_param *param_buf; |
| struct mac_context *mac = cds_get_context(QDF_MODULE_ID_PE); |
| struct mws_coex_tdm_state coex_tdm; |
| |
| wma_debug("Enter"); |
| param_tlvs = |
| (WMI_VDEV_GET_MWS_COEX_TDM_STATE_EVENTID_param_tlvs *)event; |
| if (!param_tlvs) { |
| wma_err("Invalid MWS coex event"); |
| return -EINVAL; |
| } |
| |
| param_buf = param_tlvs->fixed_param; |
| if (!param_buf || !mac || !mac->sme.mws_coex_info_state_resp_callback) { |
| wma_debug("NULL mac ptr or HDD callback is null"); |
| return -EINVAL; |
| } |
| |
| if (!param_buf) { |
| wma_debug("NULL mws tdm info event fixed param"); |
| return -EINVAL; |
| } |
| |
| coex_tdm.vdev_id = param_buf->vdev_id; |
| coex_tdm.tdm_policy_bitmap = param_buf->tdm_policy_bitmap; |
| coex_tdm.tdm_sf_bitmap = param_buf->tdm_sf_bitmap; |
| |
| mac->sme.mws_coex_info_state_resp_callback(&coex_tdm, |
| mac->sme.mws_coex_info_ctx, |
| WMI_MWS_COEX_TDM_STATE); |
| wma_debug("vdev_id = %u tdm_policy_bitmap = %u tdm_sf_bitmap = %u", |
| param_buf->vdev_id, param_buf->tdm_policy_bitmap, |
| param_buf->tdm_sf_bitmap); |
| |
| wma_debug("Exit"); |
| return 0; |
| } |
| |
| /** |
| * wma_mws_coex_idrx_event_handler - IDRX state Event Handler |
| * @handle: handle to scn |
| * @event: IDRX state event |
| * @len: Length of cmd |
| * |
| * Return: 0 on success, else error on failure |
| */ |
| static int wma_mws_coex_idrx_event_handler(void *handle, uint8_t *event, |
| uint32_t len) |
| { |
| WMI_VDEV_GET_MWS_COEX_IDRX_STATE_EVENTID_param_tlvs *param_tlvs; |
| wmi_vdev_get_mws_coex_idrx_state_fixed_param *param_buf; |
| struct mac_context *mac = cds_get_context(QDF_MODULE_ID_PE); |
| struct mws_coex_idrx_state coex_idrx; |
| |
| wma_debug("Enter"); |
| param_tlvs = |
| (WMI_VDEV_GET_MWS_COEX_IDRX_STATE_EVENTID_param_tlvs *)event; |
| if (!param_tlvs) { |
| wma_err("Invalid stats event"); |
| return -EINVAL; |
| } |
| |
| param_buf = param_tlvs->fixed_param; |
| if (!param_buf || !mac || !mac->sme.mws_coex_info_state_resp_callback) { |
| wma_debug("NULL mac ptr or HDD callback is null"); |
| return -EINVAL; |
| } |
| |
| if (!param_buf) { |
| wma_debug("NULL MWS Coex event fixed param"); |
| return -EINVAL; |
| } |
| |
| coex_idrx.vdev_id = param_buf->vdev_id; |
| coex_idrx.sub0_techid = param_buf->sub0_techid; |
| coex_idrx.sub0_policy = param_buf->sub0_policy; |
| coex_idrx.sub0_is_link_critical = param_buf->sub0_is_link_critical; |
| coex_idrx.sub0_static_power = param_buf->sub0_static_power; |
| coex_idrx.sub0_rssi = param_buf->sub0_rssi; |
| coex_idrx.sub1_techid = param_buf->sub1_techid; |
| coex_idrx.sub1_policy = param_buf->sub1_policy; |
| coex_idrx.sub1_is_link_critical = param_buf->sub1_is_link_critical; |
| coex_idrx.sub1_static_power = param_buf->sub1_static_power; |
| coex_idrx.sub1_rssi = param_buf->sub1_rssi; |
| mac->sme.mws_coex_info_state_resp_callback(&coex_idrx, |
| mac->sme.mws_coex_info_ctx, |
| WMI_MWS_COEX_IDRX_STATE); |
| |
| wma_debug("vdev_id = %u sub0_techid = %u sub0_policy = %u sub0_is_link_critical = %u sub0_static_power = %u sub0_rssi = %d sub1_techid = %d sub1_policy = %d sub1_is_link_critical = %d sub1_static_power = %u sub1_rssi= %d", |
| param_buf->vdev_id, param_buf->sub0_techid, |
| param_buf->sub0_policy, param_buf->sub0_is_link_critical, |
| param_buf->sub0_static_power, param_buf->sub0_rssi, |
| param_buf->sub1_techid, param_buf->sub1_policy, |
| param_buf->sub1_is_link_critical, |
| param_buf->sub1_static_power, param_buf->sub1_rssi); |
| |
| wma_debug("EXIT"); |
| return 0; |
| } |
| |
| /** |
| * wma_mws_coex_antenna_sharing_event_handler - Antenna sharing Event Handler |
| * @handle: handle to scn |
| * @event: Antenna sharing state event |
| * @len: Length of cmd |
| * |
| * Return: 0 on success, else error on failure |
| */ |
| static int wma_mws_coex_antenna_sharing_event_handler(void *handle, |
| uint8_t *event, |
| uint32_t len) |
| { |
| WMI_VDEV_GET_MWS_COEX_ANTENNA_SHARING_STATE_EVENTID_param_tlvs |
| *param_tlvs = |
| (WMI_VDEV_GET_MWS_COEX_ANTENNA_SHARING_STATE_EVENTID_param_tlvs *)event; |
| wmi_vdev_get_mws_coex_antenna_sharing_state_fixed_param *param_buf; |
| struct mac_context *mac = cds_get_context(QDF_MODULE_ID_PE); |
| struct mws_antenna_sharing_info *antenna_sharing; |
| |
| wma_debug("Enter"); |
| if (!param_tlvs) { |
| wma_err("Invalid stats event"); |
| return -EINVAL; |
| } |
| |
| param_buf = param_tlvs->fixed_param; |
| if (!param_buf || !mac || !mac->sme.mws_coex_info_state_resp_callback) { |
| wma_debug("NULL mac ptr or HDD callback is null"); |
| return -EINVAL; |
| } |
| |
| if (!param_buf) { |
| wma_debug("NULL MWS event fixed param"); |
| return -EINVAL; |
| } |
| |
| antenna_sharing = qdf_mem_malloc(sizeof(*antenna_sharing)); |
| if (!antenna_sharing) |
| return -ENOMEM; |
| |
| antenna_sharing->vdev_id = param_buf->vdev_id; |
| antenna_sharing->coex_flags = param_buf->coex_flags; |
| antenna_sharing->coex_config = param_buf->coex_config; |
| antenna_sharing->tx_chain_mask = param_buf->tx_chain_mask; |
| antenna_sharing->rx_chain_mask = param_buf->rx_chain_mask; |
| antenna_sharing->rx_nss = param_buf->rx_nss; |
| antenna_sharing->force_mrc = param_buf->force_mrc; |
| antenna_sharing->rssi_type = param_buf->rssi_type; |
| antenna_sharing->chain0_rssi = param_buf->chain0_rssi; |
| antenna_sharing->chain1_rssi = param_buf->chain1_rssi; |
| antenna_sharing->combined_rssi = param_buf->combined_rssi; |
| antenna_sharing->imbalance = param_buf->imbalance; |
| antenna_sharing->mrc_threshold = param_buf->mrc_threshold; |
| antenna_sharing->grant_duration = param_buf->grant_duration; |
| |
| mac->sme.mws_coex_info_state_resp_callback(antenna_sharing, |
| mac->sme.mws_coex_info_ctx, |
| WMI_MWS_COEX_ANTENNA_SHARING_STATE); |
| wma_debug("vdev_id = %u coex_flags = %u coex_config = %u tx_chain_mask = %u rx_chain_mask = %u rx_nss = %u force_mrc = %u rssi_type = %u chain0_rssi = %d chain1_rssi = %d chain0_rssi = %d imbalance = %u mrc_threshold = %d grant_duration = %u", |
| param_buf->vdev_id, param_buf->coex_flags, |
| param_buf->coex_config, param_buf->tx_chain_mask, |
| param_buf->rx_chain_mask, |
| param_buf->rx_nss, param_buf->force_mrc, |
| param_buf->rssi_type, param_buf->chain0_rssi, |
| param_buf->chain1_rssi, param_buf->combined_rssi, |
| param_buf->imbalance, param_buf->mrc_threshold, |
| param_buf->grant_duration); |
| |
| qdf_mem_free(antenna_sharing); |
| wma_debug("EXIT"); |
| return 0; |
| } |
| |
| void wma_get_mws_coex_info_req(tp_wma_handle wma_handle, |
| struct sir_get_mws_coex_info *req) |
| { |
| QDF_STATUS status; |
| |
| status = wmi_unified_send_mws_coex_req_cmd(wma_handle->wmi_handle, |
| req->vdev_id, req->cmd_id); |
| |
| if (QDF_IS_STATUS_ERROR(status)) |
| WMA_LOGE("Failed to send mws coex info"); |
| } |
| |
| void wma_register_mws_coex_events(tp_wma_handle wma_handle) |
| { |
| if (!wma_handle) { |
| wma_err("wma_handle is NULL"); |
| return; |
| } |
| |
| wmi_unified_register_event_handler(wma_handle->wmi_handle, |
| wmi_vdev_get_mws_coex_state_eventid, |
| wma_mws_coex_state_host_event_handler, |
| WMA_RX_SERIALIZER_CTX); |
| |
| wmi_unified_register_event_handler( |
| wma_handle->wmi_handle, |
| wmi_vdev_get_mws_coex_dpwb_state_eventid, |
| wma_mws_coex_state_dpwb_event_handler, |
| WMA_RX_SERIALIZER_CTX); |
| |
| wmi_unified_register_event_handler( |
| wma_handle->wmi_handle, |
| wmi_vdev_get_mws_coex_tdm_state_eventid, |
| wma_mws_coex_tdm_event_handler, |
| WMA_RX_SERIALIZER_CTX); |
| |
| wmi_unified_register_event_handler( |
| wma_handle->wmi_handle, |
| wmi_vdev_get_mws_coex_idrx_state_eventid, |
| wma_mws_coex_idrx_event_handler, |
| WMA_RX_SERIALIZER_CTX); |
| |
| wmi_unified_register_event_handler( |
| wma_handle->wmi_handle, |
| wmi_vdev_get_mws_coex_antenna_sharing_state_eventid, |
| wma_mws_coex_antenna_sharing_event_handler, |
| WMA_RX_SERIALIZER_CTX); |
| } |