spectral_common.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673
  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. wlan_cfg80211_register_spectral_cmd_handler(
  81. pdev,
  82. SPECTRAL_SCAN_START_HANDLER_IDX,
  83. wlan_cfg80211_spectral_scan_config_and_start);
  84. wlan_cfg80211_register_spectral_cmd_handler(
  85. pdev,
  86. SPECTRAL_SCAN_STOP_HANDLER_IDX,
  87. wlan_cfg80211_spectral_scan_stop);
  88. wlan_cfg80211_register_spectral_cmd_handler(
  89. pdev,
  90. SPECTRAL_SCAN_GET_CONFIG_HANDLER_IDX,
  91. wlan_cfg80211_spectral_scan_get_config);
  92. wlan_cfg80211_register_spectral_cmd_handler(
  93. pdev,
  94. SPECTRAL_SCAN_GET_DIAG_STATS_HANDLER_IDX,
  95. wlan_cfg80211_spectral_scan_get_diag_stats);
  96. wlan_cfg80211_register_spectral_cmd_handler(
  97. pdev,
  98. SPECTRAL_SCAN_GET_CAP_HANDLER_IDX,
  99. wlan_cfg80211_spectral_scan_get_cap);
  100. wlan_cfg80211_register_spectral_cmd_handler(
  101. pdev,
  102. SPECTRAL_SCAN_GET_STATUS_HANDLER_IDX,
  103. wlan_cfg80211_spectral_scan_get_status);
  104. }
  105. #else
  106. static void
  107. spectral_register_cfg80211_handlers(struct wlan_objmgr_pdev *pdev)
  108. {
  109. }
  110. #endif
  111. QDF_STATUS
  112. spectral_control_cmn(struct wlan_objmgr_pdev *pdev,
  113. struct spectral_cp_request *sscan_req)
  114. {
  115. QDF_STATUS status = QDF_STATUS_E_FAILURE;
  116. int temp_debug;
  117. struct spectral_config sp_out;
  118. struct spectral_config *sp_in;
  119. struct spectral_config *spectralparams;
  120. struct spectral_context *sc;
  121. struct wlan_objmgr_vdev *vdev = NULL;
  122. uint8_t vdev_rxchainmask = 0;
  123. enum spectral_scan_mode smode = sscan_req->ss_mode;
  124. enum spectral_cp_error_code *err;
  125. QDF_STATUS ret;
  126. struct spectral_cp_param param;
  127. if (!pdev) {
  128. spectral_err("PDEV is NULL!");
  129. goto bad;
  130. }
  131. sc = spectral_get_spectral_ctx_from_pdev(pdev);
  132. if (!sc) {
  133. spectral_err("Spectral context is NULL!");
  134. goto bad;
  135. }
  136. switch (sscan_req->req_id) {
  137. case SPECTRAL_SET_CONFIG:
  138. err = &sscan_req->config_req.sscan_err_code;
  139. sp_in = &sscan_req->config_req.sscan_config;
  140. if (sp_in->ss_count != SPECTRAL_PHYERR_PARAM_NOVAL) {
  141. param.id = SPECTRAL_PARAM_SCAN_COUNT;
  142. param.value = sp_in->ss_count;
  143. ret = sc->sptrlc_set_spectral_config
  144. (pdev, &param, smode, err);
  145. if (QDF_IS_STATUS_ERROR(ret))
  146. goto bad;
  147. }
  148. if (sp_in->ss_fft_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  149. param.id = SPECTRAL_PARAM_FFT_PERIOD;
  150. param.value = sp_in->ss_fft_period;
  151. ret = sc->sptrlc_set_spectral_config
  152. (pdev, &param, smode, err);
  153. if (QDF_IS_STATUS_ERROR(ret))
  154. goto bad;
  155. }
  156. if (sp_in->ss_period != SPECTRAL_PHYERR_PARAM_NOVAL) {
  157. param.id = SPECTRAL_PARAM_SCAN_PERIOD;
  158. param.value = sp_in->ss_period;
  159. ret = sc->sptrlc_set_spectral_config
  160. (pdev, &param, smode, err);
  161. if (QDF_IS_STATUS_ERROR(ret))
  162. goto bad;
  163. }
  164. if (sp_in->ss_short_report != SPECTRAL_PHYERR_PARAM_NOVAL) {
  165. param.id = SPECTRAL_PARAM_SHORT_REPORT;
  166. param.value = (uint32_t)sp_in->ss_short_report ? 1 : 0;
  167. ret = sc->sptrlc_set_spectral_config
  168. (pdev, &param, smode, err);
  169. if (QDF_IS_STATUS_ERROR(ret))
  170. goto bad;
  171. }
  172. if (sp_in->ss_spectral_pri != SPECTRAL_PHYERR_PARAM_NOVAL) {
  173. param.id = SPECTRAL_PARAM_SPECT_PRI;
  174. param.value = (uint32_t)sp_in->ss_spectral_pri;
  175. ret = sc->sptrlc_set_spectral_config
  176. (pdev, &param, smode, err);
  177. if (QDF_IS_STATUS_ERROR(ret))
  178. goto bad;
  179. }
  180. if (sp_in->ss_fft_size != SPECTRAL_PHYERR_PARAM_NOVAL) {
  181. param.id = SPECTRAL_PARAM_FFT_SIZE;
  182. param.value = sp_in->ss_fft_size;
  183. ret = sc->sptrlc_set_spectral_config
  184. (pdev, &param, 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. param.id = SPECTRAL_PARAM_GC_ENA;
  190. param.value = sp_in->ss_gc_ena;
  191. ret = sc->sptrlc_set_spectral_config
  192. (pdev, &param, smode, err);
  193. if (QDF_IS_STATUS_ERROR(ret))
  194. goto bad;
  195. }
  196. if (sp_in->ss_restart_ena != SPECTRAL_PHYERR_PARAM_NOVAL) {
  197. param.id = SPECTRAL_PARAM_RESTART_ENA;
  198. param.value = sp_in->ss_restart_ena;
  199. ret = sc->sptrlc_set_spectral_config
  200. (pdev, &param, smode, err);
  201. if (QDF_IS_STATUS_ERROR(ret))
  202. goto bad;
  203. }
  204. if (sp_in->ss_noise_floor_ref != SPECTRAL_PHYERR_PARAM_NOVAL) {
  205. param.id = SPECTRAL_PARAM_NOISE_FLOOR_REF;
  206. param.value = sp_in->ss_noise_floor_ref;
  207. ret = sc->sptrlc_set_spectral_config
  208. (pdev, &param, smode, err);
  209. if (QDF_IS_STATUS_ERROR(ret))
  210. goto bad;
  211. }
  212. if (sp_in->ss_init_delay != SPECTRAL_PHYERR_PARAM_NOVAL) {
  213. param.id = SPECTRAL_PARAM_INIT_DELAY;
  214. param.value = sp_in->ss_init_delay;
  215. ret = sc->sptrlc_set_spectral_config
  216. (pdev, &param, smode, err);
  217. if (QDF_IS_STATUS_ERROR(ret))
  218. goto bad;
  219. }
  220. if (sp_in->ss_nb_tone_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  221. param.id = SPECTRAL_PARAM_NB_TONE_THR;
  222. param.value = sp_in->ss_nb_tone_thr;
  223. ret = sc->sptrlc_set_spectral_config
  224. (pdev, &param, smode, err);
  225. if (QDF_IS_STATUS_ERROR(ret))
  226. goto bad;
  227. }
  228. if (sp_in->ss_str_bin_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  229. param.id = SPECTRAL_PARAM_STR_BIN_THR;
  230. param.value = sp_in->ss_str_bin_thr;
  231. ret = sc->sptrlc_set_spectral_config
  232. (pdev, &param, smode, err);
  233. if (QDF_IS_STATUS_ERROR(ret))
  234. goto bad;
  235. }
  236. if (sp_in->ss_wb_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  237. param.id = SPECTRAL_PARAM_WB_RPT_MODE;
  238. param.value = sp_in->ss_wb_rpt_mode;
  239. ret = sc->sptrlc_set_spectral_config
  240. (pdev, &param, smode, err);
  241. if (QDF_IS_STATUS_ERROR(ret))
  242. goto bad;
  243. }
  244. if (sp_in->ss_rssi_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  245. param.id = SPECTRAL_PARAM_RSSI_RPT_MODE;
  246. param.value = sp_in->ss_rssi_rpt_mode;
  247. ret = sc->sptrlc_set_spectral_config
  248. (pdev, &param, smode, err);
  249. if (QDF_IS_STATUS_ERROR(ret))
  250. goto bad;
  251. }
  252. if (sp_in->ss_rssi_thr != SPECTRAL_PHYERR_PARAM_NOVAL) {
  253. param.id = SPECTRAL_PARAM_RSSI_THR;
  254. param.value = sp_in->ss_rssi_thr;
  255. ret = sc->sptrlc_set_spectral_config
  256. (pdev, &param, smode, err);
  257. if (QDF_IS_STATUS_ERROR(ret))
  258. goto bad;
  259. }
  260. if (sp_in->ss_pwr_format != SPECTRAL_PHYERR_PARAM_NOVAL) {
  261. param.id = SPECTRAL_PARAM_PWR_FORMAT;
  262. param.value = sp_in->ss_pwr_format;
  263. ret = sc->sptrlc_set_spectral_config
  264. (pdev, &param, smode, err);
  265. if (QDF_IS_STATUS_ERROR(ret))
  266. goto bad;
  267. }
  268. if (sp_in->ss_rpt_mode != SPECTRAL_PHYERR_PARAM_NOVAL) {
  269. param.id = SPECTRAL_PARAM_RPT_MODE;
  270. param.value = sp_in->ss_rpt_mode;
  271. ret = sc->sptrlc_set_spectral_config
  272. (pdev, &param, smode, err);
  273. if (QDF_IS_STATUS_ERROR(ret))
  274. goto bad;
  275. }
  276. if (sp_in->ss_bin_scale != SPECTRAL_PHYERR_PARAM_NOVAL) {
  277. param.id = SPECTRAL_PARAM_BIN_SCALE;
  278. param.value = sp_in->ss_bin_scale;
  279. ret = sc->sptrlc_set_spectral_config
  280. (pdev, &param, smode, err);
  281. if (QDF_IS_STATUS_ERROR(ret))
  282. goto bad;
  283. }
  284. if (sp_in->ss_dbm_adj != SPECTRAL_PHYERR_PARAM_NOVAL) {
  285. param.id = SPECTRAL_PARAM_DBM_ADJ;
  286. param.value = sp_in->ss_dbm_adj;
  287. ret = sc->sptrlc_set_spectral_config
  288. (pdev, &param, smode, err);
  289. if (QDF_IS_STATUS_ERROR(ret))
  290. goto bad;
  291. }
  292. if (sp_in->ss_chn_mask != SPECTRAL_PHYERR_PARAM_NOVAL) {
  293. /*
  294. * Check if any of the inactive Rx antenna
  295. * chains is set active in spectral chainmask
  296. */
  297. vdev = spectral_get_vdev(pdev, sscan_req->vdev_id);
  298. if (!vdev)
  299. goto bad;
  300. vdev_rxchainmask =
  301. wlan_vdev_mlme_get_rxchainmask(vdev);
  302. wlan_objmgr_vdev_release_ref(vdev,
  303. WLAN_SPECTRAL_ID);
  304. if (!(sp_in->ss_chn_mask & vdev_rxchainmask)) {
  305. spectral_err("Invalid Spectral Chainmask - Inactive Rx antenna chain cannot be an active spectral chain");
  306. goto bad;
  307. } else {
  308. param.id = SPECTRAL_PARAM_CHN_MASK;
  309. param.value = sp_in->ss_chn_mask;
  310. ret = sc->sptrlc_set_spectral_config
  311. (pdev, &param, smode, err);
  312. if (QDF_IS_STATUS_ERROR(ret))
  313. goto bad;
  314. }
  315. }
  316. if (sp_in->ss_frequency.cfreq1 != SPECTRAL_PHYERR_PARAM_NOVAL) {
  317. param.id = SPECTRAL_PARAM_FREQUENCY;
  318. param.freq.cfreq1 = sp_in->ss_frequency.cfreq1;
  319. param.freq.cfreq2 = sp_in->ss_frequency.cfreq2;
  320. ret = sc->sptrlc_set_spectral_config
  321. (pdev, &param, smode, err);
  322. if (QDF_IS_STATUS_ERROR(ret))
  323. goto bad;
  324. }
  325. break;
  326. case SPECTRAL_GET_CONFIG:
  327. sc->sptrlc_get_spectral_config(pdev, &sp_out, smode);
  328. spectralparams = &sscan_req->config_req.sscan_config;
  329. spectralparams->ss_fft_period = sp_out.ss_fft_period;
  330. spectralparams->ss_period = sp_out.ss_period;
  331. spectralparams->ss_count = sp_out.ss_count;
  332. spectralparams->ss_short_report =
  333. sp_out.ss_short_report;
  334. spectralparams->ss_spectral_pri =
  335. sp_out.ss_spectral_pri;
  336. spectralparams->ss_fft_size = sp_out.ss_fft_size;
  337. spectralparams->ss_gc_ena = sp_out.ss_gc_ena;
  338. spectralparams->ss_restart_ena = sp_out.ss_restart_ena;
  339. spectralparams->ss_noise_floor_ref =
  340. sp_out.ss_noise_floor_ref;
  341. spectralparams->ss_init_delay = sp_out.ss_init_delay;
  342. spectralparams->ss_nb_tone_thr = sp_out.ss_nb_tone_thr;
  343. spectralparams->ss_str_bin_thr = sp_out.ss_str_bin_thr;
  344. spectralparams->ss_wb_rpt_mode = sp_out.ss_wb_rpt_mode;
  345. spectralparams->ss_rssi_rpt_mode =
  346. sp_out.ss_rssi_rpt_mode;
  347. spectralparams->ss_rssi_thr = sp_out.ss_rssi_thr;
  348. spectralparams->ss_pwr_format = sp_out.ss_pwr_format;
  349. spectralparams->ss_rpt_mode = sp_out.ss_rpt_mode;
  350. spectralparams->ss_bin_scale = sp_out.ss_bin_scale;
  351. spectralparams->ss_dbm_adj = sp_out.ss_dbm_adj;
  352. spectralparams->ss_chn_mask = sp_out.ss_chn_mask;
  353. spectralparams->ss_frequency = sp_out.ss_frequency;
  354. break;
  355. case SPECTRAL_IS_ACTIVE:
  356. sscan_req->status_req.is_active =
  357. sc->sptrlc_is_spectral_active(pdev,
  358. smode);
  359. break;
  360. case SPECTRAL_IS_ENABLED:
  361. sscan_req->status_req.is_enabled =
  362. sc->sptrlc_is_spectral_enabled(pdev,
  363. smode);
  364. break;
  365. case SPECTRAL_SET_DEBUG_LEVEL:
  366. temp_debug = sscan_req->debug_req.spectral_dbg_level;
  367. sc->sptrlc_set_debug_level(pdev, temp_debug);
  368. break;
  369. case SPECTRAL_GET_DEBUG_LEVEL:
  370. sscan_req->debug_req.spectral_dbg_level =
  371. sc->sptrlc_get_debug_level(pdev);
  372. break;
  373. case SPECTRAL_ACTIVATE_SCAN:
  374. err = &sscan_req->action_req.sscan_err_code;
  375. ret = sc->sptrlc_start_spectral_scan(pdev, sscan_req->vdev_id,
  376. smode, err);
  377. if (QDF_IS_STATUS_ERROR(ret))
  378. goto bad;
  379. break;
  380. case SPECTRAL_STOP_SCAN:
  381. err = &sscan_req->action_req.sscan_err_code;
  382. ret = sc->sptrlc_stop_spectral_scan(pdev, smode, err);
  383. if (QDF_IS_STATUS_ERROR(ret))
  384. goto bad;
  385. break;
  386. case SPECTRAL_GET_CAPABILITY_INFO:
  387. {
  388. struct spectral_caps *caps;
  389. caps = &sscan_req->caps_req.sscan_caps;
  390. sc->sptrlc_get_spectral_capinfo(pdev, caps);
  391. }
  392. break;
  393. case SPECTRAL_GET_DIAG_STATS:
  394. {
  395. struct spectral_diag_stats *diag;
  396. diag = &sscan_req->diag_req.sscan_diag;
  397. sc->sptrlc_get_spectral_diagstats(pdev, diag);
  398. }
  399. break;
  400. case SPECTRAL_GET_CHAN_WIDTH:
  401. {
  402. uint32_t chan_width;
  403. vdev = spectral_get_vdev(pdev, sscan_req->vdev_id);
  404. if (!vdev)
  405. goto bad;
  406. chan_width = spectral_vdev_get_ch_width(vdev);
  407. wlan_objmgr_vdev_release_ref(vdev, WLAN_SPECTRAL_ID);
  408. sscan_req->chan_width_req.chan_width =
  409. (uint32_t)chan_width;
  410. }
  411. break;
  412. case SPECTRAL_SET_DMA_DEBUG:
  413. if (sc->sptrlc_set_dma_debug)
  414. sc->sptrlc_set_dma_debug(
  415. pdev,
  416. sscan_req->dma_debug_req.dma_debug_type,
  417. sscan_req->dma_debug_req.dma_debug_enable);
  418. break;
  419. default:
  420. goto bad;
  421. break;
  422. }
  423. status = QDF_STATUS_SUCCESS;
  424. bad:
  425. return status;
  426. }
  427. /**
  428. * spectral_ctx_deinit() - De-initialize function pointers from spectral context
  429. * @sc - Reference to spectral_context object
  430. *
  431. * Return: None
  432. */
  433. static void
  434. spectral_ctx_deinit(struct spectral_context *sc)
  435. {
  436. if (sc) {
  437. sc->sptrlc_ucfg_phyerr_config = NULL;
  438. sc->sptrlc_pdev_spectral_init = NULL;
  439. sc->sptrlc_pdev_spectral_deinit = NULL;
  440. sc->sptrlc_psoc_spectral_init = NULL;
  441. sc->sptrlc_psoc_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. }