spectral_common.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673
  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. err = &sscan_req->action_req.sscan_err_code;
  393. sc->sptrlc_stop_spectral_scan(pdev, smode, err);
  394. break;
  395. case SPECTRAL_GET_CAPABILITY_INFO:
  396. {
  397. struct spectral_caps *caps;
  398. caps = &sscan_req->caps_req.sscan_caps;
  399. sc->sptrlc_get_spectral_capinfo(pdev, caps);
  400. }
  401. break;
  402. case SPECTRAL_GET_DIAG_STATS:
  403. {
  404. struct spectral_diag_stats *diag;
  405. diag = &sscan_req->diag_req.sscan_diag;
  406. sc->sptrlc_get_spectral_diagstats(pdev, diag);
  407. }
  408. break;
  409. case SPECTRAL_GET_CHAN_WIDTH:
  410. {
  411. uint32_t chan_width;
  412. vdev = spectral_get_vdev(pdev);
  413. if (!vdev)
  414. goto bad;
  415. chan_width = spectral_vdev_get_ch_width(vdev);
  416. wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID);
  417. sscan_req->chan_width_req.chan_width =
  418. (uint32_t)chan_width;
  419. }
  420. break;
  421. default:
  422. goto bad;
  423. break;
  424. }
  425. status = QDF_STATUS_SUCCESS;
  426. bad:
  427. return status;
  428. }
  429. /**
  430. * spectral_ctx_deinit() - De-initialize function pointers from spectral context
  431. * @sc - Reference to spectral_context object
  432. *
  433. * Return: None
  434. */
  435. static void
  436. spectral_ctx_deinit(struct spectral_context *sc)
  437. {
  438. if (sc) {
  439. sc->sptrlc_ucfg_phyerr_config = NULL;
  440. sc->sptrlc_pdev_spectral_init = NULL;
  441. sc->sptrlc_pdev_spectral_deinit = NULL;
  442. sc->sptrlc_set_spectral_config = NULL;
  443. sc->sptrlc_get_spectral_config = NULL;
  444. sc->sptrlc_start_spectral_scan = NULL;
  445. sc->sptrlc_stop_spectral_scan = NULL;
  446. sc->sptrlc_is_spectral_active = NULL;
  447. sc->sptrlc_is_spectral_enabled = NULL;
  448. sc->sptrlc_set_debug_level = NULL;
  449. sc->sptrlc_get_debug_level = NULL;
  450. sc->sptrlc_get_spectral_capinfo = NULL;
  451. sc->sptrlc_get_spectral_diagstats = NULL;
  452. }
  453. }
  454. #ifdef DA_SUPPORT
  455. /**
  456. * wlan_spectral_init_da() - init context of DA devices
  457. *
  458. * init context of DA device
  459. *
  460. * Return: void
  461. */
  462. static void
  463. wlan_spectral_init_da(struct spectral_context *sc)
  464. {
  465. spectral_ctx_init_da(sc);
  466. }
  467. #else
  468. static void
  469. wlan_spectral_init_da(struct spectral_context *sc)
  470. {
  471. }
  472. #endif
  473. QDF_STATUS
  474. wlan_spectral_psoc_obj_create_handler(struct wlan_objmgr_psoc *psoc, void *arg)
  475. {
  476. struct spectral_context *sc = NULL;
  477. if (!psoc) {
  478. spectral_err("PSOC is NULL");
  479. return QDF_STATUS_E_FAILURE;
  480. }
  481. if (cfg_get(psoc, CFG_SPECTRAL_DISABLE)) {
  482. wlan_psoc_nif_feat_cap_set(psoc, WLAN_SOC_F_SPECTRAL_DISABLE);
  483. spectral_info("Spectral is disabled");
  484. return QDF_STATUS_COMP_DISABLED;
  485. }
  486. sc = (struct spectral_context *)
  487. qdf_mem_malloc(sizeof(struct spectral_context));
  488. if (!sc)
  489. return QDF_STATUS_E_NOMEM;
  490. qdf_mem_zero(sc, sizeof(struct spectral_context));
  491. sc->psoc_obj = psoc;
  492. if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_OL)
  493. spectral_ctx_init_ol(sc);
  494. else if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_DA)
  495. wlan_spectral_init_da(sc);
  496. wlan_objmgr_psoc_component_obj_attach(psoc, WLAN_UMAC_COMP_SPECTRAL,
  497. (void *)sc, QDF_STATUS_SUCCESS);
  498. return QDF_STATUS_SUCCESS;
  499. }
  500. QDF_STATUS
  501. wlan_spectral_psoc_obj_destroy_handler(struct wlan_objmgr_psoc *psoc,
  502. void *arg)
  503. {
  504. struct spectral_context *sc = NULL;
  505. if (!psoc) {
  506. spectral_err("PSOC is NULL");
  507. return QDF_STATUS_E_FAILURE;
  508. }
  509. if (wlan_spectral_is_feature_disabled(psoc)) {
  510. spectral_info("Spectral is disabled");
  511. return QDF_STATUS_COMP_DISABLED;
  512. }
  513. sc = wlan_objmgr_psoc_get_comp_private_obj(psoc,
  514. WLAN_UMAC_COMP_SPECTRAL);
  515. if (sc) {
  516. wlan_objmgr_psoc_component_obj_detach(psoc,
  517. WLAN_UMAC_COMP_SPECTRAL,
  518. (void *)sc);
  519. /* Deinitilise function pointers from spectral context */
  520. spectral_ctx_deinit(sc);
  521. qdf_mem_free(sc);
  522. }
  523. return QDF_STATUS_SUCCESS;
  524. }
  525. QDF_STATUS
  526. wlan_spectral_pdev_obj_create_handler(struct wlan_objmgr_pdev *pdev, void *arg)
  527. {
  528. struct pdev_spectral *ps = NULL;
  529. struct spectral_context *sc = NULL;
  530. void *target_handle = NULL;
  531. if (!pdev) {
  532. spectral_err("PDEV is NULL");
  533. return QDF_STATUS_E_FAILURE;
  534. }
  535. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  536. spectral_info("Spectral is disabled");
  537. return QDF_STATUS_COMP_DISABLED;
  538. }
  539. ps = (struct pdev_spectral *)
  540. qdf_mem_malloc(sizeof(struct pdev_spectral));
  541. if (!ps)
  542. return QDF_STATUS_E_NOMEM;
  543. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  544. if (!sc) {
  545. spectral_err("Spectral context is NULL!");
  546. goto cleanup;
  547. }
  548. qdf_mem_zero(ps, sizeof(struct pdev_spectral));
  549. ps->psptrl_pdev = pdev;
  550. spectral_register_cfg80211_handlers(pdev);
  551. if (sc->sptrlc_pdev_spectral_init) {
  552. target_handle = sc->sptrlc_pdev_spectral_init(pdev);
  553. if (!target_handle) {
  554. spectral_err("Spectral lmac object is NULL!");
  555. goto cleanup;
  556. }
  557. ps->psptrl_target_handle = target_handle;
  558. }
  559. wlan_objmgr_pdev_component_obj_attach(pdev, WLAN_UMAC_COMP_SPECTRAL,
  560. (void *)ps, QDF_STATUS_SUCCESS);
  561. return QDF_STATUS_SUCCESS;
  562. cleanup:
  563. qdf_mem_free(ps);
  564. return QDF_STATUS_E_FAILURE;
  565. }
  566. QDF_STATUS
  567. wlan_spectral_pdev_obj_destroy_handler(struct wlan_objmgr_pdev *pdev,
  568. void *arg)
  569. {
  570. struct pdev_spectral *ps = NULL;
  571. struct spectral_context *sc = NULL;
  572. if (!pdev) {
  573. spectral_err("PDEV is NULL");
  574. return QDF_STATUS_E_FAILURE;
  575. }
  576. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  577. spectral_info("Spectral is disabled");
  578. return QDF_STATUS_COMP_DISABLED;
  579. }
  580. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  581. if (!sc) {
  582. spectral_err("Spectral context is NULL!");
  583. return QDF_STATUS_E_FAILURE;
  584. }
  585. ps = wlan_objmgr_pdev_get_comp_private_obj(pdev,
  586. WLAN_UMAC_COMP_SPECTRAL);
  587. if (ps) {
  588. if (sc->sptrlc_pdev_spectral_deinit)
  589. sc->sptrlc_pdev_spectral_deinit(pdev);
  590. ps->psptrl_target_handle = NULL;
  591. wlan_objmgr_pdev_component_obj_detach(pdev,
  592. WLAN_UMAC_COMP_SPECTRAL,
  593. (void *)ps);
  594. qdf_mem_free(ps);
  595. }
  596. return QDF_STATUS_SUCCESS;
  597. }