spectral_common.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668
  1. /*
  2. * Copyright (c) 2011,2017-2020 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. struct spectral_cp_param param;
  122. if (!pdev) {
  123. spectral_err("PDEV is NULL!");
  124. goto bad;
  125. }
  126. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  127. if (!sc) {
  128. spectral_err("Spectral context is NULL!");
  129. goto bad;
  130. }
  131. switch (sscan_req->req_id) {
  132. case SPECTRAL_SET_CONFIG:
  133. err = &sscan_req->config_req.sscan_err_code;
  134. sp_in = &sscan_req->config_req.sscan_config;
  135. if (sp_in->ss_count != SPECTRAL_PHYERR_PARAM_NOVAL) {
  136. param.id = SPECTRAL_PARAM_SCAN_COUNT;
  137. param.value = sp_in->ss_count;
  138. ret = sc->sptrlc_set_spectral_config
  139. (pdev, &param, smode, err);
  140. if (QDF_IS_STATUS_ERROR(ret))
  141. goto bad;
  142. }
  143. if (sp_in->ss_fft_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  144. param.id = SPECTRAL_PARAM_FFT_PERIOD;
  145. param.value = sp_in->ss_fft_period;
  146. ret = sc->sptrlc_set_spectral_config
  147. (pdev, &param, smode, err);
  148. if (QDF_IS_STATUS_ERROR(ret))
  149. goto bad;
  150. }
  151. if (sp_in->ss_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  152. param.id = SPECTRAL_PARAM_SCAN_PERIOD;
  153. param.value = sp_in->ss_period;
  154. ret = sc->sptrlc_set_spectral_config
  155. (pdev, &param, 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. param.id = SPECTRAL_PARAM_SHORT_REPORT;
  161. param.value = (uint32_t)sp_in->ss_short_report ? 1 : 0;
  162. ret = sc->sptrlc_set_spectral_config
  163. (pdev, &param, smode, err);
  164. if (QDF_IS_STATUS_ERROR(ret))
  165. goto bad;
  166. }
  167. if (sp_in->ss_spectral_pri != SPECTRAL_PHYERR_PARAM_NOVAL) {
  168. param.id = SPECTRAL_PARAM_SPECT_PRI;
  169. param.value = (uint32_t)sp_in->ss_spectral_pri;
  170. ret = sc->sptrlc_set_spectral_config
  171. (pdev, &param, smode, err);
  172. if (QDF_IS_STATUS_ERROR(ret))
  173. goto bad;
  174. }
  175. if (sp_in->ss_fft_size != SPECTRAL_PHYERR_PARAM_NOVAL) {
  176. param.id = SPECTRAL_PARAM_FFT_SIZE;
  177. param.value = sp_in->ss_fft_size;
  178. ret = sc->sptrlc_set_spectral_config
  179. (pdev, &param, smode, err);
  180. if (QDF_IS_STATUS_ERROR(ret))
  181. goto bad;
  182. }
  183. if (sp_in->ss_gc_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  184. param.id = SPECTRAL_PARAM_GC_ENA;
  185. param.value = sp_in->ss_gc_ena;
  186. ret = sc->sptrlc_set_spectral_config
  187. (pdev, &param, smode, err);
  188. if (QDF_IS_STATUS_ERROR(ret))
  189. goto bad;
  190. }
  191. if (sp_in->ss_restart_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  192. param.id = SPECTRAL_PARAM_RESTART_ENA;
  193. param.value = sp_in->ss_restart_ena;
  194. ret = sc->sptrlc_set_spectral_config
  195. (pdev, &param, smode, err);
  196. if (QDF_IS_STATUS_ERROR(ret))
  197. goto bad;
  198. }
  199. if (sp_in->ss_noise_floor_ref != SPECTRAL_PHYERR_PARAM_NOVAL) {
  200. param.id = SPECTRAL_PARAM_NOISE_FLOOR_REF;
  201. param.value = sp_in->ss_noise_floor_ref;
  202. ret = sc->sptrlc_set_spectral_config
  203. (pdev, &param, smode, err);
  204. if (QDF_IS_STATUS_ERROR(ret))
  205. goto bad;
  206. }
  207. if (sp_in->ss_init_delay != SPECTRAL_PHYERR_PARAM_NOVAL) {
  208. param.id = SPECTRAL_PARAM_INIT_DELAY;
  209. param.value = sp_in->ss_init_delay;
  210. ret = sc->sptrlc_set_spectral_config
  211. (pdev, &param, smode, err);
  212. if (QDF_IS_STATUS_ERROR(ret))
  213. goto bad;
  214. }
  215. if (sp_in->ss_nb_tone_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  216. param.id = SPECTRAL_PARAM_NB_TONE_THR;
  217. param.value = sp_in->ss_nb_tone_thr;
  218. ret = sc->sptrlc_set_spectral_config
  219. (pdev, &param, smode, err);
  220. if (QDF_IS_STATUS_ERROR(ret))
  221. goto bad;
  222. }
  223. if (sp_in->ss_str_bin_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  224. param.id = SPECTRAL_PARAM_STR_BIN_THR;
  225. param.value = sp_in->ss_str_bin_thr;
  226. ret = sc->sptrlc_set_spectral_config
  227. (pdev, &param, smode, err);
  228. if (QDF_IS_STATUS_ERROR(ret))
  229. goto bad;
  230. }
  231. if (sp_in->ss_wb_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  232. param.id = SPECTRAL_PARAM_WB_RPT_MODE;
  233. param.value = sp_in->ss_wb_rpt_mode;
  234. ret = sc->sptrlc_set_spectral_config
  235. (pdev, &param, smode, err);
  236. if (QDF_IS_STATUS_ERROR(ret))
  237. goto bad;
  238. }
  239. if (sp_in->ss_rssi_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  240. param.id = SPECTRAL_PARAM_RSSI_RPT_MODE;
  241. param.value = sp_in->ss_rssi_rpt_mode;
  242. ret = sc->sptrlc_set_spectral_config
  243. (pdev, &param, smode, err);
  244. if (QDF_IS_STATUS_ERROR(ret))
  245. goto bad;
  246. }
  247. if (sp_in->ss_rssi_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  248. param.id = SPECTRAL_PARAM_RSSI_THR;
  249. param.value = sp_in->ss_rssi_thr;
  250. ret = sc->sptrlc_set_spectral_config
  251. (pdev, &param, smode, err);
  252. if (QDF_IS_STATUS_ERROR(ret))
  253. goto bad;
  254. }
  255. if (sp_in->ss_pwr_format != SPECTRAL_PHYERR_PARAM_NOVAL) {
  256. param.id = SPECTRAL_PARAM_PWR_FORMAT;
  257. param.value = sp_in->ss_pwr_format;
  258. ret = sc->sptrlc_set_spectral_config
  259. (pdev, &param, smode, err);
  260. if (QDF_IS_STATUS_ERROR(ret))
  261. goto bad;
  262. }
  263. if (sp_in->ss_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  264. param.id = SPECTRAL_PARAM_RPT_MODE;
  265. param.value = sp_in->ss_rpt_mode;
  266. ret = sc->sptrlc_set_spectral_config
  267. (pdev, &param, smode, err);
  268. if (QDF_IS_STATUS_ERROR(ret))
  269. goto bad;
  270. }
  271. if (sp_in->ss_bin_scale != SPECTRAL_PHYERR_PARAM_NOVAL) {
  272. param.id = SPECTRAL_PARAM_BIN_SCALE;
  273. param.value = sp_in->ss_bin_scale;
  274. ret = sc->sptrlc_set_spectral_config
  275. (pdev, &param, smode, err);
  276. if (QDF_IS_STATUS_ERROR(ret))
  277. goto bad;
  278. }
  279. if (sp_in->ss_dbm_adj != SPECTRAL_PHYERR_PARAM_NOVAL) {
  280. param.id = SPECTRAL_PARAM_DBM_ADJ;
  281. param.value = sp_in->ss_dbm_adj;
  282. ret = sc->sptrlc_set_spectral_config
  283. (pdev, &param, smode, err);
  284. if (QDF_IS_STATUS_ERROR(ret))
  285. goto bad;
  286. }
  287. if (sp_in->ss_chn_mask != SPECTRAL_PHYERR_PARAM_NOVAL) {
  288. /*
  289. * Check if any of the inactive Rx antenna
  290. * chains is set active in spectral chainmask
  291. */
  292. vdev = spectral_get_vdev(pdev);
  293. if (!vdev)
  294. goto bad;
  295. vdev_rxchainmask =
  296. wlan_vdev_mlme_get_rxchainmask(vdev);
  297. wlan_objmgr_vdev_release_ref(vdev,
  298. WLAN_SPECTRAL_ID);
  299. if (!(sp_in->ss_chn_mask & vdev_rxchainmask)) {
  300. spectral_err("Invalid Spectral Chainmask - Inactive Rx antenna chain cannot be an active spectral chain");
  301. goto bad;
  302. } else {
  303. param.id = SPECTRAL_PARAM_CHN_MASK;
  304. param.value = sp_in->ss_chn_mask;
  305. ret = sc->sptrlc_set_spectral_config
  306. (pdev, &param, smode, err);
  307. if (QDF_IS_STATUS_ERROR(ret))
  308. goto bad;
  309. }
  310. }
  311. if (sp_in->ss_frequency.cfreq1 != SPECTRAL_PHYERR_PARAM_NOVAL) {
  312. param.id = SPECTRAL_PARAM_FREQUENCY;
  313. param.freq.cfreq1 = sp_in->ss_frequency.cfreq1;
  314. param.freq.cfreq2 = sp_in->ss_frequency.cfreq2;
  315. ret = sc->sptrlc_set_spectral_config
  316. (pdev, &param, smode, err);
  317. if (QDF_IS_STATUS_ERROR(ret))
  318. goto bad;
  319. }
  320. break;
  321. case SPECTRAL_GET_CONFIG:
  322. sc->sptrlc_get_spectral_config(pdev, &sp_out, smode);
  323. spectralparams = &sscan_req->config_req.sscan_config;
  324. spectralparams->ss_fft_period = sp_out.ss_fft_period;
  325. spectralparams->ss_period = sp_out.ss_period;
  326. spectralparams->ss_count = sp_out.ss_count;
  327. spectralparams->ss_short_report =
  328. sp_out.ss_short_report;
  329. spectralparams->ss_spectral_pri =
  330. sp_out.ss_spectral_pri;
  331. spectralparams->ss_fft_size = sp_out.ss_fft_size;
  332. spectralparams->ss_gc_ena = sp_out.ss_gc_ena;
  333. spectralparams->ss_restart_ena = sp_out.ss_restart_ena;
  334. spectralparams->ss_noise_floor_ref =
  335. sp_out.ss_noise_floor_ref;
  336. spectralparams->ss_init_delay = sp_out.ss_init_delay;
  337. spectralparams->ss_nb_tone_thr = sp_out.ss_nb_tone_thr;
  338. spectralparams->ss_str_bin_thr = sp_out.ss_str_bin_thr;
  339. spectralparams->ss_wb_rpt_mode = sp_out.ss_wb_rpt_mode;
  340. spectralparams->ss_rssi_rpt_mode =
  341. sp_out.ss_rssi_rpt_mode;
  342. spectralparams->ss_rssi_thr = sp_out.ss_rssi_thr;
  343. spectralparams->ss_pwr_format = sp_out.ss_pwr_format;
  344. spectralparams->ss_rpt_mode = sp_out.ss_rpt_mode;
  345. spectralparams->ss_bin_scale = sp_out.ss_bin_scale;
  346. spectralparams->ss_dbm_adj = sp_out.ss_dbm_adj;
  347. spectralparams->ss_chn_mask = sp_out.ss_chn_mask;
  348. spectralparams->ss_frequency = sp_out.ss_frequency;
  349. break;
  350. case SPECTRAL_IS_ACTIVE:
  351. sscan_req->status_req.is_active =
  352. sc->sptrlc_is_spectral_active(pdev,
  353. smode);
  354. break;
  355. case SPECTRAL_IS_ENABLED:
  356. sscan_req->status_req.is_enabled =
  357. sc->sptrlc_is_spectral_enabled(pdev,
  358. smode);
  359. break;
  360. case SPECTRAL_SET_DEBUG_LEVEL:
  361. temp_debug = sscan_req->debug_req.spectral_dbg_level;
  362. sc->sptrlc_set_debug_level(pdev, temp_debug);
  363. break;
  364. case SPECTRAL_GET_DEBUG_LEVEL:
  365. sscan_req->debug_req.spectral_dbg_level =
  366. sc->sptrlc_get_debug_level(pdev);
  367. break;
  368. case SPECTRAL_ACTIVATE_SCAN:
  369. err = &sscan_req->action_req.sscan_err_code;
  370. ret = sc->sptrlc_start_spectral_scan(pdev, smode, err);
  371. if (QDF_IS_STATUS_ERROR(ret))
  372. goto bad;
  373. break;
  374. case SPECTRAL_STOP_SCAN:
  375. err = &sscan_req->action_req.sscan_err_code;
  376. ret = sc->sptrlc_stop_spectral_scan(pdev, smode, err);
  377. if (QDF_IS_STATUS_ERROR(ret))
  378. goto bad;
  379. break;
  380. case SPECTRAL_GET_CAPABILITY_INFO:
  381. {
  382. struct spectral_caps *caps;
  383. caps = &sscan_req->caps_req.sscan_caps;
  384. sc->sptrlc_get_spectral_capinfo(pdev, caps);
  385. }
  386. break;
  387. case SPECTRAL_GET_DIAG_STATS:
  388. {
  389. struct spectral_diag_stats *diag;
  390. diag = &sscan_req->diag_req.sscan_diag;
  391. sc->sptrlc_get_spectral_diagstats(pdev, diag);
  392. }
  393. break;
  394. case SPECTRAL_GET_CHAN_WIDTH:
  395. {
  396. uint32_t chan_width;
  397. vdev = spectral_get_vdev(pdev);
  398. if (!vdev)
  399. goto bad;
  400. chan_width = spectral_vdev_get_ch_width(vdev);
  401. wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID);
  402. sscan_req->chan_width_req.chan_width =
  403. (uint32_t)chan_width;
  404. }
  405. break;
  406. case SPECTRAL_SET_DMA_DEBUG:
  407. if (sc->sptrlc_set_dma_debug)
  408. sc->sptrlc_set_dma_debug(
  409. pdev,
  410. sscan_req->dma_debug_req.dma_debug_type,
  411. sscan_req->dma_debug_req.dma_debug_enable);
  412. break;
  413. default:
  414. goto bad;
  415. break;
  416. }
  417. status = QDF_STATUS_SUCCESS;
  418. bad:
  419. return status;
  420. }
  421. /**
  422. * spectral_ctx_deinit() - De-initialize function pointers from spectral context
  423. * @sc - Reference to spectral_context object
  424. *
  425. * Return: None
  426. */
  427. static void
  428. spectral_ctx_deinit(struct spectral_context *sc)
  429. {
  430. if (sc) {
  431. sc->sptrlc_ucfg_phyerr_config = NULL;
  432. sc->sptrlc_pdev_spectral_init = NULL;
  433. sc->sptrlc_pdev_spectral_deinit = NULL;
  434. sc->sptrlc_psoc_spectral_init = NULL;
  435. sc->sptrlc_psoc_spectral_deinit = NULL;
  436. sc->sptrlc_set_spectral_config = NULL;
  437. sc->sptrlc_get_spectral_config = NULL;
  438. sc->sptrlc_start_spectral_scan = NULL;
  439. sc->sptrlc_stop_spectral_scan = NULL;
  440. sc->sptrlc_is_spectral_active = NULL;
  441. sc->sptrlc_is_spectral_enabled = NULL;
  442. sc->sptrlc_set_debug_level = NULL;
  443. sc->sptrlc_get_debug_level = NULL;
  444. sc->sptrlc_get_spectral_capinfo = NULL;
  445. sc->sptrlc_get_spectral_diagstats = NULL;
  446. }
  447. }
  448. #ifdef DA_SUPPORT
  449. /**
  450. * wlan_spectral_init_da() - init context of DA devices
  451. *
  452. * init context of DA device
  453. *
  454. * Return: void
  455. */
  456. static void
  457. wlan_spectral_init_da(struct spectral_context *sc)
  458. {
  459. spectral_ctx_init_da(sc);
  460. }
  461. #else
  462. static void
  463. wlan_spectral_init_da(struct spectral_context *sc)
  464. {
  465. }
  466. #endif
  467. QDF_STATUS
  468. wlan_spectral_psoc_obj_create_handler(struct wlan_objmgr_psoc *psoc, void *arg)
  469. {
  470. struct spectral_context *sc = NULL;
  471. if (!psoc) {
  472. spectral_err("PSOC is NULL");
  473. return QDF_STATUS_E_FAILURE;
  474. }
  475. if (cfg_get(psoc, CFG_SPECTRAL_DISABLE)) {
  476. wlan_psoc_nif_feat_cap_set(psoc, WLAN_SOC_F_SPECTRAL_DISABLE);
  477. spectral_info("Spectral is disabled");
  478. return QDF_STATUS_COMP_DISABLED;
  479. }
  480. sc = (struct spectral_context *)
  481. qdf_mem_malloc(sizeof(struct spectral_context));
  482. if (!sc)
  483. return QDF_STATUS_E_NOMEM;
  484. qdf_mem_zero(sc, sizeof(struct spectral_context));
  485. sc->psoc_obj = psoc;
  486. if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_OL)
  487. spectral_ctx_init_ol(sc);
  488. else if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_DA)
  489. wlan_spectral_init_da(sc);
  490. wlan_objmgr_psoc_component_obj_attach(psoc, WLAN_UMAC_COMP_SPECTRAL,
  491. (void *)sc, QDF_STATUS_SUCCESS);
  492. return QDF_STATUS_SUCCESS;
  493. }
  494. QDF_STATUS
  495. wlan_spectral_psoc_obj_destroy_handler(struct wlan_objmgr_psoc *psoc,
  496. void *arg)
  497. {
  498. struct spectral_context *sc = NULL;
  499. if (!psoc) {
  500. spectral_err("PSOC is NULL");
  501. return QDF_STATUS_E_FAILURE;
  502. }
  503. if (wlan_spectral_is_feature_disabled(psoc)) {
  504. spectral_info("Spectral is disabled");
  505. return QDF_STATUS_COMP_DISABLED;
  506. }
  507. sc = wlan_objmgr_psoc_get_comp_private_obj(psoc,
  508. WLAN_UMAC_COMP_SPECTRAL);
  509. if (sc) {
  510. wlan_objmgr_psoc_component_obj_detach(psoc,
  511. WLAN_UMAC_COMP_SPECTRAL,
  512. (void *)sc);
  513. /* Deinitilise function pointers from spectral context */
  514. spectral_ctx_deinit(sc);
  515. qdf_mem_free(sc);
  516. }
  517. return QDF_STATUS_SUCCESS;
  518. }
  519. QDF_STATUS
  520. wlan_spectral_pdev_obj_create_handler(struct wlan_objmgr_pdev *pdev, void *arg)
  521. {
  522. struct pdev_spectral *ps = NULL;
  523. struct spectral_context *sc = NULL;
  524. void *target_handle = NULL;
  525. if (!pdev) {
  526. spectral_err("PDEV is NULL");
  527. return QDF_STATUS_E_FAILURE;
  528. }
  529. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  530. spectral_info("Spectral is disabled");
  531. return QDF_STATUS_COMP_DISABLED;
  532. }
  533. ps = (struct pdev_spectral *)
  534. qdf_mem_malloc(sizeof(struct pdev_spectral));
  535. if (!ps)
  536. return QDF_STATUS_E_NOMEM;
  537. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  538. if (!sc) {
  539. spectral_err("Spectral context is NULL!");
  540. goto cleanup;
  541. }
  542. qdf_mem_zero(ps, sizeof(struct pdev_spectral));
  543. ps->psptrl_pdev = pdev;
  544. spectral_register_cfg80211_handlers(pdev);
  545. if (sc->sptrlc_pdev_spectral_init) {
  546. target_handle = sc->sptrlc_pdev_spectral_init(pdev);
  547. if (!target_handle) {
  548. spectral_err("Spectral lmac object is NULL!");
  549. goto cleanup;
  550. }
  551. ps->psptrl_target_handle = target_handle;
  552. }
  553. wlan_objmgr_pdev_component_obj_attach(pdev, WLAN_UMAC_COMP_SPECTRAL,
  554. (void *)ps, QDF_STATUS_SUCCESS);
  555. return QDF_STATUS_SUCCESS;
  556. cleanup:
  557. qdf_mem_free(ps);
  558. return QDF_STATUS_E_FAILURE;
  559. }
  560. QDF_STATUS
  561. wlan_spectral_pdev_obj_destroy_handler(struct wlan_objmgr_pdev *pdev,
  562. void *arg)
  563. {
  564. struct pdev_spectral *ps = NULL;
  565. struct spectral_context *sc = NULL;
  566. if (!pdev) {
  567. spectral_err("PDEV is NULL");
  568. return QDF_STATUS_E_FAILURE;
  569. }
  570. if (wlan_spectral_is_feature_disabled(wlan_pdev_get_psoc(pdev))) {
  571. spectral_info("Spectral is disabled");
  572. return QDF_STATUS_COMP_DISABLED;
  573. }
  574. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  575. if (!sc) {
  576. spectral_err("Spectral context is NULL!");
  577. return QDF_STATUS_E_FAILURE;
  578. }
  579. ps = wlan_objmgr_pdev_get_comp_private_obj(pdev,
  580. WLAN_UMAC_COMP_SPECTRAL);
  581. if (ps) {
  582. if (sc->sptrlc_pdev_spectral_deinit)
  583. sc->sptrlc_pdev_spectral_deinit(pdev);
  584. ps->psptrl_target_handle = NULL;
  585. wlan_objmgr_pdev_component_obj_detach(pdev,
  586. WLAN_UMAC_COMP_SPECTRAL,
  587. (void *)ps);
  588. qdf_mem_free(ps);
  589. }
  590. return QDF_STATUS_SUCCESS;
  591. }