1 /* 2 * Copyright (c) 2017-2018 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 } 186 187 void 188 wlan_register_wmi_spectral_cmd_ops(struct wlan_objmgr_pdev *pdev, 189 struct wmi_spectral_cmd_ops *cmd_ops) 190 { 191 struct spectral_context *sc; 192 193 if (!pdev) { 194 spectral_err("PDEV is NULL!"); 195 return; 196 } 197 198 sc = spectral_get_spectral_ctx_from_pdev(pdev); 199 if (!sc) { 200 spectral_err("spectral context is NULL!"); 201 return; 202 } 203 204 return sc->sptrlc_register_wmi_spectral_cmd_ops(pdev, cmd_ops); 205 } 206 qdf_export_symbol(wlan_register_wmi_spectral_cmd_ops); 207 208 #ifdef DIRECT_BUF_RX_ENABLE 209 int spectral_dbr_event_handler(struct wlan_objmgr_pdev *pdev, 210 struct direct_buf_rx_data *payload) 211 { 212 struct spectral_context *sc; 213 214 if (!pdev) { 215 spectral_err("PDEV is NULL!"); 216 return -EINVAL; 217 } 218 sc = spectral_get_spectral_ctx_from_pdev(pdev); 219 if (!sc) { 220 spectral_err("spectral context is NULL!"); 221 return -EINVAL; 222 } 223 224 return sc->sptrlc_process_spectral_report(pdev, payload); 225 } 226 #endif 227 228 QDF_STATUS spectral_pdev_open(struct wlan_objmgr_pdev *pdev) 229 { 230 QDF_STATUS status; 231 232 if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) { 233 spectral_info("Spectral is disabled"); 234 return QDF_STATUS_COMP_DISABLED; 235 } 236 237 status = tgt_spectral_register_to_dbr(pdev); 238 return QDF_STATUS_SUCCESS; 239 } 240