dp_mlo.c 17 KB

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