1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894 |
- /*
- * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
- #include <wlan_utility.h>
- #include <dp_internal.h>
- #include <dp_htt.h>
- #include <hal_be_api.h>
- #include "dp_mlo.h"
- #include <dp_be.h>
- #include <dp_be_rx.h>
- #include <dp_htt.h>
- #include <dp_internal.h>
- #include <wlan_cfg.h>
- #include <wlan_mlo_mgr_cmn.h>
- #include "dp_umac_reset.h"
- #ifdef DP_UMAC_HW_RESET_SUPPORT
- /**
- * dp_umac_reset_update_partner_map() - Update Umac reset partner map
- * @mlo_ctx: mlo soc context
- * @chip_id: chip id
- * @set: flag indicating whether to set or clear the bit
- *
- * Return: void
- */
- static void dp_umac_reset_update_partner_map(struct dp_mlo_ctxt *mlo_ctx,
- int chip_id, bool set);
- #endif
- /**
- * dp_mlo_ctxt_attach_wifi3() - Attach DP MLO context
- * @ctrl_ctxt: CDP control context
- *
- * Return: DP MLO context handle on success, NULL on failure
- */
- static struct cdp_mlo_ctxt *
- dp_mlo_ctxt_attach_wifi3(struct cdp_ctrl_mlo_mgr *ctrl_ctxt)
- {
- struct dp_mlo_ctxt *mlo_ctxt =
- qdf_mem_malloc(sizeof(struct dp_mlo_ctxt));
- if (!mlo_ctxt) {
- dp_err("Failed to allocate DP MLO Context");
- return NULL;
- }
- mlo_ctxt->ctrl_ctxt = ctrl_ctxt;
- if (dp_mlo_peer_find_hash_attach_be
- (mlo_ctxt, DP_MAX_MLO_PEER) != QDF_STATUS_SUCCESS) {
- dp_err("Failed to allocate peer hash");
- qdf_mem_free(mlo_ctxt);
- return NULL;
- }
- qdf_get_random_bytes(mlo_ctxt->toeplitz_hash_ipv4,
- (sizeof(mlo_ctxt->toeplitz_hash_ipv4[0]) *
- LRO_IPV4_SEED_ARR_SZ));
- qdf_get_random_bytes(mlo_ctxt->toeplitz_hash_ipv6,
- (sizeof(mlo_ctxt->toeplitz_hash_ipv6[0]) *
- LRO_IPV6_SEED_ARR_SZ));
- qdf_spinlock_create(&mlo_ctxt->ml_soc_list_lock);
- qdf_spinlock_create(&mlo_ctxt->grp_umac_reset_ctx.grp_ctx_lock);
- return dp_mlo_ctx_to_cdp(mlo_ctxt);
- }
- /**
- * dp_mlo_ctxt_detach_wifi3() - Detach DP MLO context
- * @cdp_ml_ctxt: pointer to CDP DP MLO context
- *
- * Return: void
- */
- static void dp_mlo_ctxt_detach_wifi3(struct cdp_mlo_ctxt *cdp_ml_ctxt)
- {
- struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
- if (!cdp_ml_ctxt)
- return;
- qdf_spinlock_destroy(&mlo_ctxt->grp_umac_reset_ctx.grp_ctx_lock);
- qdf_spinlock_destroy(&mlo_ctxt->ml_soc_list_lock);
- dp_mlo_peer_find_hash_detach_be(mlo_ctxt);
- qdf_mem_free(mlo_ctxt);
- }
- /**
- * dp_mlo_set_soc_by_chip_id() - Add DP soc to ML context soc list
- * @ml_ctxt: DP ML context handle
- * @soc: DP soc handle
- * @chip_id: MLO chip id
- *
- * Return: void
- */
- static void dp_mlo_set_soc_by_chip_id(struct dp_mlo_ctxt *ml_ctxt,
- struct dp_soc *soc,
- uint8_t chip_id)
- {
- qdf_spin_lock_bh(&ml_ctxt->ml_soc_list_lock);
- ml_ctxt->ml_soc_list[chip_id] = soc;
- /* The same API is called during soc_attach and soc_detach
- * soc parameter is non-null or null accordingly.
- */
- if (soc)
- ml_ctxt->ml_soc_cnt++;
- else
- ml_ctxt->ml_soc_cnt--;
- dp_umac_reset_update_partner_map(ml_ctxt, chip_id, !!soc);
- qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
- }
- struct dp_soc*
- dp_mlo_get_soc_ref_by_chip_id(struct dp_mlo_ctxt *ml_ctxt,
- uint8_t chip_id)
- {
- struct dp_soc *soc = NULL;
- if (!ml_ctxt) {
- dp_warn("MLO context not created, MLO not enabled");
- return NULL;
- }
- qdf_spin_lock_bh(&ml_ctxt->ml_soc_list_lock);
- soc = ml_ctxt->ml_soc_list[chip_id];
- if (!soc) {
- qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
- return NULL;
- }
- qdf_atomic_inc(&soc->ref_count);
- qdf_spin_unlock_bh(&ml_ctxt->ml_soc_list_lock);
- return soc;
- }
- static QDF_STATUS dp_partner_soc_rx_hw_cc_init(struct dp_mlo_ctxt *mlo_ctxt,
- struct dp_soc_be *be_soc)
- {
- uint8_t i;
- struct dp_soc *partner_soc;
- struct dp_soc_be *be_partner_soc;
- uint8_t pool_id;
- QDF_STATUS qdf_status = QDF_STATUS_SUCCESS;
- for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
- partner_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, i);
- if (!partner_soc) {
- dp_err("partner_soc is NULL");
- continue;
- }
- be_partner_soc = dp_get_be_soc_from_dp_soc(partner_soc);
- for (pool_id = 0; pool_id < MAX_RXDESC_POOLS; pool_id++) {
- qdf_status =
- dp_hw_cookie_conversion_init
- (be_soc,
- &be_partner_soc->rx_cc_ctx[pool_id]);
- if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
- dp_alert("MLO partner soc RX CC init failed");
- return qdf_status;
- }
- }
- }
- return qdf_status;
- }
- static void dp_mlo_soc_drain_rx_buf(struct dp_soc *soc, void *arg, int chip_id)
- {
- uint8_t i = 0;
- uint8_t cpu = 0;
- uint8_t rx_ring_mask[WLAN_CFG_INT_NUM_CONTEXTS] = {0};
- uint8_t rx_err_ring_mask[WLAN_CFG_INT_NUM_CONTEXTS] = {0};
- uint8_t rx_wbm_rel_ring_mask[WLAN_CFG_INT_NUM_CONTEXTS] = {0};
- uint8_t reo_status_ring_mask[WLAN_CFG_INT_NUM_CONTEXTS] = {0};
- /* Save the current interrupt mask and disable the interrupts */
- for (i = 0; i < wlan_cfg_get_num_contexts(soc->wlan_cfg_ctx); i++) {
- rx_ring_mask[i] = soc->intr_ctx[i].rx_ring_mask;
- rx_err_ring_mask[i] = soc->intr_ctx[i].rx_err_ring_mask;
- rx_wbm_rel_ring_mask[i] = soc->intr_ctx[i].rx_wbm_rel_ring_mask;
- reo_status_ring_mask[i] = soc->intr_ctx[i].reo_status_ring_mask;
- soc->intr_ctx[i].rx_ring_mask = 0;
- soc->intr_ctx[i].rx_err_ring_mask = 0;
- soc->intr_ctx[i].rx_wbm_rel_ring_mask = 0;
- soc->intr_ctx[i].reo_status_ring_mask = 0;
- }
- /* make sure dp_service_srngs not running on any of the CPU */
- for (cpu = 0; cpu < NR_CPUS; cpu++) {
- while (qdf_atomic_test_bit(cpu,
- &soc->service_rings_running))
- ;
- }
- for (i = 0; i < wlan_cfg_get_num_contexts(soc->wlan_cfg_ctx); i++) {
- uint8_t ring = 0;
- uint32_t num_entries = 0;
- hal_ring_handle_t hal_ring_hdl = NULL;
- uint8_t rx_mask = wlan_cfg_get_rx_ring_mask(
- soc->wlan_cfg_ctx, i);
- uint8_t rx_err_mask = wlan_cfg_get_rx_err_ring_mask(
- soc->wlan_cfg_ctx, i);
- uint8_t rx_wbm_rel_mask = wlan_cfg_get_rx_wbm_rel_ring_mask(
- soc->wlan_cfg_ctx, i);
- if (rx_mask) {
- /* iterate through each reo ring and process the buf */
- for (ring = 0; ring < soc->num_reo_dest_rings; ring++) {
- if (!(rx_mask & (1 << ring)))
- continue;
- hal_ring_hdl =
- soc->reo_dest_ring[ring].hal_srng;
- num_entries = hal_srng_get_num_entries(
- soc->hal_soc,
- hal_ring_hdl);
- dp_rx_process_be(&soc->intr_ctx[i],
- hal_ring_hdl,
- ring,
- num_entries);
- }
- }
- /* Process REO Exception ring */
- if (rx_err_mask) {
- hal_ring_hdl = soc->reo_exception_ring.hal_srng;
- num_entries = hal_srng_get_num_entries(
- soc->hal_soc,
- hal_ring_hdl);
- dp_rx_err_process(&soc->intr_ctx[i], soc,
- hal_ring_hdl, num_entries);
- }
- /* Process Rx WBM release ring */
- if (rx_wbm_rel_mask) {
- hal_ring_hdl = soc->rx_rel_ring.hal_srng;
- num_entries = hal_srng_get_num_entries(
- soc->hal_soc,
- hal_ring_hdl);
- dp_rx_wbm_err_process(&soc->intr_ctx[i], soc,
- hal_ring_hdl, num_entries);
- }
- }
- /* restore the interrupt mask */
- for (i = 0; i < wlan_cfg_get_num_contexts(soc->wlan_cfg_ctx); i++) {
- soc->intr_ctx[i].rx_ring_mask = rx_ring_mask[i];
- soc->intr_ctx[i].rx_err_ring_mask = rx_err_ring_mask[i];
- soc->intr_ctx[i].rx_wbm_rel_ring_mask = rx_wbm_rel_ring_mask[i];
- soc->intr_ctx[i].reo_status_ring_mask = reo_status_ring_mask[i];
- }
- }
- static void dp_mlo_soc_setup(struct cdp_soc_t *soc_hdl,
- struct cdp_mlo_ctxt *cdp_ml_ctxt)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- uint8_t pdev_id;
- if (!cdp_ml_ctxt)
- return;
- be_soc->ml_ctxt = mlo_ctxt;
- for (pdev_id = 0; pdev_id < MAX_PDEV_CNT; pdev_id++) {
- if (soc->pdev_list[pdev_id])
- dp_mlo_update_link_to_pdev_map(soc,
- soc->pdev_list[pdev_id]);
- }
- dp_mlo_set_soc_by_chip_id(mlo_ctxt, soc, be_soc->mlo_chip_id);
- }
- static void dp_mlo_soc_teardown(struct cdp_soc_t *soc_hdl,
- struct cdp_mlo_ctxt *cdp_ml_ctxt,
- bool is_force_down)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- if (!cdp_ml_ctxt)
- return;
- /* During the teardown drain the Rx buffers if any exist in the ring */
- dp_mlo_iter_ptnr_soc(be_soc,
- dp_mlo_soc_drain_rx_buf,
- NULL);
- dp_mlo_set_soc_by_chip_id(mlo_ctxt, NULL, be_soc->mlo_chip_id);
- be_soc->ml_ctxt = NULL;
- }
- static QDF_STATUS dp_mlo_add_ptnr_vdev(struct dp_vdev *vdev1,
- struct dp_vdev *vdev2,
- struct dp_soc *soc, uint8_t pdev_id)
- {
- struct dp_soc_be *soc_be = dp_get_be_soc_from_dp_soc(soc);
- struct dp_vdev_be *vdev2_be = dp_get_be_vdev_from_dp_vdev(vdev2);
- /* return when valid entry exists */
- if (vdev1->is_bridge_vdev) {
- if (vdev2_be->bridge_vdev_list[soc_be->mlo_chip_id][pdev_id] !=
- CDP_INVALID_VDEV_ID)
- return QDF_STATUS_SUCCESS;
- vdev2_be->bridge_vdev_list[soc_be->mlo_chip_id][pdev_id] =
- vdev1->vdev_id;
- } else {
- if (vdev2_be->partner_vdev_list[soc_be->mlo_chip_id][pdev_id] !=
- CDP_INVALID_VDEV_ID)
- return QDF_STATUS_SUCCESS;
- vdev2_be->partner_vdev_list[soc_be->mlo_chip_id][pdev_id] =
- vdev1->vdev_id;
- }
- mlo_debug("Add vdev%d to vdev%d list, mlo_chip_id = %d pdev_id = %d\n",
- vdev1->vdev_id, vdev2->vdev_id, soc_be->mlo_chip_id, pdev_id);
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS dp_update_mlo_ptnr_list(struct cdp_soc_t *soc_hdl,
- int8_t partner_vdev_ids[], uint8_t num_vdevs,
- uint8_t self_vdev_id)
- {
- int i, j;
- struct dp_soc *self_soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_vdev *self_vdev;
- QDF_STATUS ret = QDF_STATUS_SUCCESS;
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(self_soc);
- struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
- if (!dp_mlo)
- return QDF_STATUS_E_FAILURE;
- self_vdev = dp_vdev_get_ref_by_id(self_soc, self_vdev_id, DP_MOD_ID_RX);
- if (!self_vdev)
- return QDF_STATUS_E_FAILURE;
- /* go through the input vdev id list and if there are partner vdevs,
- * - then add the current vdev's id to partner vdev's list using pdev_id and
- * increase the reference
- * - add partner vdev to self list and increase the reference
- */
- for (i = 0; i < num_vdevs; i++) {
- if (partner_vdev_ids[i] == CDP_INVALID_VDEV_ID)
- continue;
- for (j = 0; j < WLAN_MAX_MLO_CHIPS; j++) {
- struct dp_soc *soc =
- dp_mlo_get_soc_ref_by_chip_id(dp_mlo, j);
- if (soc) {
- struct dp_vdev *vdev;
- vdev = dp_vdev_get_ref_by_id(soc,
- partner_vdev_ids[i], DP_MOD_ID_RX);
- if (vdev) {
- if (vdev == self_vdev) {
- dp_vdev_unref_delete(soc,
- vdev, DP_MOD_ID_RX);
- /*dp_soc_unref_delete(soc); */
- continue;
- }
- if (qdf_is_macaddr_equal(
- (struct qdf_mac_addr *)self_vdev->mld_mac_addr.raw,
- (struct qdf_mac_addr *)vdev->mld_mac_addr.raw)) {
- if (dp_mlo_add_ptnr_vdev(self_vdev,
- vdev, self_soc,
- self_vdev->pdev->pdev_id) !=
- QDF_STATUS_SUCCESS) {
- dp_err("Unable to add self to partner vdev's list");
- dp_vdev_unref_delete(soc,
- vdev, DP_MOD_ID_RX);
- /* TODO - release soc ref here */
- /* dp_soc_unref_delete(soc);*/
- ret = QDF_STATUS_E_FAILURE;
- goto exit;
- }
- /* add to self list */
- if (dp_mlo_add_ptnr_vdev(vdev, self_vdev, soc,
- vdev->pdev->pdev_id) !=
- QDF_STATUS_SUCCESS) {
- dp_err("Unable to add vdev to self vdev's list");
- dp_vdev_unref_delete(self_soc,
- vdev, DP_MOD_ID_RX);
- /* TODO - release soc ref here */
- /* dp_soc_unref_delete(soc);*/
- ret = QDF_STATUS_E_FAILURE;
- goto exit;
- }
- }
- dp_vdev_unref_delete(soc, vdev,
- DP_MOD_ID_RX);
- } /* vdev */
- /* TODO - release soc ref here */
- /* dp_soc_unref_delete(soc); */
- } /* soc */
- } /* for */
- } /* for */
- exit:
- dp_vdev_unref_delete(self_soc, self_vdev, DP_MOD_ID_RX);
- return ret;
- }
- void dp_clr_mlo_ptnr_list(struct dp_soc *soc, struct dp_vdev *vdev)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_vdev_be *vdev_be = dp_get_be_vdev_from_dp_vdev(vdev);
- struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
- uint8_t soc_id = be_soc->mlo_chip_id;
- uint8_t pdev_id = vdev->pdev->pdev_id;
- int i, j;
- for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
- for (j = 0; j < WLAN_MAX_MLO_LINKS_PER_SOC; j++) {
- struct dp_vdev *pr_vdev;
- struct dp_soc *pr_soc;
- struct dp_soc_be *pr_soc_be;
- struct dp_pdev *pr_pdev;
- struct dp_vdev_be *pr_vdev_be;
- if (vdev_be->partner_vdev_list[i][j] ==
- CDP_INVALID_VDEV_ID)
- continue;
- pr_soc = dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!pr_soc)
- continue;
- pr_soc_be = dp_get_be_soc_from_dp_soc(pr_soc);
- pr_vdev = dp_vdev_get_ref_by_id(pr_soc,
- vdev_be->partner_vdev_list[i][j],
- DP_MOD_ID_RX);
- if (!pr_vdev)
- continue;
- /* remove self vdev from partner list */
- pr_vdev_be = dp_get_be_vdev_from_dp_vdev(pr_vdev);
- if (vdev->is_bridge_vdev)
- pr_vdev_be->bridge_vdev_list[soc_id][pdev_id] =
- CDP_INVALID_VDEV_ID;
- else
- pr_vdev_be->partner_vdev_list[soc_id][pdev_id] =
- CDP_INVALID_VDEV_ID;
- /* remove partner vdev from self list */
- pr_pdev = pr_vdev->pdev;
- vdev_be->partner_vdev_list[pr_soc_be->mlo_chip_id][pr_pdev->pdev_id] =
- CDP_INVALID_VDEV_ID;
- dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
- }
- }
- for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
- for (j = 0; j < WLAN_MAX_MLO_LINKS_PER_SOC; j++) {
- struct dp_vdev *pr_vdev = NULL;
- struct dp_soc *pr_soc = NULL;
- struct dp_soc_be *pr_soc_be = NULL;
- struct dp_pdev *pr_pdev = NULL;
- struct dp_vdev_be *pr_vdev_be = NULL;
- if (vdev_be->bridge_vdev_list[i][j] ==
- CDP_INVALID_VDEV_ID)
- continue;
- pr_soc = dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!pr_soc)
- continue;
- pr_soc_be = dp_get_be_soc_from_dp_soc(pr_soc);
- pr_vdev = dp_vdev_get_ref_by_id(
- pr_soc,
- vdev_be->bridge_vdev_list[i][j],
- DP_MOD_ID_RX);
- if (!pr_vdev)
- continue;
- /* remove self vdev from partner list */
- pr_vdev_be = dp_get_be_vdev_from_dp_vdev(pr_vdev);
- if (vdev->is_bridge_vdev)
- pr_vdev_be->bridge_vdev_list[soc_id][pdev_id] =
- CDP_INVALID_VDEV_ID;
- else
- pr_vdev_be->partner_vdev_list[soc_id][pdev_id] =
- CDP_INVALID_VDEV_ID;
- /* remove partner vdev from self list */
- pr_pdev = pr_vdev->pdev;
- vdev_be->bridge_vdev_list[pr_soc_be->mlo_chip_id][pr_pdev->pdev_id] =
- CDP_INVALID_VDEV_ID;
- dp_vdev_unref_delete(pr_soc, pr_vdev, DP_MOD_ID_RX);
- }
- }
- }
- static QDF_STATUS
- dp_clear_mlo_ptnr_list(struct cdp_soc_t *soc_hdl, uint8_t self_vdev_id)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_vdev *vdev;
- vdev = dp_vdev_get_ref_by_id(soc, self_vdev_id, DP_MOD_ID_RX);
- if (!vdev)
- return QDF_STATUS_E_FAILURE;
- dp_clr_mlo_ptnr_list(soc, vdev);
- dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_RX);
- return QDF_STATUS_SUCCESS;
- }
- static void dp_mlo_setup_complete(struct cdp_mlo_ctxt *cdp_ml_ctxt)
- {
- struct dp_mlo_ctxt *mlo_ctxt = cdp_mlo_ctx_to_dp(cdp_ml_ctxt);
- int i;
- struct dp_soc *soc;
- struct dp_soc_be *be_soc;
- QDF_STATUS qdf_status;
- if (!cdp_ml_ctxt)
- return;
- for (i = 0; i < WLAN_MAX_MLO_CHIPS; i++) {
- soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, i);
- if (!soc)
- continue;
- be_soc = dp_get_be_soc_from_dp_soc(soc);
- qdf_status = dp_partner_soc_rx_hw_cc_init(mlo_ctxt, be_soc);
- if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
- dp_alert("MLO partner SOC Rx desc CC init failed");
- qdf_assert_always(0);
- }
- }
- }
- static void dp_mlo_update_delta_tsf2(struct cdp_soc_t *soc_hdl,
- uint8_t pdev_id, uint64_t delta_tsf2)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_pdev *pdev;
- struct dp_pdev_be *be_pdev;
- pdev = dp_get_pdev_from_soc_pdev_id_wifi3((struct dp_soc *)soc,
- pdev_id);
- if (!pdev) {
- dp_err("pdev is NULL for pdev_id %u", pdev_id);
- return;
- }
- be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
- be_pdev->delta_tsf2 = delta_tsf2;
- }
- static void dp_mlo_update_delta_tqm(struct cdp_soc_t *soc_hdl,
- uint64_t delta_tqm)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- be_soc->delta_tqm = delta_tqm;
- }
- static void dp_mlo_update_mlo_ts_offset(struct cdp_soc_t *soc_hdl,
- uint64_t offset)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- be_soc->mlo_tstamp_offset = offset;
- }
- #ifdef CONFIG_MLO_SINGLE_DEV
- /**
- * dp_aggregate_vdev_basic_stats() - aggregate vdev basic stats
- * @tgt_vdev_stats: target vdev buffer
- * @src_vdev_stats: source vdev buffer
- *
- * return: void
- */
- static inline
- void dp_aggregate_vdev_basic_stats(
- struct cdp_vdev_stats *tgt_vdev_stats,
- struct cdp_vdev_stats *src_vdev_stats)
- {
- DP_UPDATE_BASIC_STATS(tgt_vdev_stats, src_vdev_stats);
- }
- /**
- * dp_aggregate_vdev_ingress_stats() - aggregate vdev ingress stats
- * @tgt_vdev_stats: target vdev buffer
- * @src_vdev_stats: source vdev buffer
- *
- * return: void
- */
- static inline
- void dp_aggregate_vdev_ingress_stats(
- struct cdp_vdev_stats *tgt_vdev_stats,
- struct cdp_vdev_stats *src_vdev_stats)
- {
- /* Aggregate vdev ingress stats */
- DP_UPDATE_INGRESS_STATS(tgt_vdev_stats, src_vdev_stats);
- }
- /**
- * dp_aggregate_vdev_stats_for_unmapped_peers() - aggregate unmap peer stats
- * @tgt_vdev_stats: target vdev buffer
- * @src_vdev_stats: source vdev buffer
- *
- * return: void
- */
- static inline
- void dp_aggregate_vdev_stats_for_unmapped_peers(
- struct cdp_vdev_stats *tgt_vdev_stats,
- struct cdp_vdev_stats *src_vdev_stats)
- {
- /* Aggregate unmapped peers stats */
- DP_UPDATE_VDEV_STATS_FOR_UNMAPPED_PEERS(tgt_vdev_stats, src_vdev_stats);
- }
- /**
- * dp_aggregate_all_vdev_stats() - aggregate vdev ingress and unmap peer stats
- * @tgt_vdev_stats: target vdev buffer
- * @src_vdev_stats: source vdev buffer
- *
- * return: void
- */
- static inline
- void dp_aggregate_all_vdev_stats(
- struct cdp_vdev_stats *tgt_vdev_stats,
- struct cdp_vdev_stats *src_vdev_stats)
- {
- dp_aggregate_vdev_ingress_stats(tgt_vdev_stats, src_vdev_stats);
- dp_aggregate_vdev_stats_for_unmapped_peers(tgt_vdev_stats,
- src_vdev_stats);
- }
- /**
- * dp_mlo_vdev_stats_aggr_bridge_vap() - aggregate bridge vdev stats
- * @be_vdev: Dp Vdev handle
- * @bridge_vdev: Dp vdev handle for bridge vdev
- * @arg: buffer for target vdev stats
- *
- * return: void
- */
- static
- void dp_mlo_vdev_stats_aggr_bridge_vap(struct dp_vdev_be *be_vdev,
- struct dp_vdev *bridge_vdev,
- void *arg)
- {
- struct cdp_vdev_stats *tgt_vdev_stats = (struct cdp_vdev_stats *)arg;
- struct dp_vdev_be *bridge_be_vdev = NULL;
- bridge_be_vdev = dp_get_be_vdev_from_dp_vdev(bridge_vdev);
- if (!bridge_be_vdev)
- return;
- dp_aggregate_all_vdev_stats(tgt_vdev_stats, &bridge_vdev->stats);
- dp_aggregate_all_vdev_stats(tgt_vdev_stats, &bridge_be_vdev->mlo_stats);
- dp_vdev_iterate_peer(bridge_vdev, dp_update_vdev_stats, tgt_vdev_stats,
- DP_MOD_ID_GENERIC_STATS);
- }
- /**
- * dp_aggregate_interface_stats_based_on_peer_type() - aggregate stats at
- * VDEV level based on peer type connected to vdev
- * @vdev: DP VDEV handle
- * @vdev_stats: target vdev stats pointer
- * @peer_type: type of peer - MLO Link or Legacy peer
- *
- * return: void
- */
- static
- void dp_aggregate_interface_stats_based_on_peer_type(
- struct dp_vdev *vdev,
- struct cdp_vdev_stats *vdev_stats,
- enum dp_peer_type peer_type)
- {
- struct cdp_vdev_stats *tgt_vdev_stats = NULL;
- struct dp_vdev_be *be_vdev = NULL;
- struct dp_soc_be *be_soc = NULL;
- if (!vdev || !vdev->pdev)
- return;
- tgt_vdev_stats = vdev_stats;
- be_soc = dp_get_be_soc_from_dp_soc(vdev->pdev->soc);
- be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
- if (!be_vdev)
- return;
- if (peer_type == DP_PEER_TYPE_LEGACY) {
- dp_aggregate_all_vdev_stats(tgt_vdev_stats,
- &vdev->stats);
- } else {
- if (be_vdev->mcast_primary) {
- dp_mlo_iter_ptnr_vdev(be_soc, be_vdev,
- dp_mlo_vdev_stats_aggr_bridge_vap,
- (void *)vdev_stats,
- DP_MOD_ID_GENERIC_STATS,
- DP_BRIDGE_VDEV_ITER);
- }
- dp_aggregate_vdev_ingress_stats(tgt_vdev_stats,
- &vdev->stats);
- dp_aggregate_vdev_stats_for_unmapped_peers(
- tgt_vdev_stats,
- &be_vdev->mlo_stats);
- }
- /* Aggregate associated peer stats */
- dp_vdev_iterate_specific_peer_type(vdev,
- dp_update_vdev_stats,
- vdev_stats,
- DP_MOD_ID_GENERIC_STATS,
- peer_type);
- }
- /**
- * dp_aggregate_interface_stats() - aggregate stats at VDEV level
- * @vdev: DP VDEV handle
- * @vdev_stats: target vdev stats pointer
- *
- * return: void
- */
- static
- void dp_aggregate_interface_stats(struct dp_vdev *vdev,
- struct cdp_vdev_stats *vdev_stats)
- {
- struct dp_vdev_be *be_vdev = NULL;
- struct dp_soc_be *be_soc = NULL;
- if (!vdev || !vdev->pdev)
- return;
- be_soc = dp_get_be_soc_from_dp_soc(vdev->pdev->soc);
- be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
- if (!be_vdev)
- return;
- if (be_vdev->mcast_primary) {
- dp_mlo_iter_ptnr_vdev(be_soc, be_vdev,
- dp_mlo_vdev_stats_aggr_bridge_vap,
- (void *)vdev_stats, DP_MOD_ID_GENERIC_STATS,
- DP_BRIDGE_VDEV_ITER);
- }
- dp_aggregate_all_vdev_stats(vdev_stats, &be_vdev->mlo_stats);
- dp_aggregate_all_vdev_stats(vdev_stats, &vdev->stats);
- dp_vdev_iterate_peer(vdev, dp_update_vdev_stats, vdev_stats,
- DP_MOD_ID_GENERIC_STATS);
- dp_update_vdev_rate_stats(vdev_stats, &vdev->stats);
- }
- /**
- * dp_mlo_aggr_ptnr_iface_stats() - aggregate mlo partner vdev stats
- * @be_vdev: vdev handle
- * @ptnr_vdev: partner vdev handle
- * @arg: target buffer for aggregation
- *
- * return: void
- */
- static
- void dp_mlo_aggr_ptnr_iface_stats(struct dp_vdev_be *be_vdev,
- struct dp_vdev *ptnr_vdev,
- void *arg)
- {
- struct cdp_vdev_stats *tgt_vdev_stats = (struct cdp_vdev_stats *)arg;
- dp_aggregate_interface_stats(ptnr_vdev, tgt_vdev_stats);
- }
- /**
- * dp_mlo_aggr_ptnr_iface_stats_mlo_links() - aggregate mlo partner vdev stats
- * based on peer type
- * @be_vdev: vdev handle
- * @ptnr_vdev: partner vdev handle
- * @arg: target buffer for aggregation
- *
- * return: void
- */
- static
- void dp_mlo_aggr_ptnr_iface_stats_mlo_links(
- struct dp_vdev_be *be_vdev,
- struct dp_vdev *ptnr_vdev,
- void *arg)
- {
- struct cdp_vdev_stats *tgt_vdev_stats = (struct cdp_vdev_stats *)arg;
- dp_aggregate_interface_stats_based_on_peer_type(ptnr_vdev,
- tgt_vdev_stats,
- DP_PEER_TYPE_MLO_LINK);
- }
- /**
- * dp_aggregate_sta_interface_stats() - for sta mode aggregate vdev stats from
- * all link peers
- * @soc: soc handle
- * @vdev: vdev handle
- * @buf: target buffer for aggregation
- *
- * return: QDF_STATUS
- */
- static QDF_STATUS
- dp_aggregate_sta_interface_stats(struct dp_soc *soc,
- struct dp_vdev *vdev,
- void *buf)
- {
- struct dp_peer *vap_bss_peer = NULL;
- struct dp_peer *mld_peer = NULL;
- struct dp_peer *link_peer = NULL;
- struct dp_mld_link_peers link_peers_info;
- uint8_t i = 0;
- QDF_STATUS ret = QDF_STATUS_SUCCESS;
- vap_bss_peer = dp_vdev_bss_peer_ref_n_get(soc, vdev,
- DP_MOD_ID_GENERIC_STATS);
- if (!vap_bss_peer)
- return QDF_STATUS_E_FAILURE;
- mld_peer = DP_GET_MLD_PEER_FROM_PEER(vap_bss_peer);
- if (!mld_peer) {
- dp_peer_unref_delete(vap_bss_peer, DP_MOD_ID_GENERIC_STATS);
- return QDF_STATUS_E_FAILURE;
- }
- dp_get_link_peers_ref_from_mld_peer(soc, mld_peer, &link_peers_info,
- DP_MOD_ID_GENERIC_STATS);
- for (i = 0; i < link_peers_info.num_links; i++) {
- link_peer = link_peers_info.link_peers[i];
- dp_update_vdev_stats(soc, link_peer, buf);
- dp_aggregate_vdev_ingress_stats((struct cdp_vdev_stats *)buf,
- &link_peer->vdev->stats);
- dp_aggregate_vdev_basic_stats(
- (struct cdp_vdev_stats *)buf,
- &link_peer->vdev->stats);
- }
- dp_release_link_peers_ref(&link_peers_info, DP_MOD_ID_GENERIC_STATS);
- dp_peer_unref_delete(vap_bss_peer, DP_MOD_ID_GENERIC_STATS);
- return ret;
- }
- static QDF_STATUS dp_mlo_get_mld_vdev_stats(struct cdp_soc_t *soc_hdl,
- uint8_t vdev_id, void *buf,
- bool link_vdev_only)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_vdev *vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
- DP_MOD_ID_GENERIC_STATS);
- struct dp_vdev_be *vdev_be = NULL;
- QDF_STATUS ret = QDF_STATUS_SUCCESS;
- if (!vdev)
- return QDF_STATUS_E_FAILURE;
- vdev_be = dp_get_be_vdev_from_dp_vdev(vdev);
- if (!vdev_be) {
- dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_GENERIC_STATS);
- return QDF_STATUS_E_FAILURE;
- }
- if (vdev->opmode == wlan_op_mode_sta) {
- ret = dp_aggregate_sta_interface_stats(soc, vdev, buf);
- goto complete;
- }
- if (DP_MLD_MODE_HYBRID_NONBOND == soc->mld_mode_ap &&
- vdev->opmode == wlan_op_mode_ap) {
- dp_aggregate_interface_stats_based_on_peer_type(
- vdev, buf,
- DP_PEER_TYPE_MLO_LINK);
- if (link_vdev_only)
- goto complete;
- /* Aggregate stats from partner vdevs */
- dp_mlo_iter_ptnr_vdev(be_soc, vdev_be,
- dp_mlo_aggr_ptnr_iface_stats_mlo_links,
- buf,
- DP_MOD_ID_GENERIC_STATS,
- DP_LINK_VDEV_ITER);
- } else {
- dp_aggregate_interface_stats(vdev, buf);
- if (link_vdev_only)
- goto complete;
- /* Aggregate stats from partner vdevs */
- dp_mlo_iter_ptnr_vdev(be_soc, vdev_be,
- dp_mlo_aggr_ptnr_iface_stats, buf,
- DP_MOD_ID_GENERIC_STATS,
- DP_LINK_VDEV_ITER);
- }
- complete:
- dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_GENERIC_STATS);
- return ret;
- }
- QDF_STATUS
- dp_get_interface_stats_be(struct cdp_soc_t *soc_hdl,
- uint8_t vdev_id,
- void *buf,
- bool is_aggregate)
- {
- struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
- struct dp_vdev *vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
- DP_MOD_ID_GENERIC_STATS);
- if (!vdev)
- return QDF_STATUS_E_FAILURE;
- if (DP_MLD_MODE_HYBRID_NONBOND == soc->mld_mode_ap &&
- vdev->opmode == wlan_op_mode_ap) {
- dp_aggregate_interface_stats_based_on_peer_type(
- vdev, buf,
- DP_PEER_TYPE_LEGACY);
- } else {
- dp_aggregate_interface_stats(vdev, buf);
- }
- dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_GENERIC_STATS);
- return QDF_STATUS_SUCCESS;
- }
- #endif
- static struct cdp_mlo_ops dp_mlo_ops = {
- .mlo_soc_setup = dp_mlo_soc_setup,
- .mlo_soc_teardown = dp_mlo_soc_teardown,
- .update_mlo_ptnr_list = dp_update_mlo_ptnr_list,
- .clear_mlo_ptnr_list = dp_clear_mlo_ptnr_list,
- .mlo_setup_complete = dp_mlo_setup_complete,
- .mlo_update_delta_tsf2 = dp_mlo_update_delta_tsf2,
- .mlo_update_delta_tqm = dp_mlo_update_delta_tqm,
- .mlo_update_mlo_ts_offset = dp_mlo_update_mlo_ts_offset,
- .mlo_ctxt_attach = dp_mlo_ctxt_attach_wifi3,
- .mlo_ctxt_detach = dp_mlo_ctxt_detach_wifi3,
- #ifdef CONFIG_MLO_SINGLE_DEV
- .mlo_get_mld_vdev_stats = dp_mlo_get_mld_vdev_stats,
- #endif
- };
- void dp_soc_mlo_fill_params(struct dp_soc *soc,
- struct cdp_soc_attach_params *params)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- if (!params->mlo_enabled) {
- dp_warn("MLO not enabled on SOC");
- return;
- }
- be_soc->mlo_chip_id = params->mlo_chip_id;
- be_soc->ml_ctxt = cdp_mlo_ctx_to_dp(params->ml_context);
- be_soc->mlo_enabled = 1;
- soc->cdp_soc.ops->mlo_ops = &dp_mlo_ops;
- }
- void dp_mlo_update_link_to_pdev_map(struct dp_soc *soc, struct dp_pdev *pdev)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_pdev_be *be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
- struct dp_mlo_ctxt *ml_ctxt = be_soc->ml_ctxt;
- uint8_t link_id;
- if (!be_soc->mlo_enabled)
- return;
- if (!ml_ctxt)
- return;
- link_id = be_pdev->mlo_link_id;
- if (link_id < WLAN_MAX_MLO_CHIPS * WLAN_MAX_MLO_LINKS_PER_SOC) {
- if (!ml_ctxt->link_to_pdev_map[link_id])
- ml_ctxt->link_to_pdev_map[link_id] = be_pdev;
- else
- dp_alert("Attempt to update existing map for link %u",
- link_id);
- }
- }
- void dp_mlo_update_link_to_pdev_unmap(struct dp_soc *soc, struct dp_pdev *pdev)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_pdev_be *be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
- struct dp_mlo_ctxt *ml_ctxt = be_soc->ml_ctxt;
- uint8_t link_id;
- if (!be_soc->mlo_enabled)
- return;
- if (!ml_ctxt)
- return;
- link_id = be_pdev->mlo_link_id;
- if (link_id < WLAN_MAX_MLO_CHIPS * WLAN_MAX_MLO_LINKS_PER_SOC)
- ml_ctxt->link_to_pdev_map[link_id] = NULL;
- }
- static struct dp_pdev_be *
- dp_mlo_get_be_pdev_from_link_id(struct dp_mlo_ctxt *ml_ctxt, uint8_t link_id)
- {
- if (link_id < WLAN_MAX_MLO_CHIPS * WLAN_MAX_MLO_LINKS_PER_SOC)
- return ml_ctxt->link_to_pdev_map[link_id];
- return NULL;
- }
- void dp_pdev_mlo_fill_params(struct dp_pdev *pdev,
- struct cdp_pdev_attach_params *params)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(pdev->soc);
- struct dp_pdev_be *be_pdev = dp_get_be_pdev_from_dp_pdev(pdev);
- if (!be_soc->mlo_enabled) {
- dp_info("MLO not enabled on SOC");
- return;
- }
- be_pdev->mlo_link_id = params->mlo_link_id;
- }
- void dp_mlo_partner_chips_map(struct dp_soc *soc,
- struct dp_peer *peer,
- uint16_t peer_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = NULL;
- bool is_ml_peer_id =
- HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
- uint8_t chip_id;
- struct dp_soc *temp_soc;
- /* for non ML peer dont map on partner chips*/
- if (!is_ml_peer_id)
- return;
- mlo_ctxt = be_soc->ml_ctxt;
- if (!mlo_ctxt)
- return;
- qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
- for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
- temp_soc = mlo_ctxt->ml_soc_list[chip_id];
- if (!temp_soc)
- continue;
- /* skip if this is current soc */
- if (temp_soc == soc)
- continue;
- dp_peer_find_id_to_obj_add(temp_soc, peer, peer_id);
- }
- qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
- }
- qdf_export_symbol(dp_mlo_partner_chips_map);
- void dp_mlo_partner_chips_unmap(struct dp_soc *soc,
- uint16_t peer_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- bool is_ml_peer_id =
- HTT_RX_PEER_META_DATA_V1_ML_PEER_VALID_GET(peer_id);
- uint8_t chip_id;
- struct dp_soc *temp_soc;
- if (!is_ml_peer_id)
- return;
- if (!mlo_ctxt)
- return;
- qdf_spin_lock_bh(&mlo_ctxt->ml_soc_list_lock);
- for (chip_id = 0; chip_id < DP_MAX_MLO_CHIPS; chip_id++) {
- temp_soc = mlo_ctxt->ml_soc_list[chip_id];
- if (!temp_soc)
- continue;
- /* skip if this is current soc */
- if (temp_soc == soc)
- continue;
- dp_peer_find_id_to_obj_remove(temp_soc, peer_id);
- }
- qdf_spin_unlock_bh(&mlo_ctxt->ml_soc_list_lock);
- }
- qdf_export_symbol(dp_mlo_partner_chips_unmap);
- uint8_t dp_mlo_get_chip_id(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- return be_soc->mlo_chip_id;
- }
- qdf_export_symbol(dp_mlo_get_chip_id);
- struct dp_peer *
- dp_link_peer_hash_find_by_chip_id(struct dp_soc *soc,
- uint8_t *peer_mac_addr,
- int mac_addr_is_aligned,
- uint8_t vdev_id,
- uint8_t chip_id,
- enum dp_mod_id mod_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- struct dp_soc *link_peer_soc = NULL;
- struct dp_peer *peer = NULL;
- if (!mlo_ctxt)
- return NULL;
- link_peer_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
- if (!link_peer_soc)
- return NULL;
- peer = dp_peer_find_hash_find(link_peer_soc, peer_mac_addr,
- mac_addr_is_aligned, vdev_id,
- mod_id);
- qdf_atomic_dec(&link_peer_soc->ref_count);
- return peer;
- }
- qdf_export_symbol(dp_link_peer_hash_find_by_chip_id);
- void dp_mlo_get_rx_hash_key(struct dp_soc *soc,
- struct cdp_lro_hash_config *lro_hash)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *ml_ctxt = be_soc->ml_ctxt;
- if (!be_soc->mlo_enabled || !ml_ctxt)
- return dp_get_rx_hash_key_bytes(lro_hash);
- qdf_mem_copy(lro_hash->toeplitz_hash_ipv4, ml_ctxt->toeplitz_hash_ipv4,
- (sizeof(lro_hash->toeplitz_hash_ipv4[0]) *
- LRO_IPV4_SEED_ARR_SZ));
- qdf_mem_copy(lro_hash->toeplitz_hash_ipv6, ml_ctxt->toeplitz_hash_ipv6,
- (sizeof(lro_hash->toeplitz_hash_ipv6[0]) *
- LRO_IPV6_SEED_ARR_SZ));
- }
- struct dp_soc *
- dp_rx_replenish_soc_get(struct dp_soc *soc, uint8_t chip_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- struct dp_soc *replenish_soc;
- if (!be_soc->mlo_enabled || !mlo_ctxt)
- return soc;
- if (be_soc->mlo_chip_id == chip_id)
- return soc;
- replenish_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
- if (qdf_unlikely(!replenish_soc)) {
- dp_alert("replenish SOC is NULL");
- qdf_assert_always(0);
- }
- return replenish_soc;
- }
- uint8_t dp_soc_get_num_soc_be(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- if (!be_soc->mlo_enabled || !mlo_ctxt)
- return 1;
- return mlo_ctxt->ml_soc_cnt;
- }
- struct dp_soc *
- dp_soc_get_by_idle_bm_id(struct dp_soc *soc, uint8_t idle_bm_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- struct dp_soc *partner_soc = NULL;
- uint8_t chip_id;
- if (!be_soc->mlo_enabled || !mlo_ctxt)
- return soc;
- for (chip_id = 0; chip_id < WLAN_MAX_MLO_CHIPS; chip_id++) {
- partner_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
- if (!partner_soc)
- continue;
- if (partner_soc->idle_link_bm_id == idle_bm_id)
- return partner_soc;
- }
- return NULL;
- }
- #ifdef WLAN_MLO_MULTI_CHIP
- static void dp_print_mlo_partner_list(struct dp_vdev_be *be_vdev,
- struct dp_vdev *partner_vdev,
- void *arg)
- {
- struct dp_vdev_be *partner_vdev_be = NULL;
- struct dp_soc_be *partner_soc_be = NULL;
- partner_vdev_be = dp_get_be_vdev_from_dp_vdev(partner_vdev);
- partner_soc_be = dp_get_be_soc_from_dp_soc(partner_vdev->pdev->soc);
- DP_PRINT_STATS("is_bridge_vap = %s, mcast_primary = %s, vdev_id = %d, pdev_id = %d, chip_id = %d",
- partner_vdev->is_bridge_vdev ? "true" : "false",
- partner_vdev_be->mcast_primary ? "true" : "false",
- partner_vdev->vdev_id,
- partner_vdev->pdev->pdev_id,
- partner_soc_be->mlo_chip_id);
- }
- void dp_mlo_iter_ptnr_vdev(struct dp_soc_be *be_soc,
- struct dp_vdev_be *be_vdev,
- dp_ptnr_vdev_iter_func func,
- void *arg,
- enum dp_mod_id mod_id,
- uint8_t type)
- {
- int i = 0;
- int j = 0;
- struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
- if (type < DP_LINK_VDEV_ITER || type > DP_ALL_VDEV_ITER) {
- dp_err("invalid iterate type");
- return;
- }
- for (i = 0; (i < WLAN_MAX_MLO_CHIPS) &&
- IS_LINK_VDEV_ITER_REQUIRED(type); i++) {
- struct dp_soc *ptnr_soc =
- dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!ptnr_soc)
- continue;
- for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
- struct dp_vdev *ptnr_vdev;
- ptnr_vdev = dp_vdev_get_ref_by_id(
- ptnr_soc,
- be_vdev->partner_vdev_list[i][j],
- mod_id);
- if (!ptnr_vdev)
- continue;
- (*func)(be_vdev, ptnr_vdev, arg);
- dp_vdev_unref_delete(ptnr_vdev->pdev->soc,
- ptnr_vdev,
- mod_id);
- }
- }
- for (i = 0; (i < WLAN_MAX_MLO_CHIPS) &&
- IS_BRIDGE_VDEV_ITER_REQUIRED(type); i++) {
- struct dp_soc *ptnr_soc =
- dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!ptnr_soc)
- continue;
- for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
- struct dp_vdev *bridge_vdev;
- bridge_vdev = dp_vdev_get_ref_by_id(
- ptnr_soc,
- be_vdev->bridge_vdev_list[i][j],
- mod_id);
- if (!bridge_vdev)
- continue;
- (*func)(be_vdev, bridge_vdev, arg);
- dp_vdev_unref_delete(bridge_vdev->pdev->soc,
- bridge_vdev,
- mod_id);
- }
- }
- }
- qdf_export_symbol(dp_mlo_iter_ptnr_vdev);
- void dp_mlo_debug_print_ptnr_info(struct dp_vdev *vdev)
- {
- struct dp_vdev_be *be_vdev = NULL;
- struct dp_soc_be *be_soc = NULL;
- be_soc = dp_get_be_soc_from_dp_soc(vdev->pdev->soc);
- be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
- DP_PRINT_STATS("self vdev is_bridge_vap = %s, mcast_primary = %s, vdev = %d, pdev_id = %d, chip_id = %d",
- vdev->is_bridge_vdev ? "true" : "false",
- be_vdev->mcast_primary ? "true" : "false",
- vdev->vdev_id,
- vdev->pdev->pdev_id,
- dp_mlo_get_chip_id(vdev->pdev->soc));
- dp_mlo_iter_ptnr_vdev(be_soc, be_vdev,
- dp_print_mlo_partner_list,
- NULL, DP_MOD_ID_GENERIC_STATS,
- DP_ALL_VDEV_ITER);
- }
- #endif
- #ifdef WLAN_MCAST_MLO
- struct dp_vdev *dp_mlo_get_mcast_primary_vdev(struct dp_soc_be *be_soc,
- struct dp_vdev_be *be_vdev,
- enum dp_mod_id mod_id)
- {
- int i = 0;
- int j = 0;
- struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
- struct dp_vdev *vdev = (struct dp_vdev *)be_vdev;
- if (be_vdev->mcast_primary) {
- if (dp_vdev_get_ref((struct dp_soc *)be_soc, vdev, mod_id) !=
- QDF_STATUS_SUCCESS)
- return NULL;
- return vdev;
- }
- for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
- struct dp_soc *ptnr_soc =
- dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!ptnr_soc)
- continue;
- for (j = 0 ; j < WLAN_MAX_MLO_LINKS_PER_SOC ; j++) {
- struct dp_vdev *ptnr_vdev = NULL;
- struct dp_vdev_be *be_ptnr_vdev = NULL;
- ptnr_vdev = dp_vdev_get_ref_by_id(
- ptnr_soc,
- be_vdev->partner_vdev_list[i][j],
- mod_id);
- if (!ptnr_vdev)
- continue;
- be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
- if (be_ptnr_vdev->mcast_primary)
- return ptnr_vdev;
- dp_vdev_unref_delete(be_ptnr_vdev->vdev.pdev->soc,
- &be_ptnr_vdev->vdev,
- mod_id);
- }
- }
- return NULL;
- }
- qdf_export_symbol(dp_mlo_get_mcast_primary_vdev);
- #endif
- /**
- * dp_mlo_iter_ptnr_soc() - iterate through mlo soc list and call the callback
- * @be_soc: dp_soc_be pointer
- * @func: Function to be called for each soc
- * @arg: context to be passed to the callback
- *
- * Return: true if mlo is enabled, false if mlo is disabled
- */
- bool dp_mlo_iter_ptnr_soc(struct dp_soc_be *be_soc, dp_ptnr_soc_iter_func func,
- void *arg)
- {
- int i = 0;
- struct dp_mlo_ctxt *dp_mlo = be_soc->ml_ctxt;
- if (!be_soc->mlo_enabled || !be_soc->ml_ctxt)
- return false;
- for (i = 0; i < WLAN_MAX_MLO_CHIPS ; i++) {
- struct dp_soc *ptnr_soc =
- dp_mlo_get_soc_ref_by_chip_id(dp_mlo, i);
- if (!ptnr_soc)
- continue;
- (*func)(ptnr_soc, arg, i);
- }
- return true;
- }
- qdf_export_symbol(dp_mlo_iter_ptnr_soc);
- static inline uint64_t dp_mlo_get_mlo_ts_offset(struct dp_pdev_be *be_pdev)
- {
- struct dp_soc *soc;
- struct dp_pdev *pdev;
- struct dp_soc_be *be_soc;
- uint32_t mlo_offset;
- pdev = &be_pdev->pdev;
- soc = pdev->soc;
- be_soc = dp_get_be_soc_from_dp_soc(soc);
- mlo_offset = be_soc->mlo_tstamp_offset;
- return mlo_offset;
- }
- int32_t dp_mlo_get_delta_tsf2_wrt_mlo_offset(struct dp_soc *soc,
- uint8_t hw_link_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *ml_ctxt = be_soc->ml_ctxt;
- struct dp_pdev_be *be_pdev;
- int32_t delta_tsf2_mlo_offset;
- int32_t mlo_offset, delta_tsf2;
- if (!ml_ctxt)
- return 0;
- be_pdev = dp_mlo_get_be_pdev_from_link_id(ml_ctxt, hw_link_id);
- if (!be_pdev)
- return 0;
- mlo_offset = dp_mlo_get_mlo_ts_offset(be_pdev);
- delta_tsf2 = be_pdev->delta_tsf2;
- delta_tsf2_mlo_offset = mlo_offset - delta_tsf2;
- return delta_tsf2_mlo_offset;
- }
- int32_t dp_mlo_get_delta_tqm_wrt_mlo_offset(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- int32_t delta_tqm_mlo_offset;
- int32_t mlo_offset, delta_tqm;
- mlo_offset = be_soc->mlo_tstamp_offset;
- delta_tqm = be_soc->delta_tqm;
- delta_tqm_mlo_offset = mlo_offset - delta_tqm;
- return delta_tqm_mlo_offset;
- }
- #ifdef DP_UMAC_HW_RESET_SUPPORT
- /**
- * dp_umac_reset_update_partner_map() - Update Umac reset partner map
- * @mlo_ctx: DP ML context handle
- * @chip_id: chip id
- * @set: flag indicating whether to set or clear the bit
- *
- * Return: void
- */
- static void dp_umac_reset_update_partner_map(struct dp_mlo_ctxt *mlo_ctx,
- int chip_id, bool set)
- {
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx =
- &mlo_ctx->grp_umac_reset_ctx;
- if (set)
- qdf_atomic_set_bit(chip_id, &grp_umac_reset_ctx->partner_map);
- else
- qdf_atomic_clear_bit(chip_id, &grp_umac_reset_ctx->partner_map);
- }
- QDF_STATUS dp_umac_reset_notify_asserted_soc(struct dp_soc *soc)
- {
- struct dp_mlo_ctxt *mlo_ctx;
- struct dp_soc_be *be_soc;
- be_soc = dp_get_be_soc_from_dp_soc(soc);
- if (!be_soc) {
- dp_umac_reset_err("null be_soc");
- return QDF_STATUS_E_NULL_VALUE;
- }
- mlo_ctx = be_soc->ml_ctxt;
- if (!mlo_ctx) {
- /* This API can be called for non-MLO SOC as well. Hence, return
- * the status as success when mlo_ctx is NULL.
- */
- return QDF_STATUS_SUCCESS;
- }
- dp_umac_reset_update_partner_map(mlo_ctx, be_soc->mlo_chip_id, false);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * dp_umac_reset_complete_umac_recovery() - Complete Umac reset session
- * @soc: dp soc handle
- *
- * Return: void
- */
- void dp_umac_reset_complete_umac_recovery(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- if (!mlo_ctx) {
- dp_umac_reset_alert("Umac reset was handled on soc %pK", soc);
- return;
- }
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- qdf_spin_lock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- grp_umac_reset_ctx->umac_reset_in_progress = false;
- grp_umac_reset_ctx->is_target_recovery = false;
- grp_umac_reset_ctx->response_map = 0;
- grp_umac_reset_ctx->request_map = 0;
- grp_umac_reset_ctx->initiator_chip_id = 0;
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- dp_umac_reset_alert("Umac reset was handled on mlo group ctxt %pK",
- mlo_ctx);
- }
- /**
- * dp_umac_reset_initiate_umac_recovery() - Initiate Umac reset session
- * @soc: dp soc handle
- * @umac_reset_ctx: Umac reset context
- * @rx_event: Rx event received
- * @is_target_recovery: Flag to indicate if it is triggered for target recovery
- *
- * Return: status
- */
- QDF_STATUS dp_umac_reset_initiate_umac_recovery(struct dp_soc *soc,
- struct dp_soc_umac_reset_ctx *umac_reset_ctx,
- enum umac_reset_rx_event rx_event,
- bool is_target_recovery)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- QDF_STATUS status = QDF_STATUS_SUCCESS;
- if (!mlo_ctx)
- return dp_umac_reset_validate_n_update_state_machine_on_rx(
- umac_reset_ctx, rx_event,
- UMAC_RESET_STATE_WAIT_FOR_TRIGGER,
- UMAC_RESET_STATE_DO_TRIGGER_RECEIVED);
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- qdf_spin_lock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- if (grp_umac_reset_ctx->umac_reset_in_progress) {
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- return QDF_STATUS_E_INVAL;
- }
- status = dp_umac_reset_validate_n_update_state_machine_on_rx(
- umac_reset_ctx, rx_event,
- UMAC_RESET_STATE_WAIT_FOR_TRIGGER,
- UMAC_RESET_STATE_DO_TRIGGER_RECEIVED);
- if (status != QDF_STATUS_SUCCESS) {
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- return status;
- }
- grp_umac_reset_ctx->umac_reset_in_progress = true;
- grp_umac_reset_ctx->is_target_recovery = is_target_recovery;
- /* We don't wait for the 'Umac trigger' message from all socs */
- grp_umac_reset_ctx->request_map = grp_umac_reset_ctx->partner_map;
- grp_umac_reset_ctx->response_map = grp_umac_reset_ctx->partner_map;
- grp_umac_reset_ctx->initiator_chip_id = dp_mlo_get_chip_id(soc);
- grp_umac_reset_ctx->umac_reset_count++;
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * dp_umac_reset_handle_action_cb() - Function to call action callback
- * @soc: dp soc handle
- * @umac_reset_ctx: Umac reset context
- * @action: Action to call the callback for
- *
- * Return: QDF_STATUS status
- */
- QDF_STATUS
- dp_umac_reset_handle_action_cb(struct dp_soc *soc,
- struct dp_soc_umac_reset_ctx *umac_reset_ctx,
- enum umac_reset_action action)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- if (!mlo_ctx) {
- dp_umac_reset_debug("MLO context is Null");
- goto handle;
- }
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- qdf_spin_lock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- qdf_atomic_set_bit(dp_mlo_get_chip_id(soc),
- &grp_umac_reset_ctx->request_map);
- dp_umac_reset_debug("partner_map %u request_map %u",
- grp_umac_reset_ctx->partner_map,
- grp_umac_reset_ctx->request_map);
- /* This logic is needed for synchronization between mlo socs */
- if ((grp_umac_reset_ctx->partner_map & grp_umac_reset_ctx->request_map)
- != grp_umac_reset_ctx->partner_map) {
- struct hif_softc *hif_sc = HIF_GET_SOFTC(soc->hif_handle);
- struct hif_umac_reset_ctx *hif_umac_reset_ctx;
- if (!hif_sc) {
- hif_err("scn is null");
- qdf_assert_always(0);
- return QDF_STATUS_E_FAILURE;
- }
- hif_umac_reset_ctx = &hif_sc->umac_reset_ctx;
- /* Mark the action as pending */
- umac_reset_ctx->pending_action = action;
- /* Reschedule the tasklet and exit */
- tasklet_hi_schedule(&hif_umac_reset_ctx->intr_tq);
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- return QDF_STATUS_SUCCESS;
- }
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- umac_reset_ctx->pending_action = UMAC_RESET_ACTION_NONE;
- handle:
- if (!umac_reset_ctx->rx_actions.cb[action]) {
- dp_umac_reset_err("rx callback is NULL");
- return QDF_STATUS_E_FAILURE;
- }
- return umac_reset_ctx->rx_actions.cb[action](soc);
- }
- /**
- * dp_umac_reset_post_tx_cmd() - Iterate partner socs and post Tx command
- * @umac_reset_ctx: UMAC reset context
- * @tx_cmd: Tx command to be posted
- *
- * Return: QDF status of operation
- */
- QDF_STATUS
- dp_umac_reset_post_tx_cmd(struct dp_soc_umac_reset_ctx *umac_reset_ctx,
- enum umac_reset_tx_cmd tx_cmd)
- {
- struct dp_soc *soc = container_of(umac_reset_ctx, struct dp_soc,
- umac_reset_ctx);
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- if (!mlo_ctx) {
- dp_umac_reset_post_tx_cmd_via_shmem(soc, &tx_cmd, 0);
- return QDF_STATUS_SUCCESS;
- }
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- qdf_spin_lock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- qdf_atomic_set_bit(dp_mlo_get_chip_id(soc),
- &grp_umac_reset_ctx->response_map);
- /* This logic is needed for synchronization between mlo socs */
- if ((grp_umac_reset_ctx->partner_map & grp_umac_reset_ctx->response_map)
- != grp_umac_reset_ctx->partner_map) {
- dp_umac_reset_debug(
- "Response(s) pending : expected map %u current map %u",
- grp_umac_reset_ctx->partner_map,
- grp_umac_reset_ctx->response_map);
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- return QDF_STATUS_SUCCESS;
- }
- dp_umac_reset_debug(
- "All responses received: expected map %u current map %u",
- grp_umac_reset_ctx->partner_map,
- grp_umac_reset_ctx->response_map);
- grp_umac_reset_ctx->response_map = 0;
- grp_umac_reset_ctx->request_map = 0;
- qdf_spin_unlock_bh(&grp_umac_reset_ctx->grp_ctx_lock);
- dp_mlo_iter_ptnr_soc(be_soc, &dp_umac_reset_post_tx_cmd_via_shmem,
- &tx_cmd);
- if (tx_cmd == UMAC_RESET_TX_CMD_POST_RESET_COMPLETE_DONE)
- dp_umac_reset_complete_umac_recovery(soc);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * dp_umac_reset_initiator_check() - Check if soc is the Umac reset initiator
- * @soc: dp soc handle
- *
- * Return: true if the soc is initiator or false otherwise
- */
- bool dp_umac_reset_initiator_check(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- if (!mlo_ctx)
- return true;
- return (mlo_ctx->grp_umac_reset_ctx.initiator_chip_id ==
- dp_mlo_get_chip_id(soc));
- }
- /**
- * dp_umac_reset_target_recovery_check() - Check if this is for target recovery
- * @soc: dp soc handle
- *
- * Return: true if the session is for target recovery or false otherwise
- */
- bool dp_umac_reset_target_recovery_check(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- if (!mlo_ctx)
- return false;
- return mlo_ctx->grp_umac_reset_ctx.is_target_recovery;
- }
- /**
- * dp_umac_reset_is_soc_ignored() - Check if this soc is to be ignored
- * @soc: dp soc handle
- *
- * Return: true if the soc is ignored or false otherwise
- */
- bool dp_umac_reset_is_soc_ignored(struct dp_soc *soc)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctx = be_soc->ml_ctxt;
- if (!mlo_ctx)
- return false;
- return !qdf_atomic_test_bit(dp_mlo_get_chip_id(soc),
- &mlo_ctx->grp_umac_reset_ctx.partner_map);
- }
- QDF_STATUS dp_mlo_umac_reset_stats_print(struct dp_soc *soc)
- {
- struct dp_mlo_ctxt *mlo_ctx;
- struct dp_soc_be *be_soc;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- be_soc = dp_get_be_soc_from_dp_soc(soc);
- if (!be_soc) {
- dp_umac_reset_err("null be_soc");
- return QDF_STATUS_E_NULL_VALUE;
- }
- mlo_ctx = be_soc->ml_ctxt;
- if (!mlo_ctx) {
- /* This API can be called for non-MLO SOC as well. Hence, return
- * the status as success when mlo_ctx is NULL.
- */
- return QDF_STATUS_SUCCESS;
- }
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- DP_UMAC_RESET_PRINT_STATS("MLO UMAC RESET stats\n"
- "\t\tPartner map :%x\n"
- "\t\tRequest map :%x\n"
- "\t\tResponse map :%x\n"
- "\t\tIs target recovery :%d\n"
- "\t\tIs Umac reset inprogress :%d\n"
- "\t\tNumber of UMAC reset triggered:%d\n"
- "\t\tInitiator chip ID :%d\n",
- grp_umac_reset_ctx->partner_map,
- grp_umac_reset_ctx->request_map,
- grp_umac_reset_ctx->response_map,
- grp_umac_reset_ctx->is_target_recovery,
- grp_umac_reset_ctx->umac_reset_in_progress,
- grp_umac_reset_ctx->umac_reset_count,
- grp_umac_reset_ctx->initiator_chip_id);
- return QDF_STATUS_SUCCESS;
- }
- enum cdp_umac_reset_state
- dp_get_umac_reset_in_progress_state(struct cdp_soc_t *psoc)
- {
- struct dp_soc_umac_reset_ctx *umac_reset_ctx;
- struct dp_soc *soc = (struct dp_soc *)psoc;
- struct dp_soc_mlo_umac_reset_ctx *grp_umac_reset_ctx;
- struct dp_soc_be *be_soc = NULL;
- struct dp_mlo_ctxt *mlo_ctx = NULL;
- enum cdp_umac_reset_state umac_reset_is_inprogress;
- if (!soc) {
- dp_umac_reset_err("DP SOC is null");
- return CDP_UMAC_RESET_INVALID_STATE;
- }
- umac_reset_ctx = &soc->umac_reset_ctx;
- be_soc = dp_get_be_soc_from_dp_soc(soc);
- if (be_soc)
- mlo_ctx = be_soc->ml_ctxt;
- if (mlo_ctx) {
- grp_umac_reset_ctx = &mlo_ctx->grp_umac_reset_ctx;
- umac_reset_is_inprogress =
- grp_umac_reset_ctx->umac_reset_in_progress;
- } else {
- umac_reset_is_inprogress = (umac_reset_ctx->current_state !=
- UMAC_RESET_STATE_WAIT_FOR_TRIGGER);
- }
- if (umac_reset_is_inprogress)
- return CDP_UMAC_RESET_IN_PROGRESS;
- /* Check if the umac reset was in progress during the buffer
- * window.
- */
- umac_reset_is_inprogress =
- ((qdf_get_log_timestamp_usecs() -
- umac_reset_ctx->ts.post_reset_complete_done) <=
- (wlan_cfg_get_umac_reset_buffer_window_ms(soc->wlan_cfg_ctx) *
- 1000));
- return (umac_reset_is_inprogress ?
- CDP_UMAC_RESET_IN_PROGRESS_DURING_BUFFER_WINDOW :
- CDP_UMAC_RESET_NOT_IN_PROGRESS);
- }
- #endif
- struct dp_soc *
- dp_get_soc_by_chip_id_be(struct dp_soc *soc, uint8_t chip_id)
- {
- struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
- struct dp_mlo_ctxt *mlo_ctxt = be_soc->ml_ctxt;
- struct dp_soc *partner_soc;
- if (!be_soc->mlo_enabled || !mlo_ctxt)
- return soc;
- if (be_soc->mlo_chip_id == chip_id)
- return soc;
- partner_soc = dp_mlo_get_soc_ref_by_chip_id(mlo_ctxt, chip_id);
- return partner_soc;
- }
|