1 /* 2 * Copyright (c) 2020-2021, The Linux Foundation. All rights reserved. 3 * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. 4 * 5 * Permission to use, copy, modify, and/or distribute this software for any 6 * purpose with or without fee is hereby granted, provided that the above 7 * copyright notice and this permission notice appear in all copies. 8 * 9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16 */ 17 18 #include "osdep.h" 19 #include "wmi.h" 20 #include "wmi_unified_priv.h" 21 22 /** 23 * extract_dcs_interference_type_tlv() - extract dcs interference type 24 * from event 25 * @wmi_handle: wmi handle 26 * @evt_buf: pointer to event buffer 27 * @param: Pointer to hold dcs interference param 28 * 29 * Return: 0 for success or error code 30 */ 31 static QDF_STATUS extract_dcs_interference_type_tlv( 32 wmi_unified_t wmi_handle, 33 void *evt_buf, struct wlan_host_dcs_interference_param *param) 34 { 35 WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf; 36 37 param_buf = (WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *)evt_buf; 38 if (!param_buf) { 39 wmi_err("Invalid dcs interference event buffer"); 40 return QDF_STATUS_E_INVAL; 41 } 42 43 if (!param_buf->fixed_param) { 44 wmi_err("Invalid fixed param"); 45 return QDF_STATUS_E_INVAL; 46 } 47 48 param->interference_type = param_buf->fixed_param->interference_type; 49 /* Just support tlv currently */ 50 param->pdev_id = wmi_handle->ops->convert_target_pdev_id_to_host( 51 wmi_handle, 52 param_buf->fixed_param->pdev_id); 53 54 return QDF_STATUS_SUCCESS; 55 } 56 57 /** 58 * extract_dcs_im_tgt_stats_tlv() - extract dcs im target stats from event 59 * @wmi_handle: wmi handle 60 * @evt_buf: pointer to event buffer 61 * @wlan_stat: Pointer to hold wlan stats 62 * 63 * Return: 0 for success or error code 64 */ 65 static QDF_STATUS extract_dcs_im_tgt_stats_tlv( 66 wmi_unified_t wmi_handle, 67 void *evt_buf, 68 struct wlan_host_dcs_im_tgt_stats *wlan_stat) 69 { 70 WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf; 71 wlan_dcs_im_tgt_stats_t *ev; 72 73 param_buf = (WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *)evt_buf; 74 if (!param_buf) { 75 wmi_err("Invalid dcs interference event buffer"); 76 return QDF_STATUS_E_INVAL; 77 } 78 79 ev = param_buf->wlan_stat; 80 if (!ev) { 81 wmi_err("Invalid wlan stat"); 82 return QDF_STATUS_E_INVAL; 83 } 84 85 wlan_stat->reg_tsf32 = ev->reg_tsf32; 86 wlan_stat->last_ack_rssi = ev->last_ack_rssi; 87 wlan_stat->tx_waste_time = ev->tx_waste_time; 88 wlan_stat->rx_time = ev->rx_time; 89 wlan_stat->phyerr_cnt = ev->phyerr_cnt; 90 wlan_stat->mib_stats.listen_time = ev->listen_time; 91 wlan_stat->mib_stats.reg_tx_frame_cnt = ev->reg_tx_frame_cnt; 92 wlan_stat->mib_stats.reg_rx_frame_cnt = ev->reg_rx_frame_cnt; 93 wlan_stat->mib_stats.reg_rxclr_cnt = ev->reg_rxclr_cnt; 94 wlan_stat->mib_stats.reg_cycle_cnt = ev->reg_cycle_cnt; 95 wlan_stat->mib_stats.reg_rxclr_ext_cnt = ev->reg_rxclr_ext_cnt; 96 wlan_stat->mib_stats.reg_ofdm_phyerr_cnt = ev->reg_ofdm_phyerr_cnt; 97 wlan_stat->mib_stats.reg_cck_phyerr_cnt = ev->reg_cck_phyerr_cnt; 98 wlan_stat->chan_nf = ev->chan_nf; 99 wlan_stat->my_bss_rx_cycle_count = ev->my_bss_rx_cycle_count; 100 101 return QDF_STATUS_SUCCESS; 102 } 103 104 /* 105 * extract_dcs_awgn_info_tlv() - extract DCS AWGN interference from event 106 * @wmi_handle: wmi handle 107 * @param evt_buf: pointer to event buffer 108 * @param awgn_info: Pointer to hold cw interference 109 * 110 * Return: QDF_STATUS_SUCCESS for success or QDF_STATUS_E_* for error 111 */ 112 static QDF_STATUS 113 extract_dcs_awgn_info_tlv(wmi_unified_t wmi_handle, void *evt_buf, 114 struct wlan_host_dcs_awgn_info *awgn_info) 115 { 116 WMI_DCS_INTERFERENCE_EVENTID_param_tlvs *param_buf; 117 wmi_dcs_awgn_int_t *ev; 118 119 param_buf = evt_buf; 120 if (!param_buf) 121 return QDF_STATUS_E_INVAL; 122 123 ev = param_buf->awgn_int; 124 if (!ev) { 125 wmi_err("Invalid awgn info"); 126 return QDF_STATUS_E_INVAL; 127 } 128 129 awgn_info->channel_width = wmi_map_ch_width(ev->channel_width); 130 awgn_info->center_freq = (qdf_freq_t)ev->chan_freq; 131 awgn_info->center_freq0 = (qdf_freq_t)ev->center_freq0; 132 awgn_info->center_freq1 = (qdf_freq_t)ev->center_freq1; 133 awgn_info->chan_bw_intf_bitmap = ev->chan_bw_interference_bitmap; 134 wmi_debug("width: %u, freq: %u, freq0: %u, freq1: %u, bitmap: 0x%x", 135 awgn_info->channel_width, awgn_info->center_freq, 136 awgn_info->center_freq0, awgn_info->center_freq1, 137 awgn_info->chan_bw_intf_bitmap); 138 139 return QDF_STATUS_SUCCESS; 140 } 141 142 void wmi_dcs_attach_tlv(wmi_unified_t wmi_handle) 143 { 144 struct wmi_ops *ops = wmi_handle->ops; 145 146 ops->extract_dcs_interference_type = extract_dcs_interference_type_tlv; 147 ops->extract_dcs_im_tgt_stats = extract_dcs_im_tgt_stats_tlv; 148 ops->extract_dcs_awgn_info = extract_dcs_awgn_info_tlv; 149 } 150 151