spectral_common.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663
  1. /*
  2. * Copyright (c) 2011,2017-2021 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. #include <wlan_spectral_public_structs.h>
  24. #include <wlan_cfg80211_spectral.h>
  25. #include <cfg_ucfg_api.h>
  26. /**
  27. * spectral_get_vdev() - Get pointer to vdev to be used for Spectral
  28. * operations
  29. * @pdev: Pointer to pdev
  30. * @vdev_id: vdev_id
  31. *
  32. * Spectral operates on pdev. However, in order to retrieve some WLAN
  33. * properties, a vdev is required. To facilitate this, the function returns the
  34. * first vdev in our pdev. The caller should release the reference to the vdev
  35. * once it is done using it. Additionally, the caller should ensure it has a
  36. * reference to the pdev at the time of calling this function, and should
  37. * release the pdev reference either after this function returns or at a later
  38. * time when the caller is done using pdev.
  39. * TODO:
  40. * - If the framework later provides an API to obtain the first active
  41. * vdev, then it would be preferable to use this API.
  42. * - Use a common get_vdev() handler for core and target_if using Rx ops. This
  43. * is deferred till details emerge on framework providing API to get first
  44. * active vdev.
  45. *
  46. * Return: Pointer to vdev on success, NULL on failure
  47. */
  48. static struct wlan_objmgr_vdev*
  49. spectral_get_vdev(struct wlan_objmgr_pdev *pdev, uint8_t vdev_id)
  50. {
  51. struct wlan_objmgr_vdev *vdev = NULL;
  52. qdf_assert_always(pdev);
  53. if (vdev_id == WLAN_INVALID_VDEV_ID)
  54. vdev = wlan_objmgr_pdev_get_first_vdev(pdev, WLAN_SPECTRAL_ID);
  55. else
  56. vdev = wlan_objmgr_get_vdev_by_id_from_pdev(pdev, vdev_id,
  57. WLAN_SPECTRAL_ID);
  58. if (!vdev) {
  59. spectral_warn("Unable to get first vdev of pdev");
  60. return NULL;
  61. }
  62. return vdev;
  63. }
  64. #ifdef SPECTRAL_MODULIZED_ENABLE
  65. /**
  66. * spectral_register_cfg80211_handlers() - Register spectral cfg80211 handlers
  67. * @pdev: Pointer to pdev
  68. *
  69. * Register spectral cfg80211 handlers
  70. * Handlers can be different depending on whether spectral modulized or not
  71. *
  72. * Return: None
  73. */
  74. static void
  75. spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev)
  76. {
  77. struct spectral_cfg80211_vendor_cmd_handlers handlers = {0};
  78. handlers.wlan_cfg80211_spectral_scan_start =
  79. wlan_cfg80211_spectral_scan_config_and_start;
  80. handlers.wlan_cfg80211_spectral_scan_stop =
  81. wlan_cfg80211_spectral_scan_stop;
  82. handlers.wlan_cfg80211_spectral_scan_get_config =
  83. wlan_cfg80211_spectral_scan_get_config;
  84. handlers.wlan_cfg80211_spectral_scan_get_diag_stats =
  85. wlan_cfg80211_spectral_scan_get_diag_stats;
  86. handlers.wlan_cfg80211_spectral_scan_get_cap =
  87. wlan_cfg80211_spectral_scan_get_cap;
  88. handlers.wlan_cfg80211_spectral_scan_get_status =
  89. wlan_cfg80211_spectral_scan_get_status;
  90. wlan_cfg80211_register_spectral_cmd_handler(pdev, &handlers);
  91. }
  92. #else
  93. static void
  94. spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev)
  95. {
  96. }
  97. #endif
  98. QDF_STATUS
  99. spectral_control_cmn(struct wlan_objmgr_pdev *pdev,
  100. struct spectral_cp_request *sscan_req)
  101. {
  102. QDF_STATUS status = QDF_STATUS_E_FAILURE;
  103. int temp_debug;
  104. struct spectral_config sp_out;
  105. struct spectral_config *sp_in;
  106. struct spectral_config *spectralparams;
  107. struct spectral_context *sc;
  108. struct wlan_objmgr_vdev *vdev = NULL;
  109. uint8_t vdev_rxchainmask = 0;
  110. enum spectral_scan_mode smode = sscan_req->ss_mode;
  111. enum spectral_cp_error_code *err;
  112. QDF_STATUS ret;
  113. struct spectral_cp_param param;
  114. if (!pdev) {
  115. spectral_err("PDEV is NULL!");
  116. goto bad;
  117. }
  118. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  119. if (!sc) {
  120. spectral_err("Spectral context is NULL!");
  121. goto bad;
  122. }
  123. switch (sscan_req->req_id) {
  124. case SPECTRAL_SET_CONFIG:
  125. err = &sscan_req->config_req.sscan_err_code;
  126. sp_in = &sscan_req->config_req.sscan_config;
  127. if (sp_in->ss_count != SPECTRAL_PHYERR_PARAM_NOVAL) {
  128. param.id = SPECTRAL_PARAM_SCAN_COUNT;
  129. param.value = sp_in->ss_count;
  130. ret = sc->sptrlc_set_spectral_config
  131. (pdev, &param, smode, err);
  132. if (QDF_IS_STATUS_ERROR(ret))
  133. goto bad;
  134. }
  135. if (sp_in->ss_fft_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  136. param.id = SPECTRAL_PARAM_FFT_PERIOD;
  137. param.value = sp_in->ss_fft_period;
  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_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  144. param.id = SPECTRAL_PARAM_SCAN_PERIOD;
  145. param.value = sp_in->ss_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_short_report != SPECTRAL_PHYERR_PARAM_NOVAL) {
  152. param.id = SPECTRAL_PARAM_SHORT_REPORT;
  153. param.value = (uint32_t)sp_in->ss_short_report ? 1 : 0;
  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_spectral_pri != SPECTRAL_PHYERR_PARAM_NOVAL) {
  160. param.id = SPECTRAL_PARAM_SPECT_PRI;
  161. param.value = (uint32_t)sp_in->ss_spectral_pri;
  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_fft_size != SPECTRAL_PHYERR_PARAM_NOVAL) {
  168. param.id = SPECTRAL_PARAM_FFT_SIZE;
  169. param.value = sp_in->ss_fft_size;
  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_gc_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  176. param.id = SPECTRAL_PARAM_GC_ENA;
  177. param.value = sp_in->ss_gc_ena;
  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_restart_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  184. param.id = SPECTRAL_PARAM_RESTART_ENA;
  185. param.value = sp_in->ss_restart_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_noise_floor_ref != SPECTRAL_PHYERR_PARAM_NOVAL) {
  192. param.id = SPECTRAL_PARAM_NOISE_FLOOR_REF;
  193. param.value = sp_in->ss_noise_floor_ref;
  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_init_delay != SPECTRAL_PHYERR_PARAM_NOVAL) {
  200. param.id = SPECTRAL_PARAM_INIT_DELAY;
  201. param.value = sp_in->ss_init_delay;
  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_nb_tone_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  208. param.id = SPECTRAL_PARAM_NB_TONE_THR;
  209. param.value = sp_in->ss_nb_tone_thr;
  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_str_bin_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  216. param.id = SPECTRAL_PARAM_STR_BIN_THR;
  217. param.value = sp_in->ss_str_bin_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_wb_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  224. param.id = SPECTRAL_PARAM_WB_RPT_MODE;
  225. param.value = sp_in->ss_wb_rpt_mode;
  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_rssi_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  232. param.id = SPECTRAL_PARAM_RSSI_RPT_MODE;
  233. param.value = sp_in->ss_rssi_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_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  240. param.id = SPECTRAL_PARAM_RSSI_THR;
  241. param.value = sp_in->ss_rssi_thr;
  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_pwr_format != SPECTRAL_PHYERR_PARAM_NOVAL) {
  248. param.id = SPECTRAL_PARAM_PWR_FORMAT;
  249. param.value = sp_in->ss_pwr_format;
  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_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  256. param.id = SPECTRAL_PARAM_RPT_MODE;
  257. param.value = sp_in->ss_rpt_mode;
  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_bin_scale != SPECTRAL_PHYERR_PARAM_NOVAL) {
  264. param.id = SPECTRAL_PARAM_BIN_SCALE;
  265. param.value = sp_in->ss_bin_scale;
  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_dbm_adj != SPECTRAL_PHYERR_PARAM_NOVAL) {
  272. param.id = SPECTRAL_PARAM_DBM_ADJ;
  273. param.value = sp_in->ss_dbm_adj;
  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_chn_mask != SPECTRAL_PHYERR_PARAM_NOVAL) {
  280. /*
  281. * Check if any of the inactive Rx antenna
  282. * chains is set active in spectral chainmask
  283. */
  284. vdev = spectral_get_vdev(pdev, sscan_req->vdev_id);
  285. if (!vdev)
  286. goto bad;
  287. vdev_rxchainmask =
  288. wlan_vdev_mlme_get_rxchainmask(vdev);
  289. wlan_objmgr_vdev_release_ref(vdev,
  290. WLAN_SPECTRAL_ID);
  291. if (!(sp_in->ss_chn_mask & vdev_rxchainmask)) {
  292. spectral_err("Invalid Spectral Chainmask - Inactive Rx antenna chain cannot be an active spectral chain");
  293. goto bad;
  294. } else {
  295. param.id = SPECTRAL_PARAM_CHN_MASK;
  296. param.value = sp_in->ss_chn_mask;
  297. ret = sc->sptrlc_set_spectral_config
  298. (pdev, &param, smode, err);
  299. if (QDF_IS_STATUS_ERROR(ret))
  300. goto bad;
  301. }
  302. }
  303. if (sp_in->ss_frequency.cfreq1 != SPECTRAL_PHYERR_PARAM_NOVAL) {
  304. param.id = SPECTRAL_PARAM_FREQUENCY;
  305. param.freq.cfreq1 = sp_in->ss_frequency.cfreq1;
  306. param.freq.cfreq2 = sp_in->ss_frequency.cfreq2;
  307. ret = sc->sptrlc_set_spectral_config
  308. (pdev, &param, smode, err);
  309. if (QDF_IS_STATUS_ERROR(ret))
  310. goto bad;
  311. }
  312. if (sp_in->ss_bandwidth != SPECTRAL_PHYERR_PARAM_NOVAL) {
  313. param.id = SPECTRAL_PARAM_CHAN_WIDTH;
  314. param.value = sp_in->ss_bandwidth;
  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. spectralparams->ss_bandwidth = sp_out.ss_bandwidth;
  350. break;
  351. case SPECTRAL_IS_ACTIVE:
  352. sscan_req->status_req.is_active =
  353. sc->sptrlc_is_spectral_active(pdev,
  354. smode);
  355. break;
  356. case SPECTRAL_IS_ENABLED:
  357. sscan_req->status_req.is_enabled =
  358. sc->sptrlc_is_spectral_enabled(pdev,
  359. smode);
  360. break;
  361. case SPECTRAL_SET_DEBUG_LEVEL:
  362. temp_debug = sscan_req->debug_req.spectral_dbg_level;
  363. sc->sptrlc_set_debug_level(pdev, temp_debug);
  364. break;
  365. case SPECTRAL_GET_DEBUG_LEVEL:
  366. sscan_req->debug_req.spectral_dbg_level =
  367. sc->sptrlc_get_debug_level(pdev);
  368. break;
  369. case SPECTRAL_ACTIVATE_SCAN:
  370. err = &sscan_req->action_req.sscan_err_code;
  371. ret = sc->sptrlc_start_spectral_scan(pdev, sscan_req->vdev_id,
  372. smode, err);
  373. if (QDF_IS_STATUS_ERROR(ret))
  374. goto bad;
  375. break;
  376. case SPECTRAL_STOP_SCAN:
  377. err = &sscan_req->action_req.sscan_err_code;
  378. ret = sc->sptrlc_stop_spectral_scan(pdev, smode, err);
  379. if (QDF_IS_STATUS_ERROR(ret))
  380. goto bad;
  381. break;
  382. case SPECTRAL_GET_CAPABILITY_INFO:
  383. {
  384. struct spectral_caps *caps;
  385. caps = &sscan_req->caps_req.sscan_caps;
  386. sc->sptrlc_get_spectral_capinfo(pdev, caps);
  387. }
  388. break;
  389. case SPECTRAL_GET_DIAG_STATS:
  390. {
  391. struct spectral_diag_stats *diag;
  392. diag = &sscan_req->diag_req.sscan_diag;
  393. sc->sptrlc_get_spectral_diagstats(pdev, diag);
  394. }
  395. break;
  396. case SPECTRAL_GET_CHAN_WIDTH:
  397. {
  398. uint32_t chan_width;
  399. vdev = spectral_get_vdev(pdev, sscan_req->vdev_id);
  400. if (!vdev)
  401. goto bad;
  402. chan_width = spectral_vdev_get_ch_width(vdev);
  403. wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID);
  404. sscan_req->chan_width_req.chan_width =
  405. (uint32_t)chan_width;
  406. }
  407. break;
  408. case SPECTRAL_SET_DMA_DEBUG:
  409. if (sc->sptrlc_set_dma_debug)
  410. sc->sptrlc_set_dma_debug(
  411. pdev,
  412. sscan_req->dma_debug_req.dma_debug_type,
  413. sscan_req->dma_debug_req.dma_debug_enable);
  414. break;
  415. default:
  416. goto bad;
  417. break;
  418. }
  419. status = QDF_STATUS_SUCCESS;
  420. bad:
  421. return status;
  422. }
  423. /**
  424. * spectral_ctx_deinit() - De-initialize function pointers from spectral context
  425. * @sc - Reference to spectral_context object
  426. *
  427. * Return: None
  428. */
  429. static void
  430. spectral_ctx_deinit(struct spectral_context *sc)
  431. {
  432. if (sc) {
  433. sc->sptrlc_ucfg_phyerr_config = NULL;
  434. sc->sptrlc_pdev_spectral_init = NULL;
  435. sc->sptrlc_pdev_spectral_deinit = NULL;
  436. sc->sptrlc_psoc_spectral_init = NULL;
  437. sc->sptrlc_psoc_spectral_deinit = NULL;
  438. sc->sptrlc_set_spectral_config = NULL;
  439. sc->sptrlc_get_spectral_config = NULL;
  440. sc->sptrlc_start_spectral_scan = NULL;
  441. sc->sptrlc_stop_spectral_scan = NULL;
  442. sc->sptrlc_is_spectral_active = NULL;
  443. sc->sptrlc_is_spectral_enabled = NULL;
  444. sc->sptrlc_set_debug_level = NULL;
  445. sc->sptrlc_get_debug_level = NULL;
  446. sc->sptrlc_get_spectral_capinfo = NULL;
  447. sc->sptrlc_get_spectral_diagstats = NULL;
  448. }
  449. }
  450. QDF_STATUS
  451. wlan_spectral_psoc_obj_create_handler(struct wlan_objmgr_psoc *psoc, void *arg)
  452. {
  453. struct spectral_context *sc = NULL;
  454. QDF_STATUS status;
  455. if (!psoc) {
  456. spectral_err("PSOC is NULL");
  457. return QDF_STATUS_E_FAILURE;
  458. }
  459. status = wlan_spectral_init_psoc_feature_cap(psoc);
  460. if (QDF_IS_STATUS_ERROR(status)) {
  461. spectral_err("Failed to intitialize spectral pdev feature caps");
  462. return QDF_STATUS_E_FAILURE;
  463. }
  464. if (wlan_spectral_is_feature_disabled_psoc(psoc)) {
  465. spectral_info("Spectral feature is disabled");
  466. return QDF_STATUS_COMP_DISABLED;
  467. }
  468. sc = (struct spectral_context *)
  469. qdf_mem_malloc(sizeof(struct spectral_context));
  470. if (!sc)
  471. return QDF_STATUS_E_NOMEM;
  472. qdf_mem_zero(sc, sizeof(struct spectral_context));
  473. sc->psoc_obj = psoc;
  474. if (wlan_objmgr_psoc_get_dev_type(psoc) == WLAN_DEV_OL)
  475. spectral_ctx_init_ol(sc);
  476. wlan_objmgr_psoc_component_obj_attach(psoc, WLAN_UMAC_COMP_SPECTRAL,
  477. (void *)sc, QDF_STATUS_SUCCESS);
  478. return QDF_STATUS_SUCCESS;
  479. }
  480. QDF_STATUS
  481. wlan_spectral_psoc_obj_destroy_handler(struct wlan_objmgr_psoc *psoc,
  482. void *arg)
  483. {
  484. struct spectral_context *sc = NULL;
  485. if (!psoc) {
  486. spectral_err("PSOC is NULL");
  487. return QDF_STATUS_E_FAILURE;
  488. }
  489. if (wlan_spectral_is_feature_disabled_psoc(psoc)) {
  490. spectral_info("Spectral feature is disabled");
  491. return QDF_STATUS_COMP_DISABLED;
  492. }
  493. sc = wlan_objmgr_psoc_get_comp_private_obj(psoc,
  494. WLAN_UMAC_COMP_SPECTRAL);
  495. if (sc) {
  496. wlan_objmgr_psoc_component_obj_detach(psoc,
  497. WLAN_UMAC_COMP_SPECTRAL,
  498. (void *)sc);
  499. /* Deinitilise function pointers from spectral context */
  500. spectral_ctx_deinit(sc);
  501. qdf_mem_free(sc);
  502. }
  503. return QDF_STATUS_SUCCESS;
  504. }
  505. QDF_STATUS
  506. wlan_spectral_pdev_obj_create_handler(struct wlan_objmgr_pdev *pdev, void *arg)
  507. {
  508. struct pdev_spectral *ps = NULL;
  509. struct spectral_context *sc = NULL;
  510. void *target_handle = NULL;
  511. QDF_STATUS status;
  512. if (!pdev) {
  513. spectral_err("PDEV is NULL");
  514. return QDF_STATUS_E_FAILURE;
  515. }
  516. status = wlan_spectral_init_pdev_feature_caps(pdev);
  517. if (QDF_IS_STATUS_ERROR(status)) {
  518. spectral_err("Failed to intitialize spectral pdev feature caps");
  519. return QDF_STATUS_E_FAILURE;
  520. }
  521. if (wlan_spectral_is_feature_disabled_pdev(pdev)) {
  522. spectral_info("Spectral feature is disabled");
  523. return QDF_STATUS_COMP_DISABLED;
  524. }
  525. ps = (struct pdev_spectral *)
  526. qdf_mem_malloc(sizeof(struct pdev_spectral));
  527. if (!ps)
  528. return QDF_STATUS_E_NOMEM;
  529. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  530. if (!sc) {
  531. spectral_err("Spectral context is NULL!");
  532. goto cleanup;
  533. }
  534. qdf_mem_zero(ps, sizeof(struct pdev_spectral));
  535. ps->psptrl_pdev = pdev;
  536. spectral_register_cfg80211_handlers(pdev);
  537. if (sc->sptrlc_pdev_spectral_init) {
  538. target_handle = sc->sptrlc_pdev_spectral_init(pdev);
  539. if (!target_handle) {
  540. spectral_err("Spectral lmac object is NULL!");
  541. goto cleanup;
  542. }
  543. ps->psptrl_target_handle = target_handle;
  544. }
  545. wlan_objmgr_pdev_component_obj_attach(pdev, WLAN_UMAC_COMP_SPECTRAL,
  546. (void *)ps, QDF_STATUS_SUCCESS);
  547. return QDF_STATUS_SUCCESS;
  548. cleanup:
  549. qdf_mem_free(ps);
  550. return QDF_STATUS_E_FAILURE;
  551. }
  552. QDF_STATUS
  553. wlan_spectral_pdev_obj_destroy_handler(struct wlan_objmgr_pdev *pdev,
  554. void *arg)
  555. {
  556. struct pdev_spectral *ps = NULL;
  557. struct spectral_context *sc = NULL;
  558. if (!pdev) {
  559. spectral_err("PDEV is NULL");
  560. return QDF_STATUS_E_FAILURE;
  561. }
  562. if (wlan_spectral_is_feature_disabled_pdev(pdev)) {
  563. spectral_info("Spectral feature is disabled");
  564. return QDF_STATUS_COMP_DISABLED;
  565. }
  566. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  567. if (!sc) {
  568. spectral_err("Spectral context is NULL!");
  569. return QDF_STATUS_E_FAILURE;
  570. }
  571. ps = wlan_objmgr_pdev_get_comp_private_obj(pdev,
  572. WLAN_UMAC_COMP_SPECTRAL);
  573. if (ps) {
  574. if (sc->sptrlc_pdev_spectral_deinit)
  575. sc->sptrlc_pdev_spectral_deinit(pdev);
  576. ps->psptrl_target_handle = NULL;
  577. wlan_objmgr_pdev_component_obj_detach(pdev,
  578. WLAN_UMAC_COMP_SPECTRAL,
  579. (void *)ps);
  580. qdf_mem_free(ps);
  581. }
  582. return QDF_STATUS_SUCCESS;
  583. }