1 /* 2 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved. 3 * 4 * 5 * Permission to use, copy, modify, and/or distribute this software for 6 * any purpose with or without fee is hereby granted, provided that the 7 * above copyright notice and this permission notice appear in all 8 * copies. 9 * 10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL 11 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED 12 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE 13 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 14 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR 15 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER 16 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR 17 * PERFORMANCE OF THIS SOFTWARE. 18 */ 19 #include <target_if_spatial_reuse.h> 20 #include <wlan_lmac_if_def.h> 21 #include <wmi_unified_api.h> 22 #include <wmi_unified_vdev_api.h> 23 #include <target_if_vdev_mgr_tx_ops.h> 24 #include <init_deinit_lmac.h> 25 #include <wlan_vdev_mlme_api.h> 26 27 static QDF_STATUS spatial_reuse_send_cfg(struct wlan_objmgr_vdev *vdev, 28 uint8_t sr_ctrl, 29 uint8_t non_srg_max_pd_offset) 30 { 31 struct pdev_params pparam; 32 wmi_unified_t wmi_handle; 33 34 wmi_handle = target_if_vdev_mgr_wmi_handle_get(vdev); 35 if (!wmi_handle) { 36 mlme_err("Failed to get WMI handle!"); 37 return QDF_STATUS_E_INVAL; 38 } 39 40 qdf_mem_zero(&pparam, sizeof(pparam)); 41 pparam.param_id = WMI_PDEV_PARAM_SET_CMD_OBSS_PD_THRESHOLD; 42 if (!(sr_ctrl & NON_SRG_PD_SR_DISALLOWED) && 43 (sr_ctrl & NON_SRG_OFFSET_PRESENT)) { 44 QDF_SET_BITS(pparam.param_value, NON_SRG_SPR_ENABLE_POS, 45 NON_SRG_SPR_ENABLE_SIZE, NON_SRG_SPR_ENABLE); 46 QDF_SET_BITS(pparam.param_value, SR_PARAM_VAL_DBM_POS, 47 NON_SRG_PARAM_VAL_DBM_SIZE, 48 SR_PARAM_VAL_DBM_UNIT); 49 QDF_SET_BITS(pparam.param_value, NON_SRG_MAX_PD_OFFSET_POS, 50 NON_SRG_MAX_PD_OFFSET_SIZE, 51 non_srg_max_pd_offset); 52 } 53 54 return wmi_unified_pdev_param_send(wmi_handle, &pparam, 55 WILDCARD_PDEV_ID); 56 } 57 58 static QDF_STATUS 59 spatial_reuse_send_sr_prohibit_cfg(struct wlan_objmgr_vdev *vdev, 60 bool he_siga_va15_allowed) 61 { 62 struct sr_prohibit_param srp_param; 63 wmi_unified_t wmi_handle; 64 65 wmi_handle = target_if_vdev_mgr_wmi_handle_get(vdev); 66 if (!wmi_handle) { 67 mlme_err("Failed to get WMI handle!"); 68 return QDF_STATUS_E_INVAL; 69 } 70 71 srp_param.vdev_id = wlan_vdev_get_id(vdev); 72 srp_param.sr_he_siga_val15_allowed = he_siga_va15_allowed; 73 74 return wmi_unified_vdev_param_sr_prohibit_send(wmi_handle, &srp_param); 75 } 76 77 #ifdef OBSS_PD 78 static QDF_STATUS 79 spatial_reuse_send_bss_color_bit_map(struct wlan_objmgr_vdev *vdev, 80 struct wlan_objmgr_pdev *pdev) 81 { 82 uint64_t srg_color_bit_map = 0; 83 uint32_t bit_map_0 = 0; 84 uint32_t bit_map_1 = 0; 85 struct wmi_unified *wmi_handle; 86 QDF_STATUS status = QDF_STATUS_SUCCESS; 87 88 wmi_handle = lmac_get_pdev_wmi_handle(pdev); 89 if (!wmi_handle) 90 return QDF_STATUS_E_INVAL; 91 92 wlan_vdev_obj_lock(vdev); 93 wlan_vdev_mlme_get_srg_bss_color_bit_map(vdev, &srg_color_bit_map); 94 wlan_vdev_obj_unlock(vdev); 95 bit_map_0 = (uint32_t) srg_color_bit_map; 96 bit_map_1 = (uint32_t) (srg_color_bit_map >> 32); 97 98 status = wmi_unified_send_self_srg_bss_color_bitmap_set_cmd( 99 wmi_handle, bit_map_0, bit_map_1, 100 pdev->pdev_objmgr.wlan_pdev_id); 101 return status; 102 } 103 104 static QDF_STATUS 105 spatial_reuse_send_partial_bssid_bit_map(struct wlan_objmgr_vdev *vdev, 106 struct wlan_objmgr_pdev *pdev) 107 { 108 uint64_t partial_bssid_bit_map = 0; 109 uint32_t bit_map_0 = 0; 110 uint32_t bit_map_1 = 0; 111 struct wmi_unified *wmi_handle; 112 QDF_STATUS status = QDF_STATUS_SUCCESS; 113 114 wmi_handle = lmac_get_pdev_wmi_handle(pdev); 115 if (!wmi_handle) 116 return QDF_STATUS_E_INVAL; 117 118 wlan_vdev_obj_lock(vdev); 119 wlan_vdev_mlme_get_srg_partial_bssid_bit_map(vdev, 120 &partial_bssid_bit_map); 121 wlan_vdev_obj_unlock(vdev); 122 bit_map_0 = (uint32_t) partial_bssid_bit_map; 123 bit_map_1 = (uint32_t) (partial_bssid_bit_map >> 32); 124 125 status = wmi_unified_send_self_srg_partial_bssid_bitmap_set_cmd( 126 wmi_handle, bit_map_0, bit_map_1, 127 pdev->pdev_objmgr.wlan_pdev_id); 128 return status; 129 } 130 #else 131 static QDF_STATUS 132 spatial_reuse_send_bss_color_bit_map(struct wlan_objmgr_vdev *vdev, 133 struct wlan_objmgr_pdev *pdev) 134 { 135 return QDF_STATUS_SUCCESS; 136 } 137 138 static QDF_STATUS 139 spatial_reuse_send_partial_bssid_bit_map(struct wlan_objmgr_vdev *vdev, 140 struct wlan_objmgr_pdev *pdev) 141 { 142 return QDF_STATUS_SUCCESS; 143 } 144 #endif 145 146 static QDF_STATUS 147 spatial_reuse_send_pd_threshold(struct wlan_objmgr_pdev *pdev, 148 uint8_t vdev_id, 149 uint32_t val) 150 { 151 struct vdev_set_params vdev_param; 152 struct wmi_unified *wmi_handle; 153 bool sr_supported; 154 155 wmi_handle = lmac_get_pdev_wmi_handle(pdev); 156 if (!wmi_handle) 157 return QDF_STATUS_E_INVAL; 158 159 sr_supported = 160 wmi_service_enabled(wmi_handle, 161 wmi_service_srg_srp_spatial_reuse_support); 162 163 if (sr_supported) { 164 qdf_mem_zero(&vdev_param, sizeof(vdev_param)); 165 vdev_param.vdev_id = vdev_id; 166 vdev_param.param_id = wmi_vdev_param_set_cmd_obss_pd_threshold; 167 vdev_param.param_value = val; 168 return wmi_unified_vdev_set_param_send(wmi_handle, &vdev_param); 169 } else { 170 mlme_debug("Target doesn't support SR operations"); 171 } 172 return QDF_STATUS_SUCCESS; 173 } 174 175 /** 176 * spatial_reuse_set_sr_enable_disable: To send wmi command to enable/disable SR 177 * @vdev: object manager vdev 178 * @pdev: object manager pdev 179 * @is_sr_enable: sr enable/disable 180 * @srg_pd_threshold: SRG pd threshold 181 * @non_srg_pd_threshold: NON-SRG pd threshold 182 * 183 * Return: Success/Failure 184 */ 185 static QDF_STATUS 186 spatial_reuse_set_sr_enable_disable(struct wlan_objmgr_vdev *vdev, 187 struct wlan_objmgr_pdev *pdev, 188 bool is_sr_enable, int32_t srg_pd_threshold, 189 int32_t non_srg_pd_threshold) 190 { 191 uint32_t val = 0; 192 uint8_t sr_ctrl; 193 struct wlan_objmgr_psoc *psoc; 194 QDF_STATUS status = QDF_STATUS_SUCCESS; 195 196 psoc = wlan_pdev_get_psoc(pdev); 197 if (!psoc) 198 return QDF_STATUS_E_NOENT; 199 200 sr_ctrl = wlan_vdev_mlme_get_sr_ctrl(vdev); 201 if ((!(sr_ctrl & NON_SRG_PD_SR_DISALLOWED) && 202 (sr_ctrl & NON_SRG_OFFSET_PRESENT)) || 203 (sr_ctrl & SRG_INFO_PRESENT)) { 204 if (is_sr_enable) { 205 wlan_mlme_update_sr_data(vdev, &val, srg_pd_threshold, 206 non_srg_pd_threshold, 207 is_sr_enable); 208 wlan_vdev_obj_lock(vdev); 209 wlan_vdev_mlme_set_he_spr_enabled(vdev, true); 210 wlan_vdev_obj_unlock(vdev); 211 } else { 212 wlan_vdev_obj_lock(vdev); 213 wlan_vdev_mlme_set_he_spr_enabled(vdev, false); 214 wlan_vdev_obj_unlock(vdev); 215 } 216 217 mlme_debug("srp param val: %u, enable: %d", 218 val, is_sr_enable); 219 if (is_sr_enable) { 220 status = spatial_reuse_send_bss_color_bit_map(vdev, 221 pdev); 222 if (status != QDF_STATUS_SUCCESS) 223 return status; 224 status = spatial_reuse_send_partial_bssid_bit_map(vdev, 225 pdev); 226 if (status != QDF_STATUS_SUCCESS) 227 return status; 228 } 229 status = 230 spatial_reuse_send_pd_threshold(pdev, vdev->vdev_objmgr.vdev_id, 231 val); 232 if (status != QDF_STATUS_SUCCESS) 233 return status; 234 } else { 235 mlme_debug("Spatial reuse not enabled"); 236 } 237 238 return status; 239 } 240 241 void target_if_spatial_reuse_register_tx_ops(struct wlan_lmac_if_tx_ops *tx_ops) 242 { 243 tx_ops->spatial_reuse_tx_ops.send_cfg = spatial_reuse_send_cfg; 244 tx_ops->spatial_reuse_tx_ops.send_sr_prohibit_cfg = 245 spatial_reuse_send_sr_prohibit_cfg; 246 tx_ops->spatial_reuse_tx_ops.target_if_set_sr_enable_disable = 247 spatial_reuse_set_sr_enable_disable; 248 } 249