| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454 |
- // SPDX-License-Identifier: BSD-3-Clause-Clear
- /*
- * Copyright (c) 2018-2019 The Linux Foundation. All rights reserved.
- * Copyright (c) Qualcomm Technologies, Inc. and/or its subsidiaries.
- */
- #include <linux/dma-mapping.h>
- #include <linux/export.h>
- #include "hal_tx.h"
- #include "debug.h"
- #include "hal_desc.h"
- #include "hif.h"
- static const struct hal_srng_config hw_srng_config_template[] = {
- /* TODO: max_rings can populated by querying HW capabilities */
- { /* REO_DST */
- .start_ring_id = HAL_SRNG_RING_ID_REO2SW1,
- .max_rings = 4,
- .entry_size = sizeof(struct hal_reo_dest_ring) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_REO_REO2SW1_RING_BASE_MSB_RING_SIZE,
- },
- { /* REO_EXCEPTION */
- /* Designating REO2TCL ring as exception ring. This ring is
- * similar to other REO2SW rings though it is named as REO2TCL.
- * Any of theREO2SW rings can be used as exception ring.
- */
- .start_ring_id = HAL_SRNG_RING_ID_REO2TCL,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_reo_dest_ring) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_REO_REO2TCL_RING_BASE_MSB_RING_SIZE,
- },
- { /* REO_REINJECT */
- .start_ring_id = HAL_SRNG_RING_ID_SW2REO,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_reo_entrance_ring) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_REO_SW2REO_RING_BASE_MSB_RING_SIZE,
- },
- { /* REO_CMD */
- .start_ring_id = HAL_SRNG_RING_ID_REO_CMD,
- .max_rings = 1,
- .entry_size = (sizeof(struct hal_tlv_hdr) +
- sizeof(struct hal_reo_get_queue_stats)) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_REO_CMD_RING_BASE_MSB_RING_SIZE,
- },
- { /* REO_STATUS */
- .start_ring_id = HAL_SRNG_RING_ID_REO_STATUS,
- .max_rings = 1,
- .entry_size = (sizeof(struct hal_tlv_hdr) +
- sizeof(struct hal_reo_get_queue_stats_status)) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_REO_STATUS_RING_BASE_MSB_RING_SIZE,
- },
- { /* TCL_DATA */
- .start_ring_id = HAL_SRNG_RING_ID_SW2TCL1,
- .max_rings = 3,
- .entry_size = (sizeof(struct hal_tlv_hdr) +
- sizeof(struct hal_tcl_data_cmd)) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_SW2TCL1_RING_BASE_MSB_RING_SIZE,
- },
- { /* TCL_CMD */
- .start_ring_id = HAL_SRNG_RING_ID_SW2TCL_CMD,
- .max_rings = 1,
- .entry_size = (sizeof(struct hal_tlv_hdr) +
- sizeof(struct hal_tcl_gse_cmd)) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_SW2TCL1_CMD_RING_BASE_MSB_RING_SIZE,
- },
- { /* TCL_STATUS */
- .start_ring_id = HAL_SRNG_RING_ID_TCL_STATUS,
- .max_rings = 1,
- .entry_size = (sizeof(struct hal_tlv_hdr) +
- sizeof(struct hal_tcl_status_ring)) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_TCL_STATUS_RING_BASE_MSB_RING_SIZE,
- },
- { /* CE_SRC */
- .start_ring_id = HAL_SRNG_RING_ID_CE0_SRC,
- .max_rings = 12,
- .entry_size = sizeof(struct hal_ce_srng_src_desc) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_CE_SRC_RING_BASE_MSB_RING_SIZE,
- },
- { /* CE_DST */
- .start_ring_id = HAL_SRNG_RING_ID_CE0_DST,
- .max_rings = 12,
- .entry_size = sizeof(struct hal_ce_srng_dest_desc) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_CE_DST_RING_BASE_MSB_RING_SIZE,
- },
- { /* CE_DST_STATUS */
- .start_ring_id = HAL_SRNG_RING_ID_CE0_DST_STATUS,
- .max_rings = 12,
- .entry_size = sizeof(struct hal_ce_srng_dst_status_desc) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_CE_DST_STATUS_RING_BASE_MSB_RING_SIZE,
- },
- { /* WBM_IDLE_LINK */
- .start_ring_id = HAL_SRNG_RING_ID_WBM_IDLE_LINK,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_wbm_link_desc) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_WBM_IDLE_LINK_RING_BASE_MSB_RING_SIZE,
- },
- { /* SW2WBM_RELEASE */
- .start_ring_id = HAL_SRNG_RING_ID_WBM_SW_RELEASE,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_wbm_release_ring) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_SW2WBM_RELEASE_RING_BASE_MSB_RING_SIZE,
- },
- { /* WBM2SW_RELEASE */
- .start_ring_id = HAL_SRNG_RING_ID_WBM2SW0_RELEASE,
- .max_rings = 5,
- .entry_size = sizeof(struct hal_wbm_release_ring) >> 2,
- .lmac_ring = false,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_WBM2SW_RELEASE_RING_BASE_MSB_RING_SIZE,
- },
- { /* RXDMA_BUF */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_SW2RXDMA0_BUF,
- .max_rings = 2,
- .entry_size = sizeof(struct hal_wbm_buffer_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA_DST */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_RXDMA2SW0,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_reo_entrance_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA_MONITOR_BUF */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_SW2RXDMA2_BUF,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_wbm_buffer_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA_MONITOR_STATUS */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_SW2RXDMA1_STATBUF,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_wbm_buffer_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA_MONITOR_DST */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_RXDMA2SW1,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_reo_entrance_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_DST,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA_MONITOR_DESC */
- .start_ring_id = HAL_SRNG_RING_ID_WMAC1_SW2RXDMA1_DESC,
- .max_rings = 1,
- .entry_size = sizeof(struct hal_wbm_buffer_ring) >> 2,
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- { /* RXDMA DIR BUF */
- .start_ring_id = HAL_SRNG_RING_ID_RXDMA_DIR_BUF,
- .max_rings = 2,
- .entry_size = 8 >> 2, /* TODO: Define the struct */
- .lmac_ring = true,
- .ring_dir = HAL_SRNG_DIR_SRC,
- .max_size = HAL_RXDMA_RING_MAX_SIZE,
- },
- };
- static int ath11k_hal_alloc_cont_rdp(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- size_t size;
- size = sizeof(u32) * HAL_SRNG_RING_ID_MAX;
- hal->rdp.vaddr = dma_alloc_coherent(ab->dev, size, &hal->rdp.paddr,
- GFP_KERNEL);
- if (!hal->rdp.vaddr)
- return -ENOMEM;
- return 0;
- }
- static void ath11k_hal_free_cont_rdp(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- size_t size;
- if (!hal->rdp.vaddr)
- return;
- size = sizeof(u32) * HAL_SRNG_RING_ID_MAX;
- dma_free_coherent(ab->dev, size,
- hal->rdp.vaddr, hal->rdp.paddr);
- hal->rdp.vaddr = NULL;
- }
- static int ath11k_hal_alloc_cont_wrp(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- size_t size;
- size = sizeof(u32) * HAL_SRNG_NUM_LMAC_RINGS;
- hal->wrp.vaddr = dma_alloc_coherent(ab->dev, size, &hal->wrp.paddr,
- GFP_KERNEL);
- if (!hal->wrp.vaddr)
- return -ENOMEM;
- return 0;
- }
- static void ath11k_hal_free_cont_wrp(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- size_t size;
- if (!hal->wrp.vaddr)
- return;
- size = sizeof(u32) * HAL_SRNG_NUM_LMAC_RINGS;
- dma_free_coherent(ab->dev, size,
- hal->wrp.vaddr, hal->wrp.paddr);
- hal->wrp.vaddr = NULL;
- }
- static void ath11k_hal_ce_dst_setup(struct ath11k_base *ab,
- struct hal_srng *srng, int ring_num)
- {
- struct hal_srng_config *srng_config = &ab->hal.srng_config[HAL_CE_DST];
- u32 addr;
- u32 val;
- addr = HAL_CE_DST_RING_CTRL +
- srng_config->reg_start[HAL_SRNG_REG_GRP_R0] +
- ring_num * srng_config->reg_size[HAL_SRNG_REG_GRP_R0];
- val = ath11k_hif_read32(ab, addr);
- val &= ~HAL_CE_DST_R0_DEST_CTRL_MAX_LEN;
- val |= FIELD_PREP(HAL_CE_DST_R0_DEST_CTRL_MAX_LEN,
- srng->u.dst_ring.max_buffer_length);
- ath11k_hif_write32(ab, addr, val);
- }
- static void ath11k_hal_srng_dst_hw_init(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- struct ath11k_hal *hal = &ab->hal;
- u32 val;
- u64 hp_addr;
- u32 reg_base;
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R0];
- if (srng->flags & HAL_SRNG_FLAGS_MSI_INTR) {
- ath11k_hif_write32(ab, reg_base +
- HAL_REO1_RING_MSI1_BASE_LSB_OFFSET(ab),
- srng->msi_addr);
- val = FIELD_PREP(HAL_REO1_RING_MSI1_BASE_MSB_ADDR,
- ((u64)srng->msi_addr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- HAL_REO1_RING_MSI1_BASE_MSB_MSI1_ENABLE;
- ath11k_hif_write32(ab, reg_base +
- HAL_REO1_RING_MSI1_BASE_MSB_OFFSET(ab), val);
- ath11k_hif_write32(ab,
- reg_base + HAL_REO1_RING_MSI1_DATA_OFFSET(ab),
- srng->msi_data);
- }
- ath11k_hif_write32(ab, reg_base, srng->ring_base_paddr);
- val = FIELD_PREP(HAL_REO1_RING_BASE_MSB_RING_BASE_ADDR_MSB,
- ((u64)srng->ring_base_paddr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_REO1_RING_BASE_MSB_RING_SIZE,
- (srng->entry_size * srng->num_entries));
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_BASE_MSB_OFFSET(ab), val);
- val = FIELD_PREP(HAL_REO1_RING_ID_RING_ID, srng->ring_id) |
- FIELD_PREP(HAL_REO1_RING_ID_ENTRY_SIZE, srng->entry_size);
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_ID_OFFSET(ab), val);
- /* interrupt setup */
- val = FIELD_PREP(HAL_REO1_RING_PRDR_INT_SETUP_INTR_TMR_THOLD,
- (srng->intr_timer_thres_us >> 3));
- val |= FIELD_PREP(HAL_REO1_RING_PRDR_INT_SETUP_BATCH_COUNTER_THOLD,
- (srng->intr_batch_cntr_thres_entries *
- srng->entry_size));
- ath11k_hif_write32(ab,
- reg_base + HAL_REO1_RING_PRODUCER_INT_SETUP_OFFSET(ab),
- val);
- hp_addr = hal->rdp.paddr +
- ((unsigned long)srng->u.dst_ring.hp_addr -
- (unsigned long)hal->rdp.vaddr);
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_HP_ADDR_LSB_OFFSET(ab),
- hp_addr & HAL_ADDR_LSB_REG_MASK);
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_HP_ADDR_MSB_OFFSET(ab),
- hp_addr >> HAL_ADDR_MSB_REG_SHIFT);
- /* Initialize head and tail pointers to indicate ring is empty */
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R2];
- ath11k_hif_write32(ab, reg_base, 0);
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_TP_OFFSET(ab), 0);
- *srng->u.dst_ring.hp_addr = 0;
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R0];
- val = 0;
- if (srng->flags & HAL_SRNG_FLAGS_DATA_TLV_SWAP)
- val |= HAL_REO1_RING_MISC_DATA_TLV_SWAP;
- if (srng->flags & HAL_SRNG_FLAGS_RING_PTR_SWAP)
- val |= HAL_REO1_RING_MISC_HOST_FW_SWAP;
- if (srng->flags & HAL_SRNG_FLAGS_MSI_SWAP)
- val |= HAL_REO1_RING_MISC_MSI_SWAP;
- val |= HAL_REO1_RING_MISC_SRNG_ENABLE;
- ath11k_hif_write32(ab, reg_base + HAL_REO1_RING_MISC_OFFSET(ab), val);
- }
- static void ath11k_hal_srng_src_hw_init(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- struct ath11k_hal *hal = &ab->hal;
- u32 val;
- u64 tp_addr;
- u32 reg_base;
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R0];
- if (srng->flags & HAL_SRNG_FLAGS_MSI_INTR) {
- ath11k_hif_write32(ab, reg_base +
- HAL_TCL1_RING_MSI1_BASE_LSB_OFFSET(ab),
- srng->msi_addr);
- val = FIELD_PREP(HAL_TCL1_RING_MSI1_BASE_MSB_ADDR,
- ((u64)srng->msi_addr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- HAL_TCL1_RING_MSI1_BASE_MSB_MSI1_ENABLE;
- ath11k_hif_write32(ab, reg_base +
- HAL_TCL1_RING_MSI1_BASE_MSB_OFFSET(ab),
- val);
- ath11k_hif_write32(ab, reg_base +
- HAL_TCL1_RING_MSI1_DATA_OFFSET(ab),
- srng->msi_data);
- }
- ath11k_hif_write32(ab, reg_base, srng->ring_base_paddr);
- val = FIELD_PREP(HAL_TCL1_RING_BASE_MSB_RING_BASE_ADDR_MSB,
- ((u64)srng->ring_base_paddr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_TCL1_RING_BASE_MSB_RING_SIZE,
- (srng->entry_size * srng->num_entries));
- ath11k_hif_write32(ab, reg_base + HAL_TCL1_RING_BASE_MSB_OFFSET(ab), val);
- val = FIELD_PREP(HAL_REO1_RING_ID_ENTRY_SIZE, srng->entry_size);
- ath11k_hif_write32(ab, reg_base + HAL_TCL1_RING_ID_OFFSET(ab), val);
- if (srng->ring_id == HAL_SRNG_RING_ID_WBM_IDLE_LINK) {
- ath11k_hif_write32(ab, reg_base, (u32)srng->ring_base_paddr);
- val = FIELD_PREP(HAL_TCL1_RING_BASE_MSB_RING_BASE_ADDR_MSB,
- ((u64)srng->ring_base_paddr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_TCL1_RING_BASE_MSB_RING_SIZE,
- (srng->entry_size * srng->num_entries));
- ath11k_hif_write32(ab, reg_base + HAL_TCL1_RING_BASE_MSB_OFFSET(ab), val);
- }
- /* interrupt setup */
- /* NOTE: IPQ8074 v2 requires the interrupt timer threshold in the
- * unit of 8 usecs instead of 1 usec (as required by v1).
- */
- val = FIELD_PREP(HAL_TCL1_RING_CONSR_INT_SETUP_IX0_INTR_TMR_THOLD,
- srng->intr_timer_thres_us);
- val |= FIELD_PREP(HAL_TCL1_RING_CONSR_INT_SETUP_IX0_BATCH_COUNTER_THOLD,
- (srng->intr_batch_cntr_thres_entries *
- srng->entry_size));
- ath11k_hif_write32(ab,
- reg_base + HAL_TCL1_RING_CONSR_INT_SETUP_IX0_OFFSET(ab),
- val);
- val = 0;
- if (srng->flags & HAL_SRNG_FLAGS_LOW_THRESH_INTR_EN) {
- val |= FIELD_PREP(HAL_TCL1_RING_CONSR_INT_SETUP_IX1_LOW_THOLD,
- srng->u.src_ring.low_threshold);
- }
- ath11k_hif_write32(ab,
- reg_base + HAL_TCL1_RING_CONSR_INT_SETUP_IX1_OFFSET(ab),
- val);
- if (srng->ring_id != HAL_SRNG_RING_ID_WBM_IDLE_LINK) {
- tp_addr = hal->rdp.paddr +
- ((unsigned long)srng->u.src_ring.tp_addr -
- (unsigned long)hal->rdp.vaddr);
- ath11k_hif_write32(ab,
- reg_base + HAL_TCL1_RING_TP_ADDR_LSB_OFFSET(ab),
- tp_addr & HAL_ADDR_LSB_REG_MASK);
- ath11k_hif_write32(ab,
- reg_base + HAL_TCL1_RING_TP_ADDR_MSB_OFFSET(ab),
- tp_addr >> HAL_ADDR_MSB_REG_SHIFT);
- }
- /* Initialize head and tail pointers to indicate ring is empty */
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R2];
- ath11k_hif_write32(ab, reg_base, 0);
- ath11k_hif_write32(ab, reg_base + HAL_TCL1_RING_TP_OFFSET, 0);
- *srng->u.src_ring.tp_addr = 0;
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R0];
- val = 0;
- if (srng->flags & HAL_SRNG_FLAGS_DATA_TLV_SWAP)
- val |= HAL_TCL1_RING_MISC_DATA_TLV_SWAP;
- if (srng->flags & HAL_SRNG_FLAGS_RING_PTR_SWAP)
- val |= HAL_TCL1_RING_MISC_HOST_FW_SWAP;
- if (srng->flags & HAL_SRNG_FLAGS_MSI_SWAP)
- val |= HAL_TCL1_RING_MISC_MSI_SWAP;
- /* Loop count is not used for SRC rings */
- val |= HAL_TCL1_RING_MISC_MSI_LOOPCNT_DISABLE;
- val |= HAL_TCL1_RING_MISC_SRNG_ENABLE;
- ath11k_hif_write32(ab, reg_base + HAL_TCL1_RING_MISC_OFFSET(ab), val);
- }
- static void ath11k_hal_srng_hw_init(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- if (srng->ring_dir == HAL_SRNG_DIR_SRC)
- ath11k_hal_srng_src_hw_init(ab, srng);
- else
- ath11k_hal_srng_dst_hw_init(ab, srng);
- }
- static int ath11k_hal_srng_get_ring_id(struct ath11k_base *ab,
- enum hal_ring_type type,
- int ring_num, int mac_id)
- {
- struct hal_srng_config *srng_config = &ab->hal.srng_config[type];
- int ring_id;
- if (ring_num >= srng_config->max_rings) {
- ath11k_warn(ab, "invalid ring number :%d\n", ring_num);
- return -EINVAL;
- }
- ring_id = srng_config->start_ring_id + ring_num;
- if (srng_config->lmac_ring)
- ring_id += mac_id * HAL_SRNG_RINGS_PER_LMAC;
- if (WARN_ON(ring_id >= HAL_SRNG_RING_ID_MAX))
- return -EINVAL;
- return ring_id;
- }
- int ath11k_hal_srng_get_entrysize(struct ath11k_base *ab, u32 ring_type)
- {
- struct hal_srng_config *srng_config;
- if (WARN_ON(ring_type >= HAL_MAX_RING_TYPES))
- return -EINVAL;
- srng_config = &ab->hal.srng_config[ring_type];
- return (srng_config->entry_size << 2);
- }
- int ath11k_hal_srng_get_max_entries(struct ath11k_base *ab, u32 ring_type)
- {
- struct hal_srng_config *srng_config;
- if (WARN_ON(ring_type >= HAL_MAX_RING_TYPES))
- return -EINVAL;
- srng_config = &ab->hal.srng_config[ring_type];
- return (srng_config->max_size / srng_config->entry_size);
- }
- void ath11k_hal_srng_get_params(struct ath11k_base *ab, struct hal_srng *srng,
- struct hal_srng_params *params)
- {
- params->ring_base_paddr = srng->ring_base_paddr;
- params->ring_base_vaddr = srng->ring_base_vaddr;
- params->num_entries = srng->num_entries;
- params->intr_timer_thres_us = srng->intr_timer_thres_us;
- params->intr_batch_cntr_thres_entries =
- srng->intr_batch_cntr_thres_entries;
- params->low_threshold = srng->u.src_ring.low_threshold;
- params->msi_addr = srng->msi_addr;
- params->msi_data = srng->msi_data;
- params->flags = srng->flags;
- }
- dma_addr_t ath11k_hal_srng_get_hp_addr(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- if (!(srng->flags & HAL_SRNG_FLAGS_LMAC_RING))
- return 0;
- if (srng->ring_dir == HAL_SRNG_DIR_SRC)
- return ab->hal.wrp.paddr +
- ((unsigned long)srng->u.src_ring.hp_addr -
- (unsigned long)ab->hal.wrp.vaddr);
- else
- return ab->hal.rdp.paddr +
- ((unsigned long)srng->u.dst_ring.hp_addr -
- (unsigned long)ab->hal.rdp.vaddr);
- }
- dma_addr_t ath11k_hal_srng_get_tp_addr(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- if (!(srng->flags & HAL_SRNG_FLAGS_LMAC_RING))
- return 0;
- if (srng->ring_dir == HAL_SRNG_DIR_SRC)
- return ab->hal.rdp.paddr +
- ((unsigned long)srng->u.src_ring.tp_addr -
- (unsigned long)ab->hal.rdp.vaddr);
- else
- return ab->hal.wrp.paddr +
- ((unsigned long)srng->u.dst_ring.tp_addr -
- (unsigned long)ab->hal.wrp.vaddr);
- }
- u32 ath11k_hal_ce_get_desc_size(enum hal_ce_desc type)
- {
- switch (type) {
- case HAL_CE_DESC_SRC:
- return sizeof(struct hal_ce_srng_src_desc);
- case HAL_CE_DESC_DST:
- return sizeof(struct hal_ce_srng_dest_desc);
- case HAL_CE_DESC_DST_STATUS:
- return sizeof(struct hal_ce_srng_dst_status_desc);
- }
- return 0;
- }
- void ath11k_hal_ce_src_set_desc(void *buf, dma_addr_t paddr, u32 len, u32 id,
- u8 byte_swap_data)
- {
- struct hal_ce_srng_src_desc *desc = buf;
- desc->buffer_addr_low = paddr & HAL_ADDR_LSB_REG_MASK;
- desc->buffer_addr_info =
- FIELD_PREP(HAL_CE_SRC_DESC_ADDR_INFO_ADDR_HI,
- ((u64)paddr >> HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_CE_SRC_DESC_ADDR_INFO_BYTE_SWAP,
- byte_swap_data) |
- FIELD_PREP(HAL_CE_SRC_DESC_ADDR_INFO_GATHER, 0) |
- FIELD_PREP(HAL_CE_SRC_DESC_ADDR_INFO_LEN, len);
- desc->meta_info = FIELD_PREP(HAL_CE_SRC_DESC_META_INFO_DATA, id);
- }
- void ath11k_hal_ce_dst_set_desc(void *buf, dma_addr_t paddr)
- {
- struct hal_ce_srng_dest_desc *desc = buf;
- desc->buffer_addr_low = paddr & HAL_ADDR_LSB_REG_MASK;
- desc->buffer_addr_info =
- FIELD_PREP(HAL_CE_DEST_DESC_ADDR_INFO_ADDR_HI,
- ((u64)paddr >> HAL_ADDR_MSB_REG_SHIFT));
- }
- u32 ath11k_hal_ce_dst_status_get_length(void *buf)
- {
- struct hal_ce_srng_dst_status_desc *desc = buf;
- u32 len;
- len = FIELD_GET(HAL_CE_DST_STATUS_DESC_FLAGS_LEN, desc->flags);
- desc->flags &= ~HAL_CE_DST_STATUS_DESC_FLAGS_LEN;
- return len;
- }
- void ath11k_hal_set_link_desc_addr(struct hal_wbm_link_desc *desc, u32 cookie,
- dma_addr_t paddr)
- {
- desc->buf_addr_info.info0 = FIELD_PREP(BUFFER_ADDR_INFO0_ADDR,
- (paddr & HAL_ADDR_LSB_REG_MASK));
- desc->buf_addr_info.info1 = FIELD_PREP(BUFFER_ADDR_INFO1_ADDR,
- ((u64)paddr >> HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(BUFFER_ADDR_INFO1_RET_BUF_MGR, 1) |
- FIELD_PREP(BUFFER_ADDR_INFO1_SW_COOKIE, cookie);
- }
- u32 *ath11k_hal_srng_dst_peek(struct ath11k_base *ab, struct hal_srng *srng)
- {
- lockdep_assert_held(&srng->lock);
- if (srng->u.dst_ring.tp != srng->u.dst_ring.cached_hp)
- return (srng->ring_base_vaddr + srng->u.dst_ring.tp);
- return NULL;
- }
- static u32 *ath11k_hal_srng_dst_peek_with_dma(struct ath11k_base *ab,
- struct hal_srng *srng, dma_addr_t *paddr)
- {
- lockdep_assert_held(&srng->lock);
- if (srng->u.dst_ring.tp != srng->u.dst_ring.cached_hp) {
- *paddr = srng->ring_base_paddr +
- sizeof(*srng->ring_base_vaddr) * srng->u.dst_ring.tp;
- return srng->ring_base_vaddr + srng->u.dst_ring.tp;
- }
- return NULL;
- }
- static void ath11k_hal_srng_prefetch_desc(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- dma_addr_t desc_paddr;
- u32 *desc;
- /* prefetch only if desc is available */
- desc = ath11k_hal_srng_dst_peek_with_dma(ab, srng, &desc_paddr);
- if (likely(desc)) {
- dma_sync_single_for_cpu(ab->dev, desc_paddr,
- (srng->entry_size * sizeof(u32)),
- DMA_FROM_DEVICE);
- prefetch(desc);
- }
- }
- u32 *ath11k_hal_srng_dst_get_next_entry(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- u32 *desc;
- lockdep_assert_held(&srng->lock);
- if (srng->u.dst_ring.tp == srng->u.dst_ring.cached_hp)
- return NULL;
- desc = srng->ring_base_vaddr + srng->u.dst_ring.tp;
- srng->u.dst_ring.tp += srng->entry_size;
- /* wrap around to start of ring*/
- if (srng->u.dst_ring.tp == srng->ring_size)
- srng->u.dst_ring.tp = 0;
- /* Try to prefetch the next descriptor in the ring */
- if (srng->flags & HAL_SRNG_FLAGS_CACHED)
- ath11k_hal_srng_prefetch_desc(ab, srng);
- return desc;
- }
- int ath11k_hal_srng_dst_num_free(struct ath11k_base *ab, struct hal_srng *srng,
- bool sync_hw_ptr)
- {
- u32 tp, hp;
- lockdep_assert_held(&srng->lock);
- tp = srng->u.dst_ring.tp;
- if (sync_hw_ptr) {
- hp = *srng->u.dst_ring.hp_addr;
- srng->u.dst_ring.cached_hp = hp;
- } else {
- hp = srng->u.dst_ring.cached_hp;
- }
- if (hp >= tp)
- return (hp - tp) / srng->entry_size;
- else
- return (srng->ring_size - tp + hp) / srng->entry_size;
- }
- /* Returns number of available entries in src ring */
- int ath11k_hal_srng_src_num_free(struct ath11k_base *ab, struct hal_srng *srng,
- bool sync_hw_ptr)
- {
- u32 tp, hp;
- lockdep_assert_held(&srng->lock);
- hp = srng->u.src_ring.hp;
- if (sync_hw_ptr) {
- tp = *srng->u.src_ring.tp_addr;
- srng->u.src_ring.cached_tp = tp;
- } else {
- tp = srng->u.src_ring.cached_tp;
- }
- if (tp > hp)
- return ((tp - hp) / srng->entry_size) - 1;
- else
- return ((srng->ring_size - hp + tp) / srng->entry_size) - 1;
- }
- u32 *ath11k_hal_srng_src_get_next_entry(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- u32 *desc;
- u32 next_hp;
- lockdep_assert_held(&srng->lock);
- /* TODO: Using % is expensive, but we have to do this since size of some
- * SRNG rings is not power of 2 (due to descriptor sizes). Need to see
- * if separate function is defined for rings having power of 2 ring size
- * (TCL2SW, REO2SW, SW2RXDMA and CE rings) so that we can avoid the
- * overhead of % by using mask (with &).
- */
- next_hp = (srng->u.src_ring.hp + srng->entry_size) % srng->ring_size;
- if (next_hp == srng->u.src_ring.cached_tp)
- return NULL;
- desc = srng->ring_base_vaddr + srng->u.src_ring.hp;
- srng->u.src_ring.hp = next_hp;
- /* TODO: Reap functionality is not used by all rings. If particular
- * ring does not use reap functionality, we need not update reap_hp
- * with next_hp pointer. Need to make sure a separate function is used
- * before doing any optimization by removing below code updating
- * reap_hp.
- */
- srng->u.src_ring.reap_hp = next_hp;
- return desc;
- }
- u32 *ath11k_hal_srng_src_reap_next(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- u32 *desc;
- u32 next_reap_hp;
- lockdep_assert_held(&srng->lock);
- next_reap_hp = (srng->u.src_ring.reap_hp + srng->entry_size) %
- srng->ring_size;
- if (next_reap_hp == srng->u.src_ring.cached_tp)
- return NULL;
- desc = srng->ring_base_vaddr + next_reap_hp;
- srng->u.src_ring.reap_hp = next_reap_hp;
- return desc;
- }
- u32 *ath11k_hal_srng_src_get_next_reaped(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- u32 *desc;
- lockdep_assert_held(&srng->lock);
- if (srng->u.src_ring.hp == srng->u.src_ring.reap_hp)
- return NULL;
- desc = srng->ring_base_vaddr + srng->u.src_ring.hp;
- srng->u.src_ring.hp = (srng->u.src_ring.hp + srng->entry_size) %
- srng->ring_size;
- return desc;
- }
- u32 *ath11k_hal_srng_src_next_peek(struct ath11k_base *ab, struct hal_srng *srng)
- {
- u32 next_hp;
- lockdep_assert_held(&srng->lock);
- next_hp = (srng->u.src_ring.hp + srng->entry_size) % srng->ring_size;
- if (next_hp != srng->u.src_ring.cached_tp)
- return srng->ring_base_vaddr + next_hp;
- return NULL;
- }
- u32 *ath11k_hal_srng_src_peek(struct ath11k_base *ab, struct hal_srng *srng)
- {
- lockdep_assert_held(&srng->lock);
- if (((srng->u.src_ring.hp + srng->entry_size) % srng->ring_size) ==
- srng->u.src_ring.cached_tp)
- return NULL;
- return srng->ring_base_vaddr + srng->u.src_ring.hp;
- }
- void ath11k_hal_srng_access_begin(struct ath11k_base *ab, struct hal_srng *srng)
- {
- u32 hp;
- lockdep_assert_held(&srng->lock);
- if (srng->ring_dir == HAL_SRNG_DIR_SRC) {
- srng->u.src_ring.cached_tp =
- *(volatile u32 *)srng->u.src_ring.tp_addr;
- } else {
- hp = READ_ONCE(*srng->u.dst_ring.hp_addr);
- if (hp != srng->u.dst_ring.cached_hp) {
- srng->u.dst_ring.cached_hp = hp;
- /* Make sure descriptor is read after the head
- * pointer.
- */
- dma_rmb();
- }
- /* Try to prefetch the next descriptor in the ring */
- if (srng->flags & HAL_SRNG_FLAGS_CACHED)
- ath11k_hal_srng_prefetch_desc(ab, srng);
- }
- }
- /* Update cached ring head/tail pointers to HW. ath11k_hal_srng_access_begin()
- * should have been called before this.
- */
- void ath11k_hal_srng_access_end(struct ath11k_base *ab, struct hal_srng *srng)
- {
- lockdep_assert_held(&srng->lock);
- if (srng->flags & HAL_SRNG_FLAGS_LMAC_RING) {
- /* For LMAC rings, ring pointer updates are done through FW and
- * hence written to a shared memory location that is read by FW
- */
- if (srng->ring_dir == HAL_SRNG_DIR_SRC) {
- srng->u.src_ring.last_tp =
- *(volatile u32 *)srng->u.src_ring.tp_addr;
- /* Make sure descriptor is written before updating the
- * head pointer.
- */
- dma_wmb();
- WRITE_ONCE(*srng->u.src_ring.hp_addr, srng->u.src_ring.hp);
- } else {
- srng->u.dst_ring.last_hp = *srng->u.dst_ring.hp_addr;
- /* Make sure descriptor is read before updating the
- * tail pointer.
- */
- dma_mb();
- WRITE_ONCE(*srng->u.dst_ring.tp_addr, srng->u.dst_ring.tp);
- }
- } else {
- if (srng->ring_dir == HAL_SRNG_DIR_SRC) {
- srng->u.src_ring.last_tp =
- *(volatile u32 *)srng->u.src_ring.tp_addr;
- /* Assume implementation use an MMIO write accessor
- * which has the required wmb() so that the descriptor
- * is written before the updating the head pointer.
- */
- ath11k_hif_write32(ab,
- (unsigned long)srng->u.src_ring.hp_addr -
- (unsigned long)ab->mem,
- srng->u.src_ring.hp);
- } else {
- srng->u.dst_ring.last_hp = *srng->u.dst_ring.hp_addr;
- /* Make sure descriptor is read before updating the
- * tail pointer.
- */
- mb();
- ath11k_hif_write32(ab,
- (unsigned long)srng->u.dst_ring.tp_addr -
- (unsigned long)ab->mem,
- srng->u.dst_ring.tp);
- }
- }
- srng->timestamp = jiffies;
- }
- void ath11k_hal_setup_link_idle_list(struct ath11k_base *ab,
- struct hal_wbm_idle_scatter_list *sbuf,
- u32 nsbufs, u32 tot_link_desc,
- u32 end_offset)
- {
- struct ath11k_buffer_addr *link_addr;
- int i;
- u32 reg_scatter_buf_sz = HAL_WBM_IDLE_SCATTER_BUF_SIZE / 64;
- link_addr = (void *)sbuf[0].vaddr + HAL_WBM_IDLE_SCATTER_BUF_SIZE;
- for (i = 1; i < nsbufs; i++) {
- link_addr->info0 = sbuf[i].paddr & HAL_ADDR_LSB_REG_MASK;
- link_addr->info1 = FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_39_32,
- (u64)sbuf[i].paddr >> HAL_ADDR_MSB_REG_SHIFT) |
- FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_MATCH_TAG,
- BASE_ADDR_MATCH_TAG_VAL);
- link_addr = (void *)sbuf[i].vaddr +
- HAL_WBM_IDLE_SCATTER_BUF_SIZE;
- }
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_R0_IDLE_LIST_CONTROL_ADDR,
- FIELD_PREP(HAL_WBM_SCATTER_BUFFER_SIZE, reg_scatter_buf_sz) |
- FIELD_PREP(HAL_WBM_LINK_DESC_IDLE_LIST_MODE, 0x1));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_R0_IDLE_LIST_SIZE_ADDR,
- FIELD_PREP(HAL_WBM_SCATTER_RING_SIZE_OF_IDLE_LINK_DESC_LIST,
- reg_scatter_buf_sz * nsbufs));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_RING_BASE_LSB,
- FIELD_PREP(BUFFER_ADDR_INFO0_ADDR,
- sbuf[0].paddr & HAL_ADDR_LSB_REG_MASK));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_RING_BASE_MSB,
- FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_39_32,
- (u64)sbuf[0].paddr >> HAL_ADDR_MSB_REG_SHIFT) |
- FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_MATCH_TAG,
- BASE_ADDR_MATCH_TAG_VAL));
- /* Setup head and tail pointers for the idle list */
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_HEAD_INFO_IX0,
- FIELD_PREP(BUFFER_ADDR_INFO0_ADDR,
- sbuf[nsbufs - 1].paddr));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_HEAD_INFO_IX1,
- FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_39_32,
- ((u64)sbuf[nsbufs - 1].paddr >>
- HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_WBM_SCATTERED_DESC_HEAD_P_OFFSET_IX1,
- (end_offset >> 2)));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_HEAD_INFO_IX0,
- FIELD_PREP(BUFFER_ADDR_INFO0_ADDR,
- sbuf[0].paddr));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_TAIL_INFO_IX0,
- FIELD_PREP(BUFFER_ADDR_INFO0_ADDR,
- sbuf[0].paddr));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_TAIL_INFO_IX1,
- FIELD_PREP(
- HAL_WBM_SCATTERED_DESC_MSB_BASE_ADDR_39_32,
- ((u64)sbuf[0].paddr >> HAL_ADDR_MSB_REG_SHIFT)) |
- FIELD_PREP(HAL_WBM_SCATTERED_DESC_TAIL_P_OFFSET_IX1,
- 0));
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_SCATTERED_DESC_PTR_HP_ADDR,
- 2 * tot_link_desc);
- /* Enable the SRNG */
- ath11k_hif_write32(ab,
- HAL_SEQ_WCSS_UMAC_WBM_REG +
- HAL_WBM_IDLE_LINK_RING_MISC_ADDR(ab), 0x40);
- }
- int ath11k_hal_srng_setup(struct ath11k_base *ab, enum hal_ring_type type,
- int ring_num, int mac_id,
- struct hal_srng_params *params)
- {
- struct ath11k_hal *hal = &ab->hal;
- struct hal_srng_config *srng_config = &ab->hal.srng_config[type];
- struct hal_srng *srng;
- int ring_id;
- u32 lmac_idx;
- int i;
- u32 reg_base;
- ring_id = ath11k_hal_srng_get_ring_id(ab, type, ring_num, mac_id);
- if (ring_id < 0)
- return ring_id;
- srng = &hal->srng_list[ring_id];
- srng->ring_id = ring_id;
- srng->ring_dir = srng_config->ring_dir;
- srng->ring_base_paddr = params->ring_base_paddr;
- srng->ring_base_vaddr = params->ring_base_vaddr;
- srng->entry_size = srng_config->entry_size;
- srng->num_entries = params->num_entries;
- srng->ring_size = srng->entry_size * srng->num_entries;
- srng->intr_batch_cntr_thres_entries =
- params->intr_batch_cntr_thres_entries;
- srng->intr_timer_thres_us = params->intr_timer_thres_us;
- srng->flags = params->flags;
- srng->msi_addr = params->msi_addr;
- srng->msi_data = params->msi_data;
- srng->initialized = 1;
- spin_lock_init(&srng->lock);
- lockdep_set_class(&srng->lock, hal->srng_key + ring_id);
- for (i = 0; i < HAL_SRNG_NUM_REG_GRP; i++) {
- srng->hwreg_base[i] = srng_config->reg_start[i] +
- (ring_num * srng_config->reg_size[i]);
- }
- memset(srng->ring_base_vaddr, 0,
- (srng->entry_size * srng->num_entries) << 2);
- /* TODO: Add comments on these swap configurations */
- if (IS_ENABLED(CONFIG_CPU_BIG_ENDIAN))
- srng->flags |= HAL_SRNG_FLAGS_MSI_SWAP | HAL_SRNG_FLAGS_DATA_TLV_SWAP |
- HAL_SRNG_FLAGS_RING_PTR_SWAP;
- reg_base = srng->hwreg_base[HAL_SRNG_REG_GRP_R2];
- if (srng->ring_dir == HAL_SRNG_DIR_SRC) {
- srng->u.src_ring.hp = 0;
- srng->u.src_ring.cached_tp = 0;
- srng->u.src_ring.reap_hp = srng->ring_size - srng->entry_size;
- srng->u.src_ring.tp_addr = (void *)(hal->rdp.vaddr + ring_id);
- srng->u.src_ring.low_threshold = params->low_threshold *
- srng->entry_size;
- if (srng_config->lmac_ring) {
- lmac_idx = ring_id - HAL_SRNG_RING_ID_LMAC1_ID_START;
- srng->u.src_ring.hp_addr = (void *)(hal->wrp.vaddr +
- lmac_idx);
- srng->flags |= HAL_SRNG_FLAGS_LMAC_RING;
- } else {
- if (!ab->hw_params.supports_shadow_regs)
- srng->u.src_ring.hp_addr =
- (u32 *)((unsigned long)ab->mem + reg_base);
- else
- ath11k_dbg(ab, ATH11K_DBG_HAL,
- "type %d ring_num %d reg_base 0x%x shadow 0x%lx\n",
- type, ring_num,
- reg_base,
- (unsigned long)srng->u.src_ring.hp_addr -
- (unsigned long)ab->mem);
- }
- } else {
- /* During initialization loop count in all the descriptors
- * will be set to zero, and HW will set it to 1 on completing
- * descriptor update in first loop, and increments it by 1 on
- * subsequent loops (loop count wraps around after reaching
- * 0xffff). The 'loop_cnt' in SW ring state is the expected
- * loop count in descriptors updated by HW (to be processed
- * by SW).
- */
- srng->u.dst_ring.loop_cnt = 1;
- srng->u.dst_ring.tp = 0;
- srng->u.dst_ring.cached_hp = 0;
- srng->u.dst_ring.hp_addr = (void *)(hal->rdp.vaddr + ring_id);
- if (srng_config->lmac_ring) {
- /* For LMAC rings, tail pointer updates will be done
- * through FW by writing to a shared memory location
- */
- lmac_idx = ring_id - HAL_SRNG_RING_ID_LMAC1_ID_START;
- srng->u.dst_ring.tp_addr = (void *)(hal->wrp.vaddr +
- lmac_idx);
- srng->flags |= HAL_SRNG_FLAGS_LMAC_RING;
- } else {
- if (!ab->hw_params.supports_shadow_regs)
- srng->u.dst_ring.tp_addr =
- (u32 *)((unsigned long)ab->mem + reg_base +
- (HAL_REO1_RING_TP(ab) - HAL_REO1_RING_HP(ab)));
- else
- ath11k_dbg(ab, ATH11K_DBG_HAL,
- "type %d ring_num %d target_reg 0x%x shadow 0x%lx\n",
- type, ring_num,
- reg_base + (HAL_REO1_RING_TP(ab) -
- HAL_REO1_RING_HP(ab)),
- (unsigned long)srng->u.dst_ring.tp_addr -
- (unsigned long)ab->mem);
- }
- }
- if (srng_config->lmac_ring)
- return ring_id;
- ath11k_hal_srng_hw_init(ab, srng);
- if (type == HAL_CE_DST) {
- srng->u.dst_ring.max_buffer_length = params->max_buffer_len;
- ath11k_hal_ce_dst_setup(ab, srng, ring_num);
- }
- return ring_id;
- }
- static void ath11k_hal_srng_update_hp_tp_addr(struct ath11k_base *ab,
- int shadow_cfg_idx,
- enum hal_ring_type ring_type,
- int ring_num)
- {
- struct hal_srng *srng;
- struct ath11k_hal *hal = &ab->hal;
- int ring_id;
- struct hal_srng_config *srng_config = &hal->srng_config[ring_type];
- ring_id = ath11k_hal_srng_get_ring_id(ab, ring_type, ring_num, 0);
- if (ring_id < 0)
- return;
- srng = &hal->srng_list[ring_id];
- if (srng_config->ring_dir == HAL_SRNG_DIR_DST)
- srng->u.dst_ring.tp_addr = (u32 *)(HAL_SHADOW_REG(ab, shadow_cfg_idx) +
- (unsigned long)ab->mem);
- else
- srng->u.src_ring.hp_addr = (u32 *)(HAL_SHADOW_REG(ab, shadow_cfg_idx) +
- (unsigned long)ab->mem);
- }
- int ath11k_hal_srng_update_shadow_config(struct ath11k_base *ab,
- enum hal_ring_type ring_type,
- int ring_num)
- {
- struct ath11k_hal *hal = &ab->hal;
- struct hal_srng_config *srng_config = &hal->srng_config[ring_type];
- int shadow_cfg_idx = hal->num_shadow_reg_configured;
- u32 target_reg;
- if (shadow_cfg_idx >= HAL_SHADOW_NUM_REGS)
- return -EINVAL;
- hal->num_shadow_reg_configured++;
- target_reg = srng_config->reg_start[HAL_HP_OFFSET_IN_REG_START];
- target_reg += srng_config->reg_size[HAL_HP_OFFSET_IN_REG_START] *
- ring_num;
- /* For destination ring, shadow the TP */
- if (srng_config->ring_dir == HAL_SRNG_DIR_DST)
- target_reg += HAL_OFFSET_FROM_HP_TO_TP;
- hal->shadow_reg_addr[shadow_cfg_idx] = target_reg;
- /* update hp/tp addr to hal structure*/
- ath11k_hal_srng_update_hp_tp_addr(ab, shadow_cfg_idx, ring_type,
- ring_num);
- ath11k_dbg(ab, ATH11K_DBG_HAL,
- "update shadow config target_reg %x shadow reg 0x%x shadow_idx 0x%x ring_type %d ring num %d",
- target_reg,
- HAL_SHADOW_REG(ab, shadow_cfg_idx),
- shadow_cfg_idx,
- ring_type, ring_num);
- return 0;
- }
- void ath11k_hal_srng_shadow_config(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- int ring_type, ring_num;
- /* update all the non-CE srngs. */
- for (ring_type = 0; ring_type < HAL_MAX_RING_TYPES; ring_type++) {
- struct hal_srng_config *srng_config = &hal->srng_config[ring_type];
- if (ring_type == HAL_CE_SRC ||
- ring_type == HAL_CE_DST ||
- ring_type == HAL_CE_DST_STATUS)
- continue;
- if (srng_config->lmac_ring)
- continue;
- for (ring_num = 0; ring_num < srng_config->max_rings; ring_num++)
- ath11k_hal_srng_update_shadow_config(ab, ring_type, ring_num);
- }
- }
- void ath11k_hal_srng_get_shadow_config(struct ath11k_base *ab,
- u32 **cfg, u32 *len)
- {
- struct ath11k_hal *hal = &ab->hal;
- *len = hal->num_shadow_reg_configured;
- *cfg = hal->shadow_reg_addr;
- }
- void ath11k_hal_srng_shadow_update_hp_tp(struct ath11k_base *ab,
- struct hal_srng *srng)
- {
- lockdep_assert_held(&srng->lock);
- /* check whether the ring is empty. Update the shadow
- * HP only when then ring isn't empty.
- */
- if (srng->ring_dir == HAL_SRNG_DIR_SRC &&
- *srng->u.src_ring.tp_addr != srng->u.src_ring.hp)
- ath11k_hal_srng_access_end(ab, srng);
- }
- static int ath11k_hal_srng_create_config(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- struct hal_srng_config *s;
- hal->srng_config = kmemdup(hw_srng_config_template,
- sizeof(hw_srng_config_template),
- GFP_KERNEL);
- if (!hal->srng_config)
- return -ENOMEM;
- s = &hal->srng_config[HAL_REO_DST];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO1_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO1_RING_HP(ab);
- s->reg_size[0] = HAL_REO2_RING_BASE_LSB(ab) - HAL_REO1_RING_BASE_LSB(ab);
- s->reg_size[1] = HAL_REO2_RING_HP(ab) - HAL_REO1_RING_HP(ab);
- s = &hal->srng_config[HAL_REO_EXCEPTION];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_TCL_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_TCL_RING_HP(ab);
- s = &hal->srng_config[HAL_REO_REINJECT];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_SW2REO_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_SW2REO_RING_HP(ab);
- s = &hal->srng_config[HAL_REO_CMD];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_CMD_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_CMD_HP(ab);
- s = &hal->srng_config[HAL_REO_STATUS];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_STATUS_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_REO_REG + HAL_REO_STATUS_HP(ab);
- s = &hal->srng_config[HAL_TCL_DATA];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL1_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL1_RING_HP;
- s->reg_size[0] = HAL_TCL2_RING_BASE_LSB(ab) - HAL_TCL1_RING_BASE_LSB(ab);
- s->reg_size[1] = HAL_TCL2_RING_HP - HAL_TCL1_RING_HP;
- s = &hal->srng_config[HAL_TCL_CMD];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL_RING_HP;
- s = &hal->srng_config[HAL_TCL_STATUS];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL_STATUS_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_TCL_REG + HAL_TCL_STATUS_RING_HP;
- s = &hal->srng_config[HAL_CE_SRC];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_CE0_SRC_REG(ab) + HAL_CE_DST_RING_BASE_LSB +
- ATH11K_CE_OFFSET(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_CE0_SRC_REG(ab) + HAL_CE_DST_RING_HP +
- ATH11K_CE_OFFSET(ab);
- s->reg_size[0] = HAL_SEQ_WCSS_UMAC_CE1_SRC_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_SRC_REG(ab);
- s->reg_size[1] = HAL_SEQ_WCSS_UMAC_CE1_SRC_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_SRC_REG(ab);
- s = &hal->srng_config[HAL_CE_DST];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab) + HAL_CE_DST_RING_BASE_LSB +
- ATH11K_CE_OFFSET(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab) + HAL_CE_DST_RING_HP +
- ATH11K_CE_OFFSET(ab);
- s->reg_size[0] = HAL_SEQ_WCSS_UMAC_CE1_DST_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab);
- s->reg_size[1] = HAL_SEQ_WCSS_UMAC_CE1_DST_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab);
- s = &hal->srng_config[HAL_CE_DST_STATUS];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab) +
- HAL_CE_DST_STATUS_RING_BASE_LSB + ATH11K_CE_OFFSET(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab) + HAL_CE_DST_STATUS_RING_HP +
- ATH11K_CE_OFFSET(ab);
- s->reg_size[0] = HAL_SEQ_WCSS_UMAC_CE1_DST_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab);
- s->reg_size[1] = HAL_SEQ_WCSS_UMAC_CE1_DST_REG(ab) -
- HAL_SEQ_WCSS_UMAC_CE0_DST_REG(ab);
- s = &hal->srng_config[HAL_WBM_IDLE_LINK];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_IDLE_LINK_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_IDLE_LINK_RING_HP;
- s = &hal->srng_config[HAL_SW2WBM_RELEASE];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_RELEASE_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM_RELEASE_RING_HP;
- s = &hal->srng_config[HAL_WBM2SW_RELEASE];
- s->reg_start[0] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM0_RELEASE_RING_BASE_LSB(ab);
- s->reg_start[1] = HAL_SEQ_WCSS_UMAC_WBM_REG + HAL_WBM0_RELEASE_RING_HP;
- s->reg_size[0] = HAL_WBM1_RELEASE_RING_BASE_LSB(ab) -
- HAL_WBM0_RELEASE_RING_BASE_LSB(ab);
- s->reg_size[1] = HAL_WBM1_RELEASE_RING_HP - HAL_WBM0_RELEASE_RING_HP;
- return 0;
- }
- static void ath11k_hal_register_srng_key(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- u32 ring_id;
- for (ring_id = 0; ring_id < HAL_SRNG_RING_ID_MAX; ring_id++)
- lockdep_register_key(hal->srng_key + ring_id);
- }
- static void ath11k_hal_unregister_srng_key(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- u32 ring_id;
- for (ring_id = 0; ring_id < HAL_SRNG_RING_ID_MAX; ring_id++)
- lockdep_unregister_key(hal->srng_key + ring_id);
- }
- int ath11k_hal_srng_init(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- int ret;
- memset(hal, 0, sizeof(*hal));
- ret = ath11k_hal_srng_create_config(ab);
- if (ret)
- goto err_hal;
- ret = ath11k_hal_alloc_cont_rdp(ab);
- if (ret)
- goto err_hal;
- ret = ath11k_hal_alloc_cont_wrp(ab);
- if (ret)
- goto err_free_cont_rdp;
- ath11k_hal_register_srng_key(ab);
- return 0;
- err_free_cont_rdp:
- ath11k_hal_free_cont_rdp(ab);
- err_hal:
- return ret;
- }
- EXPORT_SYMBOL(ath11k_hal_srng_init);
- void ath11k_hal_srng_deinit(struct ath11k_base *ab)
- {
- struct ath11k_hal *hal = &ab->hal;
- int i;
- for (i = 0; i < HAL_SRNG_RING_ID_MAX; i++)
- ab->hal.srng_list[i].initialized = 0;
- ath11k_hal_unregister_srng_key(ab);
- ath11k_hal_free_cont_rdp(ab);
- ath11k_hal_free_cont_wrp(ab);
- kfree(hal->srng_config);
- hal->srng_config = NULL;
- }
- EXPORT_SYMBOL(ath11k_hal_srng_deinit);
- void ath11k_hal_srng_clear(struct ath11k_base *ab)
- {
- /* No need to memset rdp and wrp memory since each individual
- * segment would get cleared in ath11k_hal_srng_src_hw_init()
- * and ath11k_hal_srng_dst_hw_init().
- */
- memset(ab->hal.srng_list, 0,
- sizeof(ab->hal.srng_list));
- memset(ab->hal.shadow_reg_addr, 0,
- sizeof(ab->hal.shadow_reg_addr));
- ab->hal.avail_blk_resource = 0;
- ab->hal.current_blk_index = 0;
- ab->hal.num_shadow_reg_configured = 0;
- }
- EXPORT_SYMBOL(ath11k_hal_srng_clear);
- void ath11k_hal_dump_srng_stats(struct ath11k_base *ab)
- {
- struct hal_srng *srng;
- struct ath11k_ext_irq_grp *irq_grp;
- struct ath11k_ce_pipe *ce_pipe;
- int i;
- ath11k_err(ab, "Last interrupt received for each CE:\n");
- for (i = 0; i < ab->hw_params.ce_count; i++) {
- ce_pipe = &ab->ce.ce_pipe[i];
- if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR)
- continue;
- ath11k_err(ab, "CE_id %d pipe_num %d %ums before\n",
- i, ce_pipe->pipe_num,
- jiffies_to_msecs(jiffies - ce_pipe->timestamp));
- }
- ath11k_err(ab, "\nLast interrupt received for each group:\n");
- for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) {
- irq_grp = &ab->ext_irq_grp[i];
- ath11k_err(ab, "group_id %d %ums before\n",
- irq_grp->grp_id,
- jiffies_to_msecs(jiffies - irq_grp->timestamp));
- }
- for (i = 0; i < HAL_SRNG_RING_ID_MAX; i++) {
- srng = &ab->hal.srng_list[i];
- if (!srng->initialized)
- continue;
- if (srng->ring_dir == HAL_SRNG_DIR_SRC)
- ath11k_err(ab,
- "src srng id %u hp %u, reap_hp %u, cur tp %u, cached tp %u last tp %u napi processed before %ums\n",
- srng->ring_id, srng->u.src_ring.hp,
- srng->u.src_ring.reap_hp,
- *srng->u.src_ring.tp_addr, srng->u.src_ring.cached_tp,
- srng->u.src_ring.last_tp,
- jiffies_to_msecs(jiffies - srng->timestamp));
- else if (srng->ring_dir == HAL_SRNG_DIR_DST)
- ath11k_err(ab,
- "dst srng id %u tp %u, cur hp %u, cached hp %u last hp %u napi processed before %ums\n",
- srng->ring_id, srng->u.dst_ring.tp,
- *srng->u.dst_ring.hp_addr,
- srng->u.dst_ring.cached_hp,
- srng->u.dst_ring.last_hp,
- jiffies_to_msecs(jiffies - srng->timestamp));
- }
- }
|