dp_mlo.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657
  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. pr_soc_be = dp_get_be_soc_from_dp_soc(pr_soc);
  285. pr_vdev = dp_vdev_get_ref_by_id(pr_soc,
  286. vdev_be->partner_vdev_list[i][j],
  287. DP_MOD_ID_RX);
  288. if (!pr_vdev)
  289. continue;
  290. /* release ref and remove self vdev from partner list */
  291. pr_vdev_be = dp_get_be_vdev_from_dp_vdev(pr_vdev);
  292. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_RX);
  293. pr_vdev_be->partner_vdev_list[soc_id][pdev_id] =
  294. CDP_INVALID_VDEV_ID;
  295. /* release ref and remove partner vdev from self list */
  296. dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
  297. pr_pdev = pr_vdev->pdev;
  298. vdev_be->partner_vdev_list[pr_soc_be->mlo_chip_id][pr_pdev->pdev_id] =
  299. CDP_INVALID_VDEV_ID;
  300. dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
  301. }
  302. }
  303. }
  304. static void dp_mlo_setup_complete(struct cdp_mlo_ctxt *cdp_ml_ctxt)
  305. {
  306. struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
  307. int i;
  308. struct dp_soc *soc;
  309. struct dp_soc_be *be_soc;
  310. QDF_STATUS qdf_status;
  311. if (!cdp_ml_ctxt)
  312. return;
  313. for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
  314. soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, i);
  315. if (!soc)
  316. continue;
  317. be_soc = dp_get_be_soc_from_dp_soc(soc);
  318. qdf_status = dp_partner_soc_rx_hw_cc_init(mlo_ctxt, be_soc);
  319. if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
  320. dp_alert("MLO partner SOC Rx desc CC init failed");
  321. qdf_assert_always(0);
  322. }
  323. }
  324. }
  325. static struct cdp_mlo_ops dp_mlo_ops = {
  326. .mlo_soc_setup = dp_mlo_soc_setup,
  327. .mlo_soc_teardown = dp_mlo_soc_teardown,
  328. .update_mlo_ptnr_list = dp_update_mlo_ptnr_list,
  329. .mlo_setup_complete = dp_mlo_setup_complete,
  330. };
  331. void dp_soc_mlo_fill_params(struct dp_soc *soc,
  332. struct cdp_soc_attach_params *params)
  333. {
  334. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  335. if (!params->mlo_enabled) {
  336. dp_warn("MLO not enabled on SOC");
  337. return;
  338. }
  339. be_soc->mlo_chip_id = params->mlo_chip_id;
  340. be_soc->ml_ctxt = cdp_mlo_ctx_to_dp(params->ml_context);
  341. be_soc->mlo_enabled = 1;
  342. soc->cdp_soc.ops->mlo_ops = &dp_mlo_ops;
  343. }
  344. void dp_pdev_mlo_fill_params(struct dp_pdev *pdev,
  345. struct cdp_pdev_attach_params *params)
  346. {
  347. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(pdev->soc);
  348. struct dp_pdev_be *be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
  349. if (!be_soc->mlo_enabled) {
  350. dp_info("MLO not enabled on SOC");
  351. return;
  352. }
  353. be_pdev->mlo_link_id = params->mlo_link_id;
  354. }
  355. void dp_mlo_partner_chips_map(struct dp_soc *soc,
  356. struct dp_peer *peer,
  357. uint16_t peer_id)
  358. {
  359. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  360. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  361. bool is_ml_peer_id =
  362. HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
  363. uint8_t chip_id;
  364. struct dp_soc *temp_soc;
  365. if (!mlo_ctxt)
  366. return;
  367. /* for non ML peer dont map on partner chips*/
  368. if (!is_ml_peer_id)
  369. return;
  370. qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
  371. for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
  372. temp_soc = mlo_ctxt->ml_soc_list[chip_id];
  373. if (!temp_soc)
  374. continue;
  375. /* skip if this is current soc */
  376. if (temp_soc == soc)
  377. continue;
  378. dp_peer_find_id_to_obj_add(temp_soc, peer, peer_id);
  379. }
  380. qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
  381. }
  382. qdf_export_symbol(dp_mlo_partner_chips_map);
  383. void dp_mlo_partner_chips_unmap(struct dp_soc *soc,
  384. uint16_t peer_id)
  385. {
  386. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  387. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  388. bool is_ml_peer_id =
  389. HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
  390. uint8_t chip_id;
  391. struct dp_soc *temp_soc;
  392. if (!is_ml_peer_id)
  393. return;
  394. if (!mlo_ctxt)
  395. return;
  396. qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
  397. for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
  398. temp_soc = mlo_ctxt->ml_soc_list[chip_id];
  399. if (!temp_soc)
  400. continue;
  401. /* skip if this is current soc */
  402. if (temp_soc == soc)
  403. continue;
  404. dp_peer_find_id_to_obj_remove(temp_soc, peer_id);
  405. }
  406. qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
  407. }
  408. qdf_export_symbol(dp_mlo_partner_chips_unmap);
  409. uint8_t dp_mlo_get_chip_id(struct dp_soc *soc)
  410. {
  411. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  412. return be_soc->mlo_chip_id;
  413. }
  414. qdf_export_symbol(dp_mlo_get_chip_id);
  415. struct dp_peer *
  416. dp_link_peer_hash_find_by_chip_id(struct dp_soc *soc,
  417. uint8_t *peer_mac_addr,
  418. int mac_addr_is_aligned,
  419. uint8_t vdev_id,
  420. uint8_t chip_id,
  421. enum dp_mod_id mod_id)
  422. {
  423. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  424. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  425. struct dp_soc *link_peer_soc = NULL;
  426. struct dp_peer *peer = NULL;
  427. if (!mlo_ctxt)
  428. return NULL;
  429. link_peer_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
  430. if (!link_peer_soc)
  431. return NULL;
  432. peer = dp_peer_find_hash_find(link_peer_soc, peer_mac_addr,
  433. mac_addr_is_aligned, vdev_id,
  434. mod_id);
  435. qdf_atomic_dec(&link_peer_soc->ref_count);
  436. return peer;
  437. }
  438. qdf_export_symbol(dp_link_peer_hash_find_by_chip_id);
  439. void dp_mlo_get_rx_hash_key(struct dp_soc *soc,
  440. struct cdp_lro_hash_config *lro_hash)
  441. {
  442. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  443. struct dp_mlo_ctxt *ml_ctxt = be_soc->ml_ctxt;
  444. if (!be_soc->mlo_enabled || !ml_ctxt)
  445. return dp_get_rx_hash_key_bytes(lro_hash);
  446. qdf_mem_copy(lro_hash->toeplitz_hash_ipv4, ml_ctxt->toeplitz_hash_ipv4,
  447. (sizeof(lro_hash->toeplitz_hash_ipv4[0]) *
  448. LRO_IPV4_SEED_ARR_SZ));
  449. qdf_mem_copy(lro_hash->toeplitz_hash_ipv6, ml_ctxt->toeplitz_hash_ipv6,
  450. (sizeof(lro_hash->toeplitz_hash_ipv6[0]) *
  451. LRO_IPV6_SEED_ARR_SZ));
  452. }
  453. struct dp_soc *
  454. dp_rx_replensih_soc_get(struct dp_soc *soc, uint8_t reo_ring_num)
  455. {
  456. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  457. struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
  458. uint8_t chip_id;
  459. uint8_t rx_ring_mask;
  460. if (!be_soc->mlo_enabled || !mlo_ctxt)
  461. return soc;
  462. for (chip_id = 0; chip_id < WLAN_MAX_MLO_CHIPS; chip_id++) {
  463. rx_ring_mask =
  464. wlan_cfg_mlo_rx_ring_map_get_by_chip_id
  465. (soc->wlan_cfg_ctx, chip_id);
  466. if (rx_ring_mask & (1 << reo_ring_num))
  467. return dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
  468. }
  469. return soc;
  470. }
  471. #ifdef WLAN_MCAST_MLO
  472. void dp_mcast_mlo_iter_ptnr_soc(struct dp_soc_be *be_soc,
  473. dp_ptnr_soc_iter_func func,
  474. void *arg)
  475. {
  476. int i = 0;
  477. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  478. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  479. struct dp_soc *ptnr_soc =
  480. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  481. if (!ptnr_soc)
  482. continue;
  483. (*func)(ptnr_soc, arg);
  484. }
  485. }
  486. qdf_export_symbol(dp_mcast_mlo_iter_ptnr_soc);
  487. void dp_mcast_mlo_iter_ptnr_vdev(struct dp_soc_be *be_soc,
  488. struct dp_vdev_be *be_vdev,
  489. dp_ptnr_vdev_iter_func func,
  490. void *arg,
  491. enum dp_mod_id mod_id)
  492. {
  493. int i = 0;
  494. int j = 0;
  495. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  496. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  497. struct dp_soc *ptnr_soc =
  498. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  499. if (!ptnr_soc)
  500. continue;
  501. for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
  502. struct dp_vdev *ptnr_vdev;
  503. ptnr_vdev = dp_vdev_get_ref_by_id(
  504. ptnr_soc,
  505. be_vdev->partner_vdev_list[i][j],
  506. mod_id);
  507. if (!ptnr_vdev)
  508. continue;
  509. (*func)(be_vdev, ptnr_vdev, arg);
  510. dp_vdev_unref_delete(ptnr_vdev->pdev->soc,
  511. ptnr_vdev,
  512. mod_id);
  513. }
  514. }
  515. }
  516. qdf_export_symbol(dp_mcast_mlo_iter_ptnr_vdev);
  517. struct dp_vdev *dp_mlo_get_mcast_primary_vdev(struct dp_soc_be *be_soc,
  518. struct dp_vdev_be *be_vdev,
  519. enum dp_mod_id mod_id)
  520. {
  521. int i = 0;
  522. int j = 0;
  523. struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
  524. for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
  525. struct dp_soc *ptnr_soc =
  526. dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
  527. if (!ptnr_soc)
  528. continue;
  529. for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
  530. struct dp_vdev *ptnr_vdev = NULL;
  531. struct dp_vdev_be *be_ptnr_vdev = NULL;
  532. ptnr_vdev = dp_vdev_get_ref_by_id(
  533. ptnr_soc,
  534. be_vdev->partner_vdev_list[i][j],
  535. mod_id);
  536. if (!ptnr_vdev)
  537. continue;
  538. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  539. if (be_ptnr_vdev->mcast_primary)
  540. return ptnr_vdev;
  541. dp_vdev_unref_delete(be_ptnr_vdev->vdev.pdev->soc,
  542. &be_ptnr_vdev->vdev,
  543. mod_id);
  544. }
  545. }
  546. return NULL;
  547. }
  548. qdf_export_symbol(dp_mlo_get_mcast_primary_vdev);
  549. #endif