spectral_common.c 19 KB

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