dp_mlo.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633
  1. /*
  2. * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #include <wlan_utility.h>
  17. #include <dp_internal.h>
  18. #include <dp_htt.h>
  19. #include <hal_be_api.h>
  20. #include "dp_mlo.h"
  21. #include <dp_be.h>
  22. #include <dp_htt.h>
  23. #include <dp_internal.h>
  24. #include <wlan_cfg.h>
  25. #include <wlan_mlo_mgr_cmn.h>
  26. /*
  27. * dp_mlo_ctxt_attach_wifi3 () – Attach DP MLO context
  28. *
  29. * Return: DP MLO context handle on success, NULL on failure
  30. */
  31. struct cdp_mlo_ctxt *
  32. dp_mlo_ctxt_attach_wifi3(struct cdp_ctrl_mlo_mgr *ctrl_ctxt)
  33. {
  34. struct dp_mlo_ctxt *mlo_ctxt =
  35. qdf_mem_malloc(sizeof(struct dp_mlo_ctxt));
  36. if (!mlo_ctxt) {
  37. dp_err("Failed to allocate DP MLO Context");
  38. return NULL;
  39. }
  40. mlo_ctxt->ctrl_ctxt = ctrl_ctxt;
  41. if (dp_mlo_peer_find_hash_attach_be
  42. (mlo_ctxt, DP_MAX_MLO_PEER) != QDF_STATUS_SUCCESS) {
  43. dp_err("Failed to allocate peer hash");
  44. qdf_mem_free(mlo_ctxt);
  45. return NULL;
  46. }
  47. qdf_spinlock_create(&mlo_ctxt->ml_soc_list_lock);
  48. return dp_mlo_ctx_to_cdp(mlo_ctxt);
  49. }
  50. qdf_export_symbol(dp_mlo_ctxt_attach_wifi3);
  51. /*
  52. * dp_mlo_ctxt_detach_wifi3 () – Detach DP MLO context
  53. *
  54. * @ml_ctxt: pointer to DP MLO context
  55. *
  56. * Return: void
  57. */
  58. void dp_mlo_ctxt_detach_wifi3(struct cdp_mlo_ctxt *cdp_ml_ctxt)
  59. {
  60. struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
  61. if (!cdp_ml_ctxt)
  62. return;
  63. qdf_spinlock_destroy(&mlo_ctxt->ml_soc_list_lock);
  64. dp_mlo_peer_find_hash_detach_be(mlo_ctxt);
  65. qdf_mem_free(mlo_ctxt);
  66. }
  67. qdf_export_symbol(dp_mlo_ctxt_detach_wifi3);
  68. /*
  69. * dp_mlo_set_soc_by_chip_id() – Add DP soc to ML context soc list
  70. *
  71. * @ml_ctxt: DP ML context handle
  72. * @soc: DP soc handle
  73. * @chip_id: MLO chip id
  74. *
  75. * Return: void
  76. */
  77. void dp_mlo_set_soc_by_chip_id(struct dp_mlo_ctxt *ml_ctxt,
  78. struct dp_soc *soc,
  79. uint8_t chip_id)
  80. {
  81. qdf_spin_lock_bh(&ml_ctxt->ml_soc_list_lock);
  82. ml_ctxt->ml_soc_list[chip_id] = soc;
  83. qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
  84. }
  85. /*
  86. * dp_mlo_get_soc_ref_by_chip_id() – Get DP soc from DP ML context.
  87. * This API will increment a reference count for DP soc. Caller has
  88. * to take care for decrementing refcount.
  89. *
  90. * @ml_ctxt: DP ML context handle
  91. * @chip_id: MLO chip id
  92. *
  93. * Return: dp_soc
  94. */
  95. struct dp_soc*
  96. dp_mlo_get_soc_ref_by_chip_id(struct dp_mlo_ctxt *ml_ctxt,
  97. uint8_t chip_id)
  98. {
  99. struct dp_soc *soc = NULL;
  100. if (!ml_ctxt) {
  101. dp_warn("MLO context not created, MLO not enabled");
  102. return NULL;
  103. }
  104. qdf_spin_lock_bh(&ml_ctxt->ml_soc_list_lock);
  105. soc = ml_ctxt->ml_soc_list[chip_id];
  106. if (!soc) {
  107. qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
  108. return NULL;
  109. }
  110. qdf_atomic_inc(&soc->ref_count);
  111. qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
  112. return soc;
  113. }
  114. static QDF_STATUS dp_partner_soc_rx_hw_cc_init(struct dp_mlo_ctxt *mlo_ctxt,
  115. struct dp_soc_be *be_soc)
  116. {
  117. uint8_t i;
  118. struct dp_soc *partner_soc;
  119. struct dp_soc_be *be_partner_soc;
  120. uint8_t pool_id;
  121. QDF_STATUS qdf_status;
  122. for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
  123. partner_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, i);
  124. if (!partner_soc)
  125. continue;
  126. be_partner_soc = dp_get_be_soc_from_dp_soc(partner_soc);
  127. for (pool_id = 0; pool_id < MAX_RXDESC_POOLS; pool_id++) {
  128. qdf_status =
  129. dp_hw_cookie_conversion_init
  130. (be_soc,
  131. &be_partner_soc->rx_cc_ctx[pool_id]);
  132. if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
  133. dp_alert("MLO partner soc RX CC init failed");
  134. return qdf_status;
  135. }
  136. }
  137. }
  138. return qdf_status;
  139. }
  140. static void dp_mlo_soc_setup(struct cdp_soc_t *soc_hdl,
  141. struct cdp_mlo_ctxt *cdp_ml_ctxt)
  142. {
  143. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  144. struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
  145. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  146. if (!cdp_ml_ctxt)
  147. return;
  148. dp_mlo_set_soc_by_chip_id(mlo_ctxt, soc, be_soc->mlo_chip_id);
  149. }
  150. static void dp_mlo_soc_teardown(struct cdp_soc_t *soc_hdl,
  151. struct cdp_mlo_ctxt *cdp_ml_ctxt)
  152. {
  153. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  154. struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
  155. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  156. if (!cdp_ml_ctxt)
  157. return;
  158. dp_mlo_set_soc_by_chip_id(mlo_ctxt, NULL, be_soc->mlo_chip_id);
  159. }
  160. static QDF_STATUS dp_mlo_add_ptnr_vdev(struct dp_vdev *vdev1,
  161. struct dp_vdev *vdev2,
  162. struct dp_soc *soc, uint8_t pdev_id)
  163. {
  164. struct dp_soc_be *soc_be = dp_get_be_soc_from_dp_soc(soc);
  165. struct dp_vdev_be *vdev2_be = dp_get_be_vdev_from_dp_vdev(vdev2);
  166. /* return when valid entry exists */
  167. if (vdev2_be->partner_vdev_list[soc_be->mlo_chip_id][pdev_id] !=
  168. CDP_INVALID_VDEV_ID)
  169. return QDF_STATUS_SUCCESS;
  170. if (dp_vdev_get_ref(soc, vdev1, DP_MOD_ID_RX) !=
  171. QDF_STATUS_SUCCESS) {
  172. qdf_info("%pK: unable to get vdev reference vdev %pK vdev_id %u",
  173. soc, vdev1, vdev1->vdev_id);
  174. return QDF_STATUS_E_FAILURE;
  175. }
  176. vdev2_be->partner_vdev_list[soc_be->mlo_chip_id][pdev_id] =
  177. vdev1->vdev_id;
  178. mlo_debug("Add vdev%d to vdev%d list, mlo_chip_id = %d pdev_id = %d\n",
  179. vdev1->vdev_id, vdev2->vdev_id, soc_be->mlo_chip_id, pdev_id);
  180. return QDF_STATUS_SUCCESS;
  181. }
  182. QDF_STATUS dp_update_mlo_ptnr_list(struct cdp_soc_t *soc_hdl,
  183. int8_t partner_vdev_ids[], uint8_t num_vdevs,
  184. uint8_t self_vdev_id)
  185. {
  186. int i, j;
  187. struct dp_soc *self_soc = cdp_soc_t_to_dp_soc(soc_hdl);
  188. struct dp_vdev *self_vdev;
  189. QDF_STATUS ret = QDF_STATUS_SUCCESS;
  190. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(self_soc);
  191. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  192. if (!dp_mlo)
  193. return QDF_STATUS_E_FAILURE;
  194. self_vdev = dp_vdev_get_ref_by_id(self_soc, self_vdev_id, DP_MOD_ID_RX);
  195. if (!self_vdev)
  196. return QDF_STATUS_E_FAILURE;
  197. /* go through the input vdev id list and if there are partner vdevs,
  198. * - then add the current vdev's id to partner vdev's list using pdev_id and
  199. * increase the reference
  200. * - add partner vdev to self list and increase the reference
  201. */
  202. for (i = 0; i < num_vdevs; i++) {
  203. if (partner_vdev_ids[i] == CDP_INVALID_VDEV_ID)
  204. continue;
  205. for (j = 0; j < WLAN_MAX_MLO_CHIPS; j++) {
  206. struct dp_soc *soc =
  207. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, j);
  208. if (soc) {
  209. struct dp_vdev *vdev;
  210. vdev = dp_vdev_get_ref_by_id(soc,
  211. partner_vdev_ids[i], DP_MOD_ID_RX);
  212. if (vdev) {
  213. if (vdev == self_vdev) {
  214. dp_vdev_unref_delete(soc,
  215. vdev, DP_MOD_ID_RX);
  216. /*dp_soc_unref_delete(soc); */
  217. continue;
  218. }
  219. if (qdf_is_macaddr_equal(
  220. (struct qdf_mac_addr *)self_vdev->mld_mac_addr.raw,
  221. (struct qdf_mac_addr *)vdev->mld_mac_addr.raw)) {
  222. if (dp_mlo_add_ptnr_vdev(self_vdev,
  223. vdev, self_soc,
  224. self_vdev->pdev->pdev_id) !=
  225. QDF_STATUS_SUCCESS) {
  226. dp_err("Unable to add self to partner vdev's list");
  227. dp_vdev_unref_delete(soc,
  228. vdev, DP_MOD_ID_RX);
  229. /* TODO - release soc ref here */
  230. /* dp_soc_unref_delete(soc);*/
  231. ret = QDF_STATUS_E_FAILURE;
  232. goto exit;
  233. }
  234. /* add to self list */
  235. if (dp_mlo_add_ptnr_vdev(vdev, self_vdev, soc,
  236. vdev->pdev->pdev_id) !=
  237. QDF_STATUS_SUCCESS) {
  238. dp_err("Unable to add vdev to self vdev's list");
  239. dp_vdev_unref_delete(self_soc,
  240. vdev, DP_MOD_ID_RX);
  241. /* TODO - relase soc ref here */
  242. /* dp_soc_unref_delete(soc);*/
  243. ret = QDF_STATUS_E_FAILURE;
  244. goto exit;
  245. }
  246. }
  247. dp_vdev_unref_delete(soc, vdev,
  248. DP_MOD_ID_RX);
  249. } /* vdev */
  250. /* TODO - release soc ref here */
  251. /* dp_soc_unref_delete(soc); */
  252. } /* soc */
  253. } /* for */
  254. } /* for */
  255. exit:
  256. dp_vdev_unref_delete(self_soc, self_vdev, DP_MOD_ID_RX);
  257. return ret;
  258. }
  259. void dp_clr_mlo_ptnr_list(struct dp_soc *soc, struct dp_vdev *vdev)
  260. {
  261. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  262. struct dp_vdev_be *vdev_be = dp_get_be_vdev_from_dp_vdev(vdev);
  263. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  264. uint8_t soc_id = be_soc->mlo_chip_id;
  265. uint8_t pdev_id = vdev->pdev->pdev_id;
  266. int i, j;
  267. for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
  268. for (j = 0; j < WLAN_MAX_MLO_LINKS_PER_SOC; j++) {
  269. struct dp_vdev *pr_vdev;
  270. struct dp_soc *pr_soc;
  271. struct dp_soc_be *pr_soc_be;
  272. struct dp_pdev *pr_pdev;
  273. struct dp_vdev_be *pr_vdev_be;
  274. if (vdev_be->partner_vdev_list[i][j] ==
  275. CDP_INVALID_VDEV_ID)
  276. continue;
  277. pr_soc = dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  278. pr_soc_be = dp_get_be_soc_from_dp_soc(pr_soc);
  279. pr_vdev = dp_vdev_get_ref_by_id(pr_soc,
  280. vdev_be->partner_vdev_list[i][j],
  281. DP_MOD_ID_RX);
  282. if (!pr_vdev)
  283. continue;
  284. /* release ref and remove self vdev from partner list */
  285. pr_vdev_be = dp_get_be_vdev_from_dp_vdev(pr_vdev);
  286. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_RX);
  287. pr_vdev_be->partner_vdev_list[soc_id][pdev_id] =
  288. CDP_INVALID_VDEV_ID;
  289. /* release ref and remove partner vdev from self list */
  290. dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
  291. pr_pdev = pr_vdev->pdev;
  292. vdev_be->partner_vdev_list[pr_soc_be->mlo_chip_id][pr_pdev->pdev_id] =
  293. CDP_INVALID_VDEV_ID;
  294. dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
  295. }
  296. }
  297. }
  298. static void dp_mlo_setup_complete(struct cdp_mlo_ctxt *cdp_ml_ctxt)
  299. {
  300. struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
  301. int i;
  302. struct dp_soc *soc;
  303. struct dp_soc_be *be_soc;
  304. QDF_STATUS qdf_status;
  305. if (!cdp_ml_ctxt)
  306. return;
  307. for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
  308. soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, i);
  309. if (!soc)
  310. continue;
  311. be_soc = dp_get_be_soc_from_dp_soc(soc);
  312. qdf_status = dp_partner_soc_rx_hw_cc_init(mlo_ctxt, be_soc);
  313. if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
  314. dp_alert("MLO partner SOC Rx desc CC init failed");
  315. qdf_assert_always(0);
  316. }
  317. }
  318. }
  319. static struct cdp_mlo_ops dp_mlo_ops = {
  320. .mlo_soc_setup = dp_mlo_soc_setup,
  321. .mlo_soc_teardown = dp_mlo_soc_teardown,
  322. .update_mlo_ptnr_list = dp_update_mlo_ptnr_list,
  323. .mlo_setup_complete = dp_mlo_setup_complete,
  324. };
  325. void dp_soc_mlo_fill_params(struct dp_soc *soc,
  326. struct cdp_soc_attach_params *params)
  327. {
  328. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  329. if (!params->mlo_enabled) {
  330. dp_warn("MLO not enabled on SOC");
  331. return;
  332. }
  333. be_soc->mlo_chip_id = params->mlo_chip_id;
  334. be_soc->ml_ctxt = cdp_mlo_ctx_to_dp(params->ml_context);
  335. be_soc->mlo_enabled = 1;
  336. soc->cdp_soc.ops->mlo_ops = &dp_mlo_ops;
  337. }
  338. void dp_pdev_mlo_fill_params(struct dp_pdev *pdev,
  339. struct cdp_pdev_attach_params *params)
  340. {
  341. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(pdev->soc);
  342. struct dp_pdev_be *be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
  343. if (!be_soc->mlo_enabled) {
  344. dp_info("MLO not enabled on SOC");
  345. return;
  346. }
  347. be_pdev->mlo_link_id = params->mlo_link_id;
  348. }
  349. void dp_mlo_partner_chips_map(struct dp_soc *soc,
  350. struct dp_peer *peer,
  351. uint16_t peer_id)
  352. {
  353. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  354. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  355. bool is_ml_peer_id =
  356. HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
  357. uint8_t chip_id;
  358. struct dp_soc *temp_soc;
  359. if (!mlo_ctxt)
  360. return;
  361. /* for non ML peer dont map on partner chips*/
  362. if (!is_ml_peer_id)
  363. return;
  364. qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
  365. for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
  366. temp_soc = mlo_ctxt->ml_soc_list[chip_id];
  367. if (!temp_soc)
  368. continue;
  369. /* skip if this is current soc */
  370. if (temp_soc == soc)
  371. continue;
  372. dp_peer_find_id_to_obj_add(temp_soc, peer, peer_id);
  373. }
  374. qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
  375. }
  376. qdf_export_symbol(dp_mlo_partner_chips_map);
  377. void dp_mlo_partner_chips_unmap(struct dp_soc *soc,
  378. uint16_t peer_id)
  379. {
  380. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  381. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  382. bool is_ml_peer_id =
  383. HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
  384. uint8_t chip_id;
  385. struct dp_soc *temp_soc;
  386. if (!is_ml_peer_id)
  387. return;
  388. if (!mlo_ctxt)
  389. return;
  390. qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
  391. for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
  392. temp_soc = mlo_ctxt->ml_soc_list[chip_id];
  393. if (!temp_soc)
  394. continue;
  395. /* skip if this is current soc */
  396. if (temp_soc == soc)
  397. continue;
  398. dp_peer_find_id_to_obj_remove(temp_soc, peer_id);
  399. }
  400. qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
  401. }
  402. qdf_export_symbol(dp_mlo_partner_chips_unmap);
  403. uint8_t dp_mlo_get_chip_id(struct dp_soc *soc)
  404. {
  405. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  406. return be_soc->mlo_chip_id;
  407. }
  408. qdf_export_symbol(dp_mlo_get_chip_id);
  409. struct dp_peer *
  410. dp_link_peer_hash_find_by_chip_id(struct dp_soc *soc,
  411. uint8_t *peer_mac_addr,
  412. int mac_addr_is_aligned,
  413. uint8_t vdev_id,
  414. uint8_t chip_id,
  415. enum dp_mod_id mod_id)
  416. {
  417. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  418. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  419. struct dp_soc *link_peer_soc = NULL;
  420. struct dp_peer *peer = NULL;
  421. if (!mlo_ctxt)
  422. return NULL;
  423. link_peer_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
  424. if (!link_peer_soc)
  425. return NULL;
  426. peer = dp_peer_find_hash_find(link_peer_soc, peer_mac_addr,
  427. mac_addr_is_aligned, vdev_id,
  428. mod_id);
  429. qdf_atomic_dec(&link_peer_soc->ref_count);
  430. return peer;
  431. }
  432. qdf_export_symbol(dp_link_peer_hash_find_by_chip_id);
  433. struct dp_soc *
  434. dp_rx_replensih_soc_get(struct dp_soc *soc, uint8_t reo_ring_num)
  435. {
  436. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  437. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  438. uint8_t chip_id;
  439. uint8_t rx_ring_mask;
  440. if (!be_soc->mlo_enabled || !mlo_ctxt)
  441. return soc;
  442. for (chip_id = 0; chip_id < WLAN_MAX_MLO_CHIPS; chip_id++) {
  443. rx_ring_mask =
  444. wlan_cfg_mlo_rx_ring_map_get_by_chip_id
  445. (soc->wlan_cfg_ctx, chip_id);
  446. if (rx_ring_mask & (1 << reo_ring_num))
  447. return dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
  448. }
  449. return soc;
  450. }
  451. #ifdef WLAN_MCAST_MLO
  452. void dp_mcast_mlo_iter_ptnr_soc(struct dp_soc_be *be_soc,
  453. dp_ptnr_soc_iter_func func,
  454. void *arg)
  455. {
  456. int i = 0;
  457. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  458. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  459. struct dp_soc *ptnr_soc =
  460. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  461. if (!ptnr_soc)
  462. continue;
  463. (*func)(ptnr_soc, arg);
  464. }
  465. }
  466. qdf_export_symbol(dp_mcast_mlo_iter_ptnr_soc);
  467. void dp_mcast_mlo_iter_ptnr_vdev(struct dp_soc_be *be_soc,
  468. struct dp_vdev_be *be_vdev,
  469. dp_ptnr_vdev_iter_func func,
  470. void *arg,
  471. enum dp_mod_id mod_id)
  472. {
  473. int i = 0;
  474. int j = 0;
  475. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  476. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  477. struct dp_soc *ptnr_soc =
  478. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  479. if (!ptnr_soc)
  480. continue;
  481. for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
  482. struct dp_vdev *ptnr_vdev;
  483. ptnr_vdev = dp_vdev_get_ref_by_id(
  484. ptnr_soc,
  485. be_vdev->partner_vdev_list[i][j],
  486. mod_id);
  487. if (!ptnr_vdev)
  488. continue;
  489. (*func)(be_vdev, ptnr_vdev, arg);
  490. dp_vdev_unref_delete(ptnr_vdev->pdev->soc,
  491. ptnr_vdev,
  492. mod_id);
  493. }
  494. }
  495. }
  496. qdf_export_symbol(dp_mcast_mlo_iter_ptnr_vdev);
  497. struct dp_vdev *dp_mlo_get_mcast_primary_vdev(struct dp_soc_be *be_soc,
  498. struct dp_vdev_be *be_vdev,
  499. enum dp_mod_id mod_id)
  500. {
  501. int i = 0;
  502. int j = 0;
  503. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  504. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  505. struct dp_soc *ptnr_soc =
  506. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  507. if (!ptnr_soc)
  508. continue;
  509. for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
  510. struct dp_vdev *ptnr_vdev = NULL;
  511. struct dp_vdev_be *be_ptnr_vdev = NULL;
  512. ptnr_vdev = dp_vdev_get_ref_by_id(
  513. ptnr_soc,
  514. be_vdev->partner_vdev_list[i][j],
  515. mod_id);
  516. if (!ptnr_vdev)
  517. continue;
  518. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  519. if (be_ptnr_vdev->mcast_primary)
  520. return ptnr_vdev;
  521. dp_vdev_unref_delete(be_ptnr_vdev->vdev.pdev->soc,
  522. &be_ptnr_vdev->vdev,
  523. mod_id);
  524. }
  525. }
  526. return NULL;
  527. }
  528. qdf_export_symbol(dp_mlo_get_mcast_primary_vdev);
  529. #endif