spectral_common.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672
  1. /*
  2. * Copyright (c) 2011,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. #include "spectral_cmn_api_i.h"
  20. #include "spectral_ol_api_i.h"
  21. #include <qdf_mem.h>
  22. #include <qdf_types.h>
  23. #ifdef DA_SUPPORT
  24. #include "spectral_da_api_i.h"
  25. #endif
  26. #include <wlan_spectral_public_structs.h>
  27. #include <wlan_cfg80211_spectral.h>
  28. #include <cfg_ucfg_api.h>
  29. /**
  30. * spectral_get_vdev() - Get pointer to vdev to be used for Spectral
  31. * operations
  32. * @pdev: Pointer to pdev
  33. *
  34. * Spectral operates on pdev. However, in order to retrieve some WLAN
  35. * properties, a vdev is required. To facilitate this, the function returns the
  36. * first vdev in our pdev. The caller should release the reference to the vdev
  37. * once it is done using it. Additionally, the caller should ensure it has a
  38. * reference to the pdev at the time of calling this function, and should
  39. * release the pdev reference either after this function returns or at a later
  40. * time when the caller is done using pdev.
  41. * TODO:
  42. * - If the framework later provides an API to obtain the first active
  43. * vdev, then it would be preferable to use this API.
  44. * - Use a common get_vdev() handler for core and target_if using Rx ops. This
  45. * is deferred till details emerge on framework providing API to get first
  46. * active vdev.
  47. *
  48. * Return: Pointer to vdev on success, NULL on failure
  49. */
  50. static struct wlan_objmgr_vdev*
  51. spectral_get_vdev(struct wlan_objmgr_pdev *pdev)
  52. {
  53. struct wlan_objmgr_vdev *vdev = NULL;
  54. qdf_assert_always(pdev);
  55. vdev = wlan_objmgr_pdev_get_first_vdev(pdev, WLAN_SPECTRAL_ID);
  56. if (!vdev) {
  57. spectral_warn("Unable to get first vdev of pdev");
  58. return NULL;
  59. }
  60. return vdev;
  61. }
  62. #ifdef SPECTRAL_MODULIZED_ENABLE
  63. /**
  64. * spectral_register_cfg80211_handlers() - Register spectral cfg80211 handlers
  65. * @pdev: Pointer to pdev
  66. *
  67. * Register spectral cfg80211 handlers
  68. * Handlers can be different depending on whether spectral modulized or not
  69. *
  70. * Return: None
  71. */
  72. static void
  73. spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev)
  74. {
  75. wlan_cfg80211_register_spectral_cmd_handler(
  76. pdev,
  77. SPECTRAL_SCAN_START_HANDLER_IDX,
  78. wlan_cfg80211_spectral_scan_config_and_start);
  79. wlan_cfg80211_register_spectral_cmd_handler(
  80. pdev,
  81. SPECTRAL_SCAN_STOP_HANDLER_IDX,
  82. wlan_cfg80211_spectral_scan_stop);
  83. wlan_cfg80211_register_spectral_cmd_handler(
  84. pdev,
  85. SPECTRAL_SCAN_GET_CONFIG_HANDLER_IDX,
  86. wlan_cfg80211_spectral_scan_get_config);
  87. wlan_cfg80211_register_spectral_cmd_handler(
  88. pdev,
  89. SPECTRAL_SCAN_GET_DIAG_STATS_HANDLER_IDX,
  90. wlan_cfg80211_spectral_scan_get_diag_stats);
  91. wlan_cfg80211_register_spectral_cmd_handler(
  92. pdev,
  93. SPECTRAL_SCAN_GET_CAP_HANDLER_IDX,
  94. wlan_cfg80211_spectral_scan_get_cap);
  95. wlan_cfg80211_register_spectral_cmd_handler(
  96. pdev,
  97. SPECTRAL_SCAN_GET_STATUS_HANDLER_IDX,
  98. wlan_cfg80211_spectral_scan_get_status);
  99. }
  100. #else
  101. static void
  102. spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev)
  103. {
  104. }
  105. #endif
  106. QDF_STATUS
  107. spectral_control_cmn(struct wlan_objmgr_pdev *pdev,
  108. struct spectral_cp_request *sscan_req)
  109. {
  110. QDF_STATUS status = QDF_STATUS_E_FAILURE;
  111. int temp_debug;
  112. struct spectral_config sp_out;
  113. struct spectral_config *sp_in;
  114. struct spectral_config *spectralparams;
  115. struct spectral_context *sc;
  116. struct wlan_objmgr_vdev *vdev = NULL;
  117. uint8_t vdev_rxchainmask = 0;
  118. enum spectral_scan_mode smode = sscan_req->ss_mode;
  119. enum spectral_cp_error_code *err;
  120. QDF_STATUS ret;
  121. if (!pdev) {
  122. spectral_err("PDEV is NULL!");
  123. goto bad;
  124. }
  125. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  126. if (!sc) {
  127. spectral_err("Spectral context is NULL!");
  128. goto bad;
  129. }
  130. switch (sscan_req->req_id) {
  131. case SPECTRAL_SET_CONFIG:
  132. err = &sscan_req->config_req.sscan_err_code;
  133. sp_in = &sscan_req->config_req.sscan_config;
  134. if (sp_in->ss_count != SPECTRAL_PHYERR_PARAM_NOVAL) {
  135. ret = sc->sptrlc_set_spectral_config
  136. (pdev,
  137. SPECTRAL_PARAM_SCAN_COUNT,
  138. sp_in->ss_count, smode, err);
  139. if (QDF_IS_STATUS_ERROR(ret))
  140. goto bad;
  141. }
  142. if (sp_in->ss_fft_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  143. ret = sc->sptrlc_set_spectral_config
  144. (pdev,
  145. SPECTRAL_PARAM_FFT_PERIOD,
  146. sp_in->ss_fft_period,
  147. smode, err);
  148. if (QDF_IS_STATUS_ERROR(ret))
  149. goto bad;
  150. }
  151. if (sp_in->ss_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  152. ret = sc->sptrlc_set_spectral_config
  153. (pdev,
  154. SPECTRAL_PARAM_SCAN_PERIOD,
  155. sp_in->ss_period, smode, err);
  156. if (QDF_IS_STATUS_ERROR(ret))
  157. goto bad;
  158. }
  159. if (sp_in->ss_short_report != SPECTRAL_PHYERR_PARAM_NOVAL) {
  160. ret = sc->sptrlc_set_spectral_config
  161. (pdev,
  162. SPECTRAL_PARAM_SHORT_REPORT,
  163. (uint32_t)
  164. sp_in->ss_short_report ? 1 : 0,
  165. smode, err);
  166. if (QDF_IS_STATUS_ERROR(ret))
  167. goto bad;
  168. }
  169. if (sp_in->ss_spectral_pri != SPECTRAL_PHYERR_PARAM_NOVAL) {
  170. ret = sc->sptrlc_set_spectral_config
  171. (pdev,
  172. SPECTRAL_PARAM_SPECT_PRI,
  173. (uint32_t)
  174. (sp_in->ss_spectral_pri),
  175. smode, err);
  176. if (QDF_IS_STATUS_ERROR(ret))
  177. goto bad;
  178. }
  179. if (sp_in->ss_fft_size != SPECTRAL_PHYERR_PARAM_NOVAL) {
  180. ret = sc->sptrlc_set_spectral_config
  181. (pdev,
  182. SPECTRAL_PARAM_FFT_SIZE,
  183. sp_in->ss_fft_size,
  184. smode, err);
  185. if (QDF_IS_STATUS_ERROR(ret))
  186. goto bad;
  187. }
  188. if (sp_in->ss_gc_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  189. ret = sc->sptrlc_set_spectral_config
  190. (pdev,
  191. SPECTRAL_PARAM_GC_ENA,
  192. sp_in->ss_gc_ena,
  193. smode, err);
  194. if (QDF_IS_STATUS_ERROR(ret))
  195. goto bad;
  196. }
  197. if (sp_in->ss_restart_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  198. ret = sc->sptrlc_set_spectral_config
  199. (pdev,
  200. SPECTRAL_PARAM_RESTART_ENA,
  201. sp_in->ss_restart_ena,
  202. smode, err);
  203. if (QDF_IS_STATUS_ERROR(ret))
  204. goto bad;
  205. }
  206. if (sp_in->ss_noise_floor_ref != SPECTRAL_PHYERR_PARAM_NOVAL) {
  207. ret = sc->sptrlc_set_spectral_config
  208. (pdev,
  209. SPECTRAL_PARAM_NOISE_FLOOR_REF,
  210. sp_in->ss_noise_floor_ref,
  211. smode, err);
  212. if (QDF_IS_STATUS_ERROR(ret))
  213. goto bad;
  214. }
  215. if (sp_in->ss_init_delay != SPECTRAL_PHYERR_PARAM_NOVAL) {
  216. ret = sc->sptrlc_set_spectral_config
  217. (pdev,
  218. SPECTRAL_PARAM_INIT_DELAY,
  219. sp_in->ss_init_delay,
  220. smode, err);
  221. if (QDF_IS_STATUS_ERROR(ret))
  222. goto bad;
  223. }
  224. if (sp_in->ss_nb_tone_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  225. ret = sc->sptrlc_set_spectral_config
  226. (pdev,
  227. SPECTRAL_PARAM_NB_TONE_THR,
  228. sp_in->ss_nb_tone_thr,
  229. smode, err);
  230. if (QDF_IS_STATUS_ERROR(ret))
  231. goto bad;
  232. }
  233. if (sp_in->ss_str_bin_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  234. ret = sc->sptrlc_set_spectral_config
  235. (pdev,
  236. SPECTRAL_PARAM_STR_BIN_THR,
  237. sp_in->ss_str_bin_thr,
  238. smode, err);
  239. if (QDF_IS_STATUS_ERROR(ret))
  240. goto bad;
  241. }
  242. if (sp_in->ss_wb_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  243. ret = sc->sptrlc_set_spectral_config
  244. (pdev,
  245. SPECTRAL_PARAM_WB_RPT_MODE,
  246. sp_in->ss_wb_rpt_mode,
  247. smode, err);
  248. if (QDF_IS_STATUS_ERROR(ret))
  249. goto bad;
  250. }
  251. if (sp_in->ss_rssi_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  252. ret = sc->sptrlc_set_spectral_config
  253. (pdev,
  254. SPECTRAL_PARAM_RSSI_RPT_MODE,
  255. sp_in->ss_rssi_rpt_mode,
  256. smode, err);
  257. if (QDF_IS_STATUS_ERROR(ret))
  258. goto bad;
  259. }
  260. if (sp_in->ss_rssi_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  261. ret = sc->sptrlc_set_spectral_config
  262. (pdev,
  263. SPECTRAL_PARAM_RSSI_THR,
  264. sp_in->ss_rssi_thr,
  265. smode, err);
  266. if (QDF_IS_STATUS_ERROR(ret))
  267. goto bad;
  268. }
  269. if (sp_in->ss_pwr_format != SPECTRAL_PHYERR_PARAM_NOVAL) {
  270. ret = sc->sptrlc_set_spectral_config
  271. (pdev,
  272. SPECTRAL_PARAM_PWR_FORMAT,
  273. sp_in->ss_pwr_format,
  274. smode, err);
  275. if (QDF_IS_STATUS_ERROR(ret))
  276. goto bad;
  277. }
  278. if (sp_in->ss_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  279. ret = sc->sptrlc_set_spectral_config
  280. (pdev,
  281. SPECTRAL_PARAM_RPT_MODE,
  282. sp_in->ss_rpt_mode,
  283. smode, err);
  284. if (QDF_IS_STATUS_ERROR(ret))
  285. goto bad;
  286. }
  287. if (sp_in->ss_bin_scale != SPECTRAL_PHYERR_PARAM_NOVAL) {
  288. ret = sc->sptrlc_set_spectral_config
  289. (pdev,
  290. SPECTRAL_PARAM_BIN_SCALE,
  291. sp_in->ss_bin_scale,
  292. smode, err);
  293. if (QDF_IS_STATUS_ERROR(ret))
  294. goto bad;
  295. }
  296. if (sp_in->ss_dbm_adj != SPECTRAL_PHYERR_PARAM_NOVAL) {
  297. ret = sc->sptrlc_set_spectral_config
  298. (pdev,
  299. SPECTRAL_PARAM_DBM_ADJ,
  300. sp_in->ss_dbm_adj,
  301. smode, err);
  302. if (QDF_IS_STATUS_ERROR(ret))
  303. goto bad;
  304. }
  305. if (sp_in->ss_chn_mask != SPECTRAL_PHYERR_PARAM_NOVAL) {
  306. /*
  307. * Check if any of the inactive Rx antenna
  308. * chains is set active in spectral chainmask
  309. */
  310. vdev = spectral_get_vdev(pdev);
  311. if (!vdev)
  312. goto bad;
  313. vdev_rxchainmask =
  314. wlan_vdev_mlme_get_rxchainmask(vdev);
  315. wlan_objmgr_vdev_release_ref(vdev,
  316. WLAN_SPECTRAL_ID);
  317. if (!(sp_in->ss_chn_mask & vdev_rxchainmask)) {
  318. spectral_err("Invalid Spectral Chainmask - Inactive Rx antenna chain cannot be an active spectral chain");
  319. goto bad;
  320. } else {
  321. ret = sc->sptrlc_set_spectral_config
  322. (pdev,
  323. SPECTRAL_PARAM_CHN_MASK,
  324. sp_in->ss_chn_mask,
  325. smode, err);
  326. if (QDF_IS_STATUS_ERROR(ret))
  327. goto bad;
  328. }
  329. }
  330. if (sp_in->ss_frequency != SPECTRAL_PHYERR_PARAM_NOVAL) {
  331. ret = sc->sptrlc_set_spectral_config
  332. (pdev,
  333. SPECTRAL_PARAM_FREQUENCY,
  334. sp_in->ss_frequency,
  335. smode, err);
  336. if (QDF_IS_STATUS_ERROR(ret))
  337. goto bad;
  338. }
  339. break;
  340. case SPECTRAL_GET_CONFIG:
  341. sc->sptrlc_get_spectral_config(pdev, &sp_out, smode);
  342. spectralparams = &sscan_req->config_req.sscan_config;
  343. spectralparams->ss_fft_period = sp_out.ss_fft_period;
  344. spectralparams->ss_period = sp_out.ss_period;
  345. spectralparams->ss_count = sp_out.ss_count;
  346. spectralparams->ss_short_report =
  347. sp_out.ss_short_report;
  348. spectralparams->ss_spectral_pri =
  349. sp_out.ss_spectral_pri;
  350. spectralparams->ss_fft_size = sp_out.ss_fft_size;
  351. spectralparams->ss_gc_ena = sp_out.ss_gc_ena;
  352. spectralparams->ss_restart_ena = sp_out.ss_restart_ena;
  353. spectralparams->ss_noise_floor_ref =
  354. sp_out.ss_noise_floor_ref;
  355. spectralparams->ss_init_delay = sp_out.ss_init_delay;
  356. spectralparams->ss_nb_tone_thr = sp_out.ss_nb_tone_thr;
  357. spectralparams->ss_str_bin_thr = sp_out.ss_str_bin_thr;
  358. spectralparams->ss_wb_rpt_mode = sp_out.ss_wb_rpt_mode;
  359. spectralparams->ss_rssi_rpt_mode =
  360. sp_out.ss_rssi_rpt_mode;
  361. spectralparams->ss_rssi_thr = sp_out.ss_rssi_thr;
  362. spectralparams->ss_pwr_format = sp_out.ss_pwr_format;
  363. spectralparams->ss_rpt_mode = sp_out.ss_rpt_mode;
  364. spectralparams->ss_bin_scale = sp_out.ss_bin_scale;
  365. spectralparams->ss_dbm_adj = sp_out.ss_dbm_adj;
  366. spectralparams->ss_chn_mask = sp_out.ss_chn_mask;
  367. spectralparams->ss_frequency = sp_out.ss_frequency;
  368. break;
  369. case SPECTRAL_IS_ACTIVE:
  370. sscan_req->status_req.is_active =
  371. sc->sptrlc_is_spectral_active(pdev,
  372. smode);
  373. break;
  374. case SPECTRAL_IS_ENABLED:
  375. sscan_req->status_req.is_enabled =
  376. sc->sptrlc_is_spectral_enabled(pdev,
  377. smode);
  378. break;
  379. case SPECTRAL_SET_DEBUG_LEVEL:
  380. temp_debug = sscan_req->debug_req.spectral_dbg_level;
  381. sc->sptrlc_set_debug_level(pdev, temp_debug);
  382. break;
  383. case SPECTRAL_GET_DEBUG_LEVEL:
  384. sscan_req->debug_req.spectral_dbg_level =
  385. sc->sptrlc_get_debug_level(pdev);
  386. break;
  387. case SPECTRAL_ACTIVATE_SCAN:
  388. err = &sscan_req->action_req.sscan_err_code;
  389. sc->sptrlc_start_spectral_scan(pdev, smode, err);
  390. break;
  391. case SPECTRAL_STOP_SCAN:
  392. sc->sptrlc_stop_spectral_scan(pdev, smode);
  393. break;
  394. case SPECTRAL_GET_CAPABILITY_INFO:
  395. {
  396. struct spectral_caps *caps;
  397. caps = &sscan_req->caps_req.sscan_caps;
  398. sc->sptrlc_get_spectral_capinfo(pdev, caps);
  399. }
  400. break;
  401. case SPECTRAL_GET_DIAG_STATS:
  402. {
  403. struct spectral_diag_stats *diag;
  404. diag = &sscan_req->diag_req.sscan_diag;
  405. sc->sptrlc_get_spectral_diagstats(pdev, diag);
  406. }
  407. break;
  408. case SPECTRAL_GET_CHAN_WIDTH:
  409. {
  410. uint32_t chan_width;
  411. vdev = spectral_get_vdev(pdev);
  412. if (!vdev)
  413. goto bad;
  414. chan_width = spectral_vdev_get_ch_width(vdev);
  415. wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID);
  416. sscan_req->chan_width_req.chan_width =
  417. (uint32_t)chan_width;
  418. }
  419. break;
  420. default:
  421. goto bad;
  422. break;
  423. }
  424. status = QDF_STATUS_SUCCESS;
  425. bad:
  426. return status;
  427. }
  428. /**
  429. * spectral_ctx_deinit() - De-initialize function pointers from spectral context
  430. * @sc - Reference to spectral_context object
  431. *
  432. * Return: None
  433. */
  434. static void
  435. spectral_ctx_deinit(struct spectral_context *sc)
  436. {
  437. if (sc) {
  438. sc->sptrlc_ucfg_phyerr_config = NULL;
  439. sc->sptrlc_pdev_spectral_init = NULL;
  440. sc->sptrlc_pdev_spectral_deinit = NULL;
  441. sc->sptrlc_set_spectral_config = NULL;
  442. sc->sptrlc_get_spectral_config = NULL;
  443. sc->sptrlc_start_spectral_scan = NULL;
  444. sc->sptrlc_stop_spectral_scan = NULL;
  445. sc->sptrlc_is_spectral_active = NULL;
  446. sc->sptrlc_is_spectral_enabled = NULL;
  447. sc->sptrlc_set_debug_level = NULL;
  448. sc->sptrlc_get_debug_level = NULL;
  449. sc->sptrlc_get_spectral_capinfo = NULL;
  450. sc->sptrlc_get_spectral_diagstats = NULL;
  451. }
  452. }
  453. #ifdef DA_SUPPORT
  454. /**
  455. * wlan_spectral_init_da() - init context of DA devices
  456. *
  457. * init context of DA device
  458. *
  459. * Return: void
  460. */
  461. static void
  462. wlan_spectral_init_da(struct spectral_context *sc)
  463. {
  464. spectral_ctx_init_da(sc);
  465. }
  466. #else
  467. static void
  468. wlan_spectral_init_da(struct spectral_context *sc)
  469. {
  470. }
  471. #endif
  472. QDF_STATUS
  473. wlan_spectral_psoc_obj_create_handler(struct wlan_objmgr_psoc *psoc, void *arg)
  474. {
  475. struct spectral_context *sc = NULL;
  476. if (!psoc) {
  477. spectral_err("PSOC is NULL");
  478. return QDF_STATUS_E_FAILURE;
  479. }
  480. if (cfg_get(psoc, CFG_SPECTRAL_DISABLE)) {
  481. wlan_psoc_nif_feat_cap_set(psoc, WLAN_SOC_F_SPECTRAL_DISABLE);
  482. spectral_info("Spectral is disabled");
  483. return QDF_STATUS_COMP_DISABLED;
  484. }
  485. sc = (struct spectral_context *)
  486. qdf_mem_malloc(sizeof(struct spectral_context));
  487. if (!sc)
  488. return QDF_STATUS_E_NOMEM;
  489. qdf_mem_zero(sc, sizeof(struct spectral_context));
  490. sc->psoc_obj = psoc;
  491. if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_OL)
  492. spectral_ctx_init_ol(sc);
  493. else if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_DA)
  494. wlan_spectral_init_da(sc);
  495. wlan_objmgr_psoc_component_obj_attach(psoc, WLAN_UMAC_COMP_SPECTRAL,
  496. (void *)sc, QDF_STATUS_SUCCESS);
  497. return QDF_STATUS_SUCCESS;
  498. }
  499. QDF_STATUS
  500. wlan_spectral_psoc_obj_destroy_handler(struct wlan_objmgr_psoc *psoc,
  501. void *arg)
  502. {
  503. struct spectral_context *sc = NULL;
  504. if (!psoc) {
  505. spectral_err("PSOC is NULL");
  506. return QDF_STATUS_E_FAILURE;
  507. }
  508. if (wlan_spectral_is_feature_disabled(psoc)) {
  509. spectral_info("Spectral is disabled");
  510. return QDF_STATUS_COMP_DISABLED;
  511. }
  512. sc = wlan_objmgr_psoc_get_comp_private_obj(psoc,
  513. WLAN_UMAC_COMP_SPECTRAL);
  514. if (sc) {
  515. wlan_objmgr_psoc_component_obj_detach(psoc,
  516. WLAN_UMAC_COMP_SPECTRAL,
  517. (void *)sc);
  518. /* Deinitilise function pointers from spectral context */
  519. spectral_ctx_deinit(sc);
  520. qdf_mem_free(sc);
  521. }
  522. return QDF_STATUS_SUCCESS;
  523. }
  524. QDF_STATUS
  525. wlan_spectral_pdev_obj_create_handler(struct wlan_objmgr_pdev *pdev, void *arg)
  526. {
  527. struct pdev_spectral *ps = NULL;
  528. struct spectral_context *sc = NULL;
  529. void *target_handle = NULL;
  530. if (!pdev) {
  531. spectral_err("PDEV is NULL");
  532. return QDF_STATUS_E_FAILURE;
  533. }
  534. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  535. spectral_info("Spectral is disabled");
  536. return QDF_STATUS_COMP_DISABLED;
  537. }
  538. ps = (struct pdev_spectral *)
  539. qdf_mem_malloc(sizeof(struct pdev_spectral));
  540. if (!ps)
  541. return QDF_STATUS_E_NOMEM;
  542. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  543. if (!sc) {
  544. spectral_err("Spectral context is NULL!");
  545. goto cleanup;
  546. }
  547. qdf_mem_zero(ps, sizeof(struct pdev_spectral));
  548. ps->psptrl_pdev = pdev;
  549. spectral_register_cfg80211_handlers(pdev);
  550. if (sc->sptrlc_pdev_spectral_init) {
  551. target_handle = sc->sptrlc_pdev_spectral_init(pdev);
  552. if (!target_handle) {
  553. spectral_err("Spectral lmac object is NULL!");
  554. goto cleanup;
  555. }
  556. ps->psptrl_target_handle = target_handle;
  557. }
  558. wlan_objmgr_pdev_component_obj_attach(pdev, WLAN_UMAC_COMP_SPECTRAL,
  559. (void *)ps, QDF_STATUS_SUCCESS);
  560. return QDF_STATUS_SUCCESS;
  561. cleanup:
  562. qdf_mem_free(ps);
  563. return QDF_STATUS_E_FAILURE;
  564. }
  565. QDF_STATUS
  566. wlan_spectral_pdev_obj_destroy_handler(struct wlan_objmgr_pdev *pdev,
  567. void *arg)
  568. {
  569. struct pdev_spectral *ps = NULL;
  570. struct spectral_context *sc = NULL;
  571. if (!pdev) {
  572. spectral_err("PDEV is NULL");
  573. return QDF_STATUS_E_FAILURE;
  574. }
  575. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  576. spectral_info("Spectral is disabled");
  577. return QDF_STATUS_COMP_DISABLED;
  578. }
  579. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  580. if (!sc) {
  581. spectral_err("Spectral context is NULL!");
  582. return QDF_STATUS_E_FAILURE;
  583. }
  584. ps = wlan_objmgr_pdev_get_comp_private_obj(pdev,
  585. WLAN_UMAC_COMP_SPECTRAL);
  586. if (ps) {
  587. if (sc->sptrlc_pdev_spectral_deinit)
  588. sc->sptrlc_pdev_spectral_deinit(pdev);
  589. ps->psptrl_target_handle = NULL;
  590. wlan_objmgr_pdev_component_obj_detach(pdev,
  591. WLAN_UMAC_COMP_SPECTRAL,
  592. (void *)ps);
  593. qdf_mem_free(ps);
  594. }
  595. return QDF_STATUS_SUCCESS;
  596. }