| /* |
| * Copyright (c) 2011,2017-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 "spectral_cmn_api_i.h" |
| #include "spectral_ol_api_i.h" |
| #include <qdf_mem.h> |
| #include <qdf_types.h> |
| #ifdef DA_SUPPORT |
| #include "spectral_da_api_i.h" |
| #endif |
| #include <wlan_spectral_public_structs.h> |
| #include <wlan_cfg80211_spectral.h> |
| #include <cfg_ucfg_api.h> |
| |
| /** |
| * spectral_get_vdev() - Get pointer to vdev to be used for Spectral |
| * operations |
| * @pdev: Pointer to pdev |
| * |
| * Spectral operates on pdev. However, in order to retrieve some WLAN |
| * properties, a vdev is required. To facilitate this, the function returns the |
| * first vdev in our pdev. The caller should release the reference to the vdev |
| * once it is done using it. Additionally, the caller should ensure it has a |
| * reference to the pdev at the time of calling this function, and should |
| * release the pdev reference either after this function returns or at a later |
| * time when the caller is done using pdev. |
| * TODO: |
| * - If the framework later provides an API to obtain the first active |
| * vdev, then it would be preferable to use this API. |
| * - Use a common get_vdev() handler for core and target_if using Rx ops. This |
| * is deferred till details emerge on framework providing API to get first |
| * active vdev. |
| * |
| * Return: Pointer to vdev on success, NULL on failure |
| */ |
| static struct wlan_objmgr_vdev* |
| spectral_get_vdev(struct wlan_objmgr_pdev *pdev) |
| { |
| struct wlan_objmgr_vdev *vdev = NULL; |
| |
| qdf_assert_always(pdev); |
| |
| vdev = wlan_objmgr_pdev_get_first_vdev(pdev, WLAN_SPECTRAL_ID); |
| |
| if (!vdev) { |
| spectral_warn("Unable to get first vdev of pdev"); |
| return NULL; |
| } |
| |
| return vdev; |
| } |
| |
| #ifdef SPECTRAL_MODULIZED_ENABLE |
| /** |
| * spectral_register_cfg80211_handlers() - Register spectral cfg80211 handlers |
| * @pdev: Pointer to pdev |
| * |
| * Register spectral cfg80211 handlers |
| * Handlers can be different depending on whether spectral modulized or not |
| * |
| * Return: None |
| */ |
| static void |
| spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev) |
| { |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_START_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_config_and_start); |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_STOP_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_stop); |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_GET_CONFIG_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_get_config); |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_GET_DIAG_STATS_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_get_diag_stats); |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_GET_CAP_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_get_cap); |
| wlan_cfg80211_register_spectral_cmd_handler( |
| pdev, |
| SPECTRAL_SCAN_GET_STATUS_HANDLER_IDX, |
| wlan_cfg80211_spectral_scan_get_status); |
| } |
| #else |
| static void |
| spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev) |
| { |
| } |
| #endif |
| |
| QDF_STATUS |
| spectral_control_cmn(struct wlan_objmgr_pdev *pdev, |
| struct spectral_cp_request *sscan_req) |
| { |
| QDF_STATUS status = QDF_STATUS_E_FAILURE; |
| int temp_debug; |
| struct spectral_config sp_out; |
| struct spectral_config *sp_in; |
| struct spectral_config *spectralparams; |
| struct spectral_context *sc; |
| struct wlan_objmgr_vdev *vdev = NULL; |
| uint8_t vdev_rxchainmask = 0; |
| enum spectral_scan_mode smode = sscan_req->ss_mode; |
| enum spectral_cp_error_code *err; |
| QDF_STATUS ret; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| goto bad; |
| } |
| sc = spectral_get_spectral_ctx_from_pdev(pdev); |
| if (!sc) { |
| spectral_err("Spectral context is NULL!"); |
| goto bad; |
| } |
| |
| switch (sscan_req->req_id) { |
| case SPECTRAL_SET_CONFIG: |
| err = &sscan_req->config_req.sscan_err_code; |
| sp_in = &sscan_req->config_req.sscan_config; |
| if (sp_in->ss_count != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_SCAN_COUNT, |
| sp_in->ss_count, smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_fft_period != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_FFT_PERIOD, |
| sp_in->ss_fft_period, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_period != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_SCAN_PERIOD, |
| sp_in->ss_period, smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_short_report != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_SHORT_REPORT, |
| (uint32_t) |
| sp_in->ss_short_report ? 1 : 0, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_spectral_pri != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_SPECT_PRI, |
| (uint32_t) |
| (sp_in->ss_spectral_pri), |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_fft_size != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_FFT_SIZE, |
| sp_in->ss_fft_size, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_gc_ena != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_GC_ENA, |
| sp_in->ss_gc_ena, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_restart_ena != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_RESTART_ENA, |
| sp_in->ss_restart_ena, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_noise_floor_ref != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_NOISE_FLOOR_REF, |
| sp_in->ss_noise_floor_ref, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_init_delay != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_INIT_DELAY, |
| sp_in->ss_init_delay, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_nb_tone_thr != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_NB_TONE_THR, |
| sp_in->ss_nb_tone_thr, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_str_bin_thr != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_STR_BIN_THR, |
| sp_in->ss_str_bin_thr, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_wb_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_WB_RPT_MODE, |
| sp_in->ss_wb_rpt_mode, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_rssi_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_RSSI_RPT_MODE, |
| sp_in->ss_rssi_rpt_mode, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_rssi_thr != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_RSSI_THR, |
| sp_in->ss_rssi_thr, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_pwr_format != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_PWR_FORMAT, |
| sp_in->ss_pwr_format, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_RPT_MODE, |
| sp_in->ss_rpt_mode, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_bin_scale != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_BIN_SCALE, |
| sp_in->ss_bin_scale, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_dbm_adj != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_DBM_ADJ, |
| sp_in->ss_dbm_adj, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| if (sp_in->ss_chn_mask != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| /* |
| * Check if any of the inactive Rx antenna |
| * chains is set active in spectral chainmask |
| */ |
| vdev = spectral_get_vdev(pdev); |
| if (!vdev) |
| goto bad; |
| |
| vdev_rxchainmask = |
| wlan_vdev_mlme_get_rxchainmask(vdev); |
| wlan_objmgr_vdev_release_ref(vdev, |
| WLAN_SPECTRAL_ID); |
| |
| if (!(sp_in->ss_chn_mask & vdev_rxchainmask)) { |
| spectral_err("Invalid Spectral Chainmask - Inactive Rx antenna chain cannot be an active spectral chain"); |
| goto bad; |
| } else { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_CHN_MASK, |
| sp_in->ss_chn_mask, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| } |
| |
| if (sp_in->ss_frequency != SPECTRAL_PHYERR_PARAM_NOVAL) { |
| ret = sc->sptrlc_set_spectral_config |
| (pdev, |
| SPECTRAL_PARAM_FREQUENCY, |
| sp_in->ss_frequency, |
| smode, err); |
| if (QDF_IS_STATUS_ERROR(ret)) |
| goto bad; |
| } |
| |
| break; |
| |
| case SPECTRAL_GET_CONFIG: |
| sc->sptrlc_get_spectral_config(pdev, &sp_out, smode); |
| spectralparams = &sscan_req->config_req.sscan_config; |
| spectralparams->ss_fft_period = sp_out.ss_fft_period; |
| spectralparams->ss_period = sp_out.ss_period; |
| spectralparams->ss_count = sp_out.ss_count; |
| spectralparams->ss_short_report = |
| sp_out.ss_short_report; |
| spectralparams->ss_spectral_pri = |
| sp_out.ss_spectral_pri; |
| spectralparams->ss_fft_size = sp_out.ss_fft_size; |
| spectralparams->ss_gc_ena = sp_out.ss_gc_ena; |
| spectralparams->ss_restart_ena = sp_out.ss_restart_ena; |
| spectralparams->ss_noise_floor_ref = |
| sp_out.ss_noise_floor_ref; |
| spectralparams->ss_init_delay = sp_out.ss_init_delay; |
| spectralparams->ss_nb_tone_thr = sp_out.ss_nb_tone_thr; |
| spectralparams->ss_str_bin_thr = sp_out.ss_str_bin_thr; |
| spectralparams->ss_wb_rpt_mode = sp_out.ss_wb_rpt_mode; |
| spectralparams->ss_rssi_rpt_mode = |
| sp_out.ss_rssi_rpt_mode; |
| spectralparams->ss_rssi_thr = sp_out.ss_rssi_thr; |
| spectralparams->ss_pwr_format = sp_out.ss_pwr_format; |
| spectralparams->ss_rpt_mode = sp_out.ss_rpt_mode; |
| spectralparams->ss_bin_scale = sp_out.ss_bin_scale; |
| spectralparams->ss_dbm_adj = sp_out.ss_dbm_adj; |
| spectralparams->ss_chn_mask = sp_out.ss_chn_mask; |
| spectralparams->ss_frequency = sp_out.ss_frequency; |
| break; |
| |
| case SPECTRAL_IS_ACTIVE: |
| sscan_req->status_req.is_active = |
| sc->sptrlc_is_spectral_active(pdev, |
| smode); |
| break; |
| |
| case SPECTRAL_IS_ENABLED: |
| sscan_req->status_req.is_enabled = |
| sc->sptrlc_is_spectral_enabled(pdev, |
| smode); |
| break; |
| |
| case SPECTRAL_SET_DEBUG_LEVEL: |
| temp_debug = sscan_req->debug_req.spectral_dbg_level; |
| sc->sptrlc_set_debug_level(pdev, temp_debug); |
| break; |
| |
| case SPECTRAL_GET_DEBUG_LEVEL: |
| sscan_req->debug_req.spectral_dbg_level = |
| sc->sptrlc_get_debug_level(pdev); |
| break; |
| |
| case SPECTRAL_ACTIVATE_SCAN: |
| err = &sscan_req->action_req.sscan_err_code; |
| sc->sptrlc_start_spectral_scan(pdev, smode, err); |
| break; |
| |
| case SPECTRAL_STOP_SCAN: |
| sc->sptrlc_stop_spectral_scan(pdev, smode); |
| break; |
| |
| case SPECTRAL_GET_CAPABILITY_INFO: |
| { |
| struct spectral_caps *caps; |
| |
| caps = &sscan_req->caps_req.sscan_caps; |
| sc->sptrlc_get_spectral_capinfo(pdev, caps); |
| } |
| break; |
| |
| case SPECTRAL_GET_DIAG_STATS: |
| { |
| struct spectral_diag_stats *diag; |
| |
| diag = &sscan_req->diag_req.sscan_diag; |
| sc->sptrlc_get_spectral_diagstats(pdev, diag); |
| } |
| break; |
| |
| case SPECTRAL_GET_CHAN_WIDTH: |
| { |
| uint32_t chan_width; |
| |
| vdev = spectral_get_vdev(pdev); |
| if (!vdev) |
| goto bad; |
| |
| chan_width = spectral_vdev_get_ch_width(vdev); |
| wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID); |
| |
| sscan_req->chan_width_req.chan_width = |
| (uint32_t)chan_width; |
| } |
| break; |
| |
| default: |
| goto bad; |
| break; |
| } |
| |
| status = QDF_STATUS_SUCCESS; |
| bad: |
| return status; |
| } |
| |
| /** |
| * spectral_ctx_deinit() - De-initialize function pointers from spectral context |
| * @sc - Reference to spectral_context object |
| * |
| * Return: None |
| */ |
| static void |
| spectral_ctx_deinit(struct spectral_context *sc) |
| { |
| if (sc) { |
| sc->sptrlc_ucfg_phyerr_config = NULL; |
| sc->sptrlc_pdev_spectral_init = NULL; |
| sc->sptrlc_pdev_spectral_deinit = NULL; |
| sc->sptrlc_set_spectral_config = NULL; |
| sc->sptrlc_get_spectral_config = NULL; |
| sc->sptrlc_start_spectral_scan = NULL; |
| sc->sptrlc_stop_spectral_scan = NULL; |
| sc->sptrlc_is_spectral_active = NULL; |
| sc->sptrlc_is_spectral_enabled = NULL; |
| sc->sptrlc_set_debug_level = NULL; |
| sc->sptrlc_get_debug_level = NULL; |
| sc->sptrlc_get_spectral_capinfo = NULL; |
| sc->sptrlc_get_spectral_diagstats = NULL; |
| } |
| } |
| |
| #ifdef DA_SUPPORT |
| /** |
| * wlan_spectral_init_da() - init context of DA devices |
| * |
| * init context of DA device |
| * |
| * Return: void |
| */ |
| static void |
| wlan_spectral_init_da(struct spectral_context *sc) |
| { |
| spectral_ctx_init_da(sc); |
| } |
| #else |
| static void |
| wlan_spectral_init_da(struct spectral_context *sc) |
| { |
| } |
| #endif |
| |
| QDF_STATUS |
| wlan_spectral_psoc_obj_create_handler(struct wlan_objmgr_psoc *psoc, void *arg) |
| { |
| struct spectral_context *sc = NULL; |
| |
| if (!psoc) { |
| spectral_err("PSOC is NULL"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (cfg_get(psoc, CFG_SPECTRAL_DISABLE)) { |
| wlan_psoc_nif_feat_cap_set(psoc, WLAN_SOC_F_SPECTRAL_DISABLE); |
| spectral_info("Spectral is disabled"); |
| return QDF_STATUS_COMP_DISABLED; |
| } |
| |
| sc = (struct spectral_context *) |
| qdf_mem_malloc(sizeof(struct spectral_context)); |
| if (!sc) |
| return QDF_STATUS_E_NOMEM; |
| |
| qdf_mem_zero(sc, sizeof(struct spectral_context)); |
| sc->psoc_obj = psoc; |
| if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_OL) |
| spectral_ctx_init_ol(sc); |
| else if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_DA) |
| wlan_spectral_init_da(sc); |
| wlan_objmgr_psoc_component_obj_attach(psoc, WLAN_UMAC_COMP_SPECTRAL, |
| (void *)sc, QDF_STATUS_SUCCESS); |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| QDF_STATUS |
| wlan_spectral_psoc_obj_destroy_handler(struct wlan_objmgr_psoc *psoc, |
| void *arg) |
| { |
| struct spectral_context *sc = NULL; |
| |
| if (!psoc) { |
| spectral_err("PSOC is NULL"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (wlan_spectral_is_feature_disabled(psoc)) { |
| spectral_info("Spectral is disabled"); |
| return QDF_STATUS_COMP_DISABLED; |
| } |
| |
| sc = wlan_objmgr_psoc_get_comp_private_obj(psoc, |
| WLAN_UMAC_COMP_SPECTRAL); |
| if (sc) { |
| wlan_objmgr_psoc_component_obj_detach(psoc, |
| WLAN_UMAC_COMP_SPECTRAL, |
| (void *)sc); |
| /* Deinitilise function pointers from spectral context */ |
| spectral_ctx_deinit(sc); |
| qdf_mem_free(sc); |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| QDF_STATUS |
| wlan_spectral_pdev_obj_create_handler(struct wlan_objmgr_pdev *pdev, void *arg) |
| { |
| struct pdev_spectral *ps = NULL; |
| struct spectral_context *sc = NULL; |
| void *target_handle = NULL; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) { |
| spectral_info("Spectral is disabled"); |
| return QDF_STATUS_COMP_DISABLED; |
| } |
| |
| ps = (struct pdev_spectral *) |
| qdf_mem_malloc(sizeof(struct pdev_spectral)); |
| if (!ps) |
| return QDF_STATUS_E_NOMEM; |
| |
| sc = spectral_get_spectral_ctx_from_pdev(pdev); |
| if (!sc) { |
| spectral_err("Spectral context is NULL!"); |
| goto cleanup; |
| } |
| |
| qdf_mem_zero(ps, sizeof(struct pdev_spectral)); |
| ps->psptrl_pdev = pdev; |
| |
| spectral_register_cfg80211_handlers(pdev); |
| if (sc->sptrlc_pdev_spectral_init) { |
| target_handle = sc->sptrlc_pdev_spectral_init(pdev); |
| if (!target_handle) { |
| spectral_err("Spectral lmac object is NULL!"); |
| goto cleanup; |
| } |
| ps->psptrl_target_handle = target_handle; |
| } |
| wlan_objmgr_pdev_component_obj_attach(pdev, WLAN_UMAC_COMP_SPECTRAL, |
| (void *)ps, QDF_STATUS_SUCCESS); |
| |
| return QDF_STATUS_SUCCESS; |
| cleanup: |
| qdf_mem_free(ps); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| QDF_STATUS |
| wlan_spectral_pdev_obj_destroy_handler(struct wlan_objmgr_pdev *pdev, |
| void *arg) |
| { |
| struct pdev_spectral *ps = NULL; |
| struct spectral_context *sc = NULL; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| |
| if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) { |
| spectral_info("Spectral is disabled"); |
| return QDF_STATUS_COMP_DISABLED; |
| } |
| |
| sc = spectral_get_spectral_ctx_from_pdev(pdev); |
| if (!sc) { |
| spectral_err("Spectral context is NULL!"); |
| return QDF_STATUS_E_FAILURE; |
| } |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| if (ps) { |
| if (sc->sptrlc_pdev_spectral_deinit) |
| sc->sptrlc_pdev_spectral_deinit(pdev); |
| ps->psptrl_target_handle = NULL; |
| wlan_objmgr_pdev_component_obj_detach(pdev, |
| WLAN_UMAC_COMP_SPECTRAL, |
| (void *)ps); |
| qdf_mem_free(ps); |
| } |
| |
| return QDF_STATUS_SUCCESS; |
| } |