1 /* 2 * Copyright (c) 2017-2019 The Linux Foundation. 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 20 #include <wlan_spectral_utils_api.h> 21 #include <qdf_module.h> 22 #include "../../core/spectral_cmn_api_i.h" 23 #include <wlan_spectral_tgt_api.h> 24 #include <cfg_ucfg_api.h> 25 26 bool wlan_spectral_is_feature_disabled(struct wlan_objmgr_psoc *psoc) 27 { 28 if (!psoc) { 29 spectral_err("PSOC is NULL!"); 30 return true; 31 } 32 33 if (wlan_psoc_nif_feat_cap_get(psoc, WLAN_SOC_F_SPECTRAL_DISABLE)) 34 return true; 35 36 return false; 37 } 38 39 QDF_STATUS 40 wlan_spectral_init(void) 41 { 42 if (wlan_objmgr_register_psoc_create_handler( 43 WLAN_UMAC_COMP_SPECTRAL, 44 wlan_spectral_psoc_obj_create_handler, 45 NULL) != 46 QDF_STATUS_SUCCESS) { 47 return QDF_STATUS_E_FAILURE; 48 } 49 if (wlan_objmgr_register_psoc_destroy_handler( 50 WLAN_UMAC_COMP_SPECTRAL, 51 wlan_spectral_psoc_obj_destroy_handler, 52 NULL) != 53 QDF_STATUS_SUCCESS) { 54 return QDF_STATUS_E_FAILURE; 55 } 56 if (wlan_objmgr_register_pdev_create_handler( 57 WLAN_UMAC_COMP_SPECTRAL, 58 wlan_spectral_pdev_obj_create_handler, 59 NULL) != 60 QDF_STATUS_SUCCESS) { 61 return QDF_STATUS_E_FAILURE; 62 } 63 if (wlan_objmgr_register_pdev_destroy_handler( 64 WLAN_UMAC_COMP_SPECTRAL, 65 wlan_spectral_pdev_obj_destroy_handler, 66 NULL) != 67 QDF_STATUS_SUCCESS) { 68 return QDF_STATUS_E_FAILURE; 69 } 70 71 return QDF_STATUS_SUCCESS; 72 } 73 74 QDF_STATUS 75 wlan_spectral_deinit(void) 76 { 77 if (wlan_objmgr_unregister_psoc_create_handler( 78 WLAN_UMAC_COMP_SPECTRAL, 79 wlan_spectral_psoc_obj_create_handler, 80 NULL) != 81 QDF_STATUS_SUCCESS) { 82 return QDF_STATUS_E_FAILURE; 83 } 84 if (wlan_objmgr_unregister_psoc_destroy_handler( 85 WLAN_UMAC_COMP_SPECTRAL, 86 wlan_spectral_psoc_obj_destroy_handler, 87 NULL) != 88 QDF_STATUS_SUCCESS) { 89 return QDF_STATUS_E_FAILURE; 90 } 91 if (wlan_objmgr_unregister_pdev_create_handler( 92 WLAN_UMAC_COMP_SPECTRAL, 93 wlan_spectral_pdev_obj_create_handler, 94 NULL) != 95 QDF_STATUS_SUCCESS) { 96 return QDF_STATUS_E_FAILURE; 97 } 98 if (wlan_objmgr_unregister_pdev_destroy_handler( 99 WLAN_UMAC_COMP_SPECTRAL, 100 wlan_spectral_pdev_obj_destroy_handler, 101 NULL) != 102 QDF_STATUS_SUCCESS) { 103 return QDF_STATUS_E_FAILURE; 104 } 105 return QDF_STATUS_SUCCESS; 106 } 107 108 QDF_STATUS 109 spectral_register_legacy_cb(struct wlan_objmgr_psoc *psoc, 110 struct spectral_legacy_cbacks *legacy_cbacks) 111 { 112 struct spectral_context *sc; 113 114 sc = spectral_get_spectral_ctx_from_psoc(psoc); 115 if (!sc) { 116 spectral_err("Invalid Context"); 117 return QDF_STATUS_E_FAILURE; 118 } 119 120 sc->legacy_cbacks.vdev_get_chan_freq = 121 legacy_cbacks->vdev_get_chan_freq; 122 sc->legacy_cbacks.vdev_get_ch_width = legacy_cbacks->vdev_get_ch_width; 123 sc->legacy_cbacks.vdev_get_sec20chan_freq_mhz = 124 legacy_cbacks->vdev_get_sec20chan_freq_mhz; 125 126 return QDF_STATUS_SUCCESS; 127 } 128 qdf_export_symbol(spectral_register_legacy_cb); 129 130 int16_t 131 spectral_vdev_get_chan_freq(struct wlan_objmgr_vdev *vdev) 132 { 133 struct spectral_context *sc; 134 135 sc = spectral_get_spectral_ctx_from_vdev(vdev); 136 if (!sc) { 137 spectral_err("spectral context is Null"); 138 return -EINVAL; 139 } 140 141 return sc->legacy_cbacks.vdev_get_chan_freq(vdev); 142 } 143 144 enum phy_ch_width 145 spectral_vdev_get_ch_width(struct wlan_objmgr_vdev *vdev) 146 { 147 struct spectral_context *sc; 148 149 sc = spectral_get_spectral_ctx_from_vdev(vdev); 150 if (!sc) { 151 spectral_err("spectral context is Null"); 152 return CH_WIDTH_INVALID; 153 } 154 155 return sc->legacy_cbacks.vdev_get_ch_width(vdev); 156 } 157 158 int 159 spectral_vdev_get_sec20chan_freq_mhz(struct wlan_objmgr_vdev *vdev, 160 uint16_t *sec20chan_freq) 161 { 162 struct spectral_context *sc; 163 164 sc = spectral_get_spectral_ctx_from_vdev(vdev); 165 if (!sc) { 166 spectral_err("spectral context is Null"); 167 return -EINVAL; 168 } 169 170 return sc->legacy_cbacks.vdev_get_sec20chan_freq_mhz(vdev, 171 sec20chan_freq); 172 } 173 174 void 175 wlan_lmac_if_sptrl_register_rx_ops(struct wlan_lmac_if_rx_ops *rx_ops) 176 { 177 struct wlan_lmac_if_sptrl_rx_ops *sptrl_rx_ops = &rx_ops->sptrl_rx_ops; 178 179 /* Spectral rx ops */ 180 sptrl_rx_ops->sptrlro_get_target_handle = tgt_get_target_handle; 181 sptrl_rx_ops->sptrlro_vdev_get_chan_freq = spectral_vdev_get_chan_freq; 182 sptrl_rx_ops->sptrlro_vdev_get_ch_width = spectral_vdev_get_ch_width; 183 sptrl_rx_ops->sptrlro_vdev_get_sec20chan_freq_mhz = 184 spectral_vdev_get_sec20chan_freq_mhz; 185 sptrl_rx_ops->sptrlro_spectral_is_feature_disabled = 186 wlan_spectral_is_feature_disabled; 187 } 188 189 void 190 wlan_register_wmi_spectral_cmd_ops(struct wlan_objmgr_pdev *pdev, 191 struct wmi_spectral_cmd_ops *cmd_ops) 192 { 193 struct spectral_context *sc; 194 195 if (!pdev) { 196 spectral_err("PDEV is NULL!"); 197 return; 198 } 199 200 sc = spectral_get_spectral_ctx_from_pdev(pdev); 201 if (!sc) { 202 spectral_err("spectral context is NULL!"); 203 return; 204 } 205 206 return sc->sptrlc_register_wmi_spectral_cmd_ops(pdev, cmd_ops); 207 } 208 qdf_export_symbol(wlan_register_wmi_spectral_cmd_ops); 209 210 #ifdef DIRECT_BUF_RX_ENABLE 211 int spectral_dbr_event_handler(struct wlan_objmgr_pdev *pdev, 212 struct direct_buf_rx_data *payload) 213 { 214 struct spectral_context *sc; 215 216 if (!pdev) { 217 spectral_err("PDEV is NULL!"); 218 return -EINVAL; 219 } 220 sc = spectral_get_spectral_ctx_from_pdev(pdev); 221 if (!sc) { 222 spectral_err("spectral context is NULL!"); 223 return -EINVAL; 224 } 225 226 return sc->sptrlc_process_spectral_report(pdev, payload); 227 } 228 #endif 229 230 QDF_STATUS spectral_pdev_open(struct wlan_objmgr_pdev *pdev) 231 { 232 QDF_STATUS status; 233 234 if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) { 235 spectral_info("Spectral is disabled"); 236 return QDF_STATUS_COMP_DISABLED; 237 } 238 239 status = tgt_spectral_register_to_dbr(pdev); 240 return QDF_STATUS_SUCCESS; 241 } 242