162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * TI K3 NAVSS Ring Accelerator subsystem driver 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/dma-mapping.h> 962306a36Sopenharmony_ci#include <linux/io.h> 1062306a36Sopenharmony_ci#include <linux/module.h> 1162306a36Sopenharmony_ci#include <linux/of.h> 1262306a36Sopenharmony_ci#include <linux/platform_device.h> 1362306a36Sopenharmony_ci#include <linux/sys_soc.h> 1462306a36Sopenharmony_ci#include <linux/dma/ti-cppi5.h> 1562306a36Sopenharmony_ci#include <linux/soc/ti/k3-ringacc.h> 1662306a36Sopenharmony_ci#include <linux/soc/ti/ti_sci_protocol.h> 1762306a36Sopenharmony_ci#include <linux/soc/ti/ti_sci_inta_msi.h> 1862306a36Sopenharmony_ci#include <linux/of_irq.h> 1962306a36Sopenharmony_ci#include <linux/irqdomain.h> 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic LIST_HEAD(k3_ringacc_list); 2262306a36Sopenharmony_cistatic DEFINE_MUTEX(k3_ringacc_list_lock); 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci#define K3_RINGACC_CFG_RING_SIZE_ELCNT_MASK GENMASK(19, 0) 2562306a36Sopenharmony_ci#define K3_DMARING_CFG_RING_SIZE_ELCNT_MASK GENMASK(15, 0) 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci/** 2862306a36Sopenharmony_ci * struct k3_ring_rt_regs - The RA realtime Control/Status Registers region 2962306a36Sopenharmony_ci * 3062306a36Sopenharmony_ci * @resv_16: Reserved 3162306a36Sopenharmony_ci * @db: Ring Doorbell Register 3262306a36Sopenharmony_ci * @resv_4: Reserved 3362306a36Sopenharmony_ci * @occ: Ring Occupancy Register 3462306a36Sopenharmony_ci * @indx: Ring Current Index Register 3562306a36Sopenharmony_ci * @hwocc: Ring Hardware Occupancy Register 3662306a36Sopenharmony_ci * @hwindx: Ring Hardware Current Index Register 3762306a36Sopenharmony_ci */ 3862306a36Sopenharmony_cistruct k3_ring_rt_regs { 3962306a36Sopenharmony_ci u32 resv_16[4]; 4062306a36Sopenharmony_ci u32 db; 4162306a36Sopenharmony_ci u32 resv_4[1]; 4262306a36Sopenharmony_ci u32 occ; 4362306a36Sopenharmony_ci u32 indx; 4462306a36Sopenharmony_ci u32 hwocc; 4562306a36Sopenharmony_ci u32 hwindx; 4662306a36Sopenharmony_ci}; 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci#define K3_RINGACC_RT_REGS_STEP 0x1000 4962306a36Sopenharmony_ci#define K3_DMARING_RT_REGS_STEP 0x2000 5062306a36Sopenharmony_ci#define K3_DMARING_RT_REGS_REVERSE_OFS 0x1000 5162306a36Sopenharmony_ci#define K3_RINGACC_RT_OCC_MASK GENMASK(20, 0) 5262306a36Sopenharmony_ci#define K3_DMARING_RT_OCC_TDOWN_COMPLETE BIT(31) 5362306a36Sopenharmony_ci#define K3_DMARING_RT_DB_ENTRY_MASK GENMASK(7, 0) 5462306a36Sopenharmony_ci#define K3_DMARING_RT_DB_TDOWN_ACK BIT(31) 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci/** 5762306a36Sopenharmony_ci * struct k3_ring_fifo_regs - The Ring Accelerator Queues Registers region 5862306a36Sopenharmony_ci * 5962306a36Sopenharmony_ci * @head_data: Ring Head Entry Data Registers 6062306a36Sopenharmony_ci * @tail_data: Ring Tail Entry Data Registers 6162306a36Sopenharmony_ci * @peek_head_data: Ring Peek Head Entry Data Regs 6262306a36Sopenharmony_ci * @peek_tail_data: Ring Peek Tail Entry Data Regs 6362306a36Sopenharmony_ci */ 6462306a36Sopenharmony_cistruct k3_ring_fifo_regs { 6562306a36Sopenharmony_ci u32 head_data[128]; 6662306a36Sopenharmony_ci u32 tail_data[128]; 6762306a36Sopenharmony_ci u32 peek_head_data[128]; 6862306a36Sopenharmony_ci u32 peek_tail_data[128]; 6962306a36Sopenharmony_ci}; 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci/** 7262306a36Sopenharmony_ci * struct k3_ringacc_proxy_gcfg_regs - RA Proxy Global Config MMIO Region 7362306a36Sopenharmony_ci * 7462306a36Sopenharmony_ci * @revision: Revision Register 7562306a36Sopenharmony_ci * @config: Config Register 7662306a36Sopenharmony_ci */ 7762306a36Sopenharmony_cistruct k3_ringacc_proxy_gcfg_regs { 7862306a36Sopenharmony_ci u32 revision; 7962306a36Sopenharmony_ci u32 config; 8062306a36Sopenharmony_ci}; 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci#define K3_RINGACC_PROXY_CFG_THREADS_MASK GENMASK(15, 0) 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ci/** 8562306a36Sopenharmony_ci * struct k3_ringacc_proxy_target_regs - Proxy Datapath MMIO Region 8662306a36Sopenharmony_ci * 8762306a36Sopenharmony_ci * @control: Proxy Control Register 8862306a36Sopenharmony_ci * @status: Proxy Status Register 8962306a36Sopenharmony_ci * @resv_512: Reserved 9062306a36Sopenharmony_ci * @data: Proxy Data Register 9162306a36Sopenharmony_ci */ 9262306a36Sopenharmony_cistruct k3_ringacc_proxy_target_regs { 9362306a36Sopenharmony_ci u32 control; 9462306a36Sopenharmony_ci u32 status; 9562306a36Sopenharmony_ci u8 resv_512[504]; 9662306a36Sopenharmony_ci u32 data[128]; 9762306a36Sopenharmony_ci}; 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci#define K3_RINGACC_PROXY_TARGET_STEP 0x1000 10062306a36Sopenharmony_ci#define K3_RINGACC_PROXY_NOT_USED (-1) 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cienum k3_ringacc_proxy_access_mode { 10362306a36Sopenharmony_ci PROXY_ACCESS_MODE_HEAD = 0, 10462306a36Sopenharmony_ci PROXY_ACCESS_MODE_TAIL = 1, 10562306a36Sopenharmony_ci PROXY_ACCESS_MODE_PEEK_HEAD = 2, 10662306a36Sopenharmony_ci PROXY_ACCESS_MODE_PEEK_TAIL = 3, 10762306a36Sopenharmony_ci}; 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci#define K3_RINGACC_FIFO_WINDOW_SIZE_BYTES (512U) 11062306a36Sopenharmony_ci#define K3_RINGACC_FIFO_REGS_STEP 0x1000 11162306a36Sopenharmony_ci#define K3_RINGACC_MAX_DB_RING_CNT (127U) 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_cistruct k3_ring_ops { 11462306a36Sopenharmony_ci int (*push_tail)(struct k3_ring *ring, void *elm); 11562306a36Sopenharmony_ci int (*push_head)(struct k3_ring *ring, void *elm); 11662306a36Sopenharmony_ci int (*pop_tail)(struct k3_ring *ring, void *elm); 11762306a36Sopenharmony_ci int (*pop_head)(struct k3_ring *ring, void *elm); 11862306a36Sopenharmony_ci}; 11962306a36Sopenharmony_ci 12062306a36Sopenharmony_ci/** 12162306a36Sopenharmony_ci * struct k3_ring_state - Internal state tracking structure 12262306a36Sopenharmony_ci * 12362306a36Sopenharmony_ci * @free: Number of free entries 12462306a36Sopenharmony_ci * @occ: Occupancy 12562306a36Sopenharmony_ci * @windex: Write index 12662306a36Sopenharmony_ci * @rindex: Read index 12762306a36Sopenharmony_ci * @tdown_complete: Tear down complete state 12862306a36Sopenharmony_ci */ 12962306a36Sopenharmony_cistruct k3_ring_state { 13062306a36Sopenharmony_ci u32 free; 13162306a36Sopenharmony_ci u32 occ; 13262306a36Sopenharmony_ci u32 windex; 13362306a36Sopenharmony_ci u32 rindex; 13462306a36Sopenharmony_ci u32 tdown_complete:1; 13562306a36Sopenharmony_ci}; 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ci/** 13862306a36Sopenharmony_ci * struct k3_ring - RA Ring descriptor 13962306a36Sopenharmony_ci * 14062306a36Sopenharmony_ci * @rt: Ring control/status registers 14162306a36Sopenharmony_ci * @fifos: Ring queues registers 14262306a36Sopenharmony_ci * @proxy: Ring Proxy Datapath registers 14362306a36Sopenharmony_ci * @ring_mem_dma: Ring buffer dma address 14462306a36Sopenharmony_ci * @ring_mem_virt: Ring buffer virt address 14562306a36Sopenharmony_ci * @ops: Ring operations 14662306a36Sopenharmony_ci * @size: Ring size in elements 14762306a36Sopenharmony_ci * @elm_size: Size of the ring element 14862306a36Sopenharmony_ci * @mode: Ring mode 14962306a36Sopenharmony_ci * @flags: flags 15062306a36Sopenharmony_ci * @state: Ring state 15162306a36Sopenharmony_ci * @ring_id: Ring Id 15262306a36Sopenharmony_ci * @parent: Pointer on struct @k3_ringacc 15362306a36Sopenharmony_ci * @use_count: Use count for shared rings 15462306a36Sopenharmony_ci * @proxy_id: RA Ring Proxy Id (only if @K3_RINGACC_RING_USE_PROXY) 15562306a36Sopenharmony_ci * @dma_dev: device to be used for DMA API (allocation, mapping) 15662306a36Sopenharmony_ci * @asel: Address Space Select value for physical addresses 15762306a36Sopenharmony_ci */ 15862306a36Sopenharmony_cistruct k3_ring { 15962306a36Sopenharmony_ci struct k3_ring_rt_regs __iomem *rt; 16062306a36Sopenharmony_ci struct k3_ring_fifo_regs __iomem *fifos; 16162306a36Sopenharmony_ci struct k3_ringacc_proxy_target_regs __iomem *proxy; 16262306a36Sopenharmony_ci dma_addr_t ring_mem_dma; 16362306a36Sopenharmony_ci void *ring_mem_virt; 16462306a36Sopenharmony_ci struct k3_ring_ops *ops; 16562306a36Sopenharmony_ci u32 size; 16662306a36Sopenharmony_ci enum k3_ring_size elm_size; 16762306a36Sopenharmony_ci enum k3_ring_mode mode; 16862306a36Sopenharmony_ci u32 flags; 16962306a36Sopenharmony_ci#define K3_RING_FLAG_BUSY BIT(1) 17062306a36Sopenharmony_ci#define K3_RING_FLAG_SHARED BIT(2) 17162306a36Sopenharmony_ci#define K3_RING_FLAG_REVERSE BIT(3) 17262306a36Sopenharmony_ci struct k3_ring_state state; 17362306a36Sopenharmony_ci u32 ring_id; 17462306a36Sopenharmony_ci struct k3_ringacc *parent; 17562306a36Sopenharmony_ci u32 use_count; 17662306a36Sopenharmony_ci int proxy_id; 17762306a36Sopenharmony_ci struct device *dma_dev; 17862306a36Sopenharmony_ci u32 asel; 17962306a36Sopenharmony_ci#define K3_ADDRESS_ASEL_SHIFT 48 18062306a36Sopenharmony_ci}; 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_cistruct k3_ringacc_ops { 18362306a36Sopenharmony_ci int (*init)(struct platform_device *pdev, struct k3_ringacc *ringacc); 18462306a36Sopenharmony_ci}; 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci/** 18762306a36Sopenharmony_ci * struct k3_ringacc - Rings accelerator descriptor 18862306a36Sopenharmony_ci * 18962306a36Sopenharmony_ci * @dev: pointer on RA device 19062306a36Sopenharmony_ci * @proxy_gcfg: RA proxy global config registers 19162306a36Sopenharmony_ci * @proxy_target_base: RA proxy datapath region 19262306a36Sopenharmony_ci * @num_rings: number of ring in RA 19362306a36Sopenharmony_ci * @rings_inuse: bitfield for ring usage tracking 19462306a36Sopenharmony_ci * @rm_gp_range: general purpose rings range from tisci 19562306a36Sopenharmony_ci * @dma_ring_reset_quirk: DMA reset workaround enable 19662306a36Sopenharmony_ci * @num_proxies: number of RA proxies 19762306a36Sopenharmony_ci * @proxy_inuse: bitfield for proxy usage tracking 19862306a36Sopenharmony_ci * @rings: array of rings descriptors (struct @k3_ring) 19962306a36Sopenharmony_ci * @list: list of RAs in the system 20062306a36Sopenharmony_ci * @req_lock: protect rings allocation 20162306a36Sopenharmony_ci * @tisci: pointer ti-sci handle 20262306a36Sopenharmony_ci * @tisci_ring_ops: ti-sci rings ops 20362306a36Sopenharmony_ci * @tisci_dev_id: ti-sci device id 20462306a36Sopenharmony_ci * @ops: SoC specific ringacc operation 20562306a36Sopenharmony_ci * @dma_rings: indicate DMA ring (dual ring within BCDMA/PKTDMA) 20662306a36Sopenharmony_ci */ 20762306a36Sopenharmony_cistruct k3_ringacc { 20862306a36Sopenharmony_ci struct device *dev; 20962306a36Sopenharmony_ci struct k3_ringacc_proxy_gcfg_regs __iomem *proxy_gcfg; 21062306a36Sopenharmony_ci void __iomem *proxy_target_base; 21162306a36Sopenharmony_ci u32 num_rings; /* number of rings in Ringacc module */ 21262306a36Sopenharmony_ci unsigned long *rings_inuse; 21362306a36Sopenharmony_ci struct ti_sci_resource *rm_gp_range; 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_ci bool dma_ring_reset_quirk; 21662306a36Sopenharmony_ci u32 num_proxies; 21762306a36Sopenharmony_ci unsigned long *proxy_inuse; 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci struct k3_ring *rings; 22062306a36Sopenharmony_ci struct list_head list; 22162306a36Sopenharmony_ci struct mutex req_lock; /* protect rings allocation */ 22262306a36Sopenharmony_ci 22362306a36Sopenharmony_ci const struct ti_sci_handle *tisci; 22462306a36Sopenharmony_ci const struct ti_sci_rm_ringacc_ops *tisci_ring_ops; 22562306a36Sopenharmony_ci u32 tisci_dev_id; 22662306a36Sopenharmony_ci 22762306a36Sopenharmony_ci const struct k3_ringacc_ops *ops; 22862306a36Sopenharmony_ci bool dma_rings; 22962306a36Sopenharmony_ci}; 23062306a36Sopenharmony_ci 23162306a36Sopenharmony_ci/** 23262306a36Sopenharmony_ci * struct k3_ringacc_soc_data - Rings accelerator SoC data 23362306a36Sopenharmony_ci * 23462306a36Sopenharmony_ci * @dma_ring_reset_quirk: DMA reset workaround enable 23562306a36Sopenharmony_ci */ 23662306a36Sopenharmony_cistruct k3_ringacc_soc_data { 23762306a36Sopenharmony_ci unsigned dma_ring_reset_quirk:1; 23862306a36Sopenharmony_ci}; 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_cistatic int k3_ringacc_ring_read_occ(struct k3_ring *ring) 24162306a36Sopenharmony_ci{ 24262306a36Sopenharmony_ci return readl(&ring->rt->occ) & K3_RINGACC_RT_OCC_MASK; 24362306a36Sopenharmony_ci} 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_cistatic void k3_ringacc_ring_update_occ(struct k3_ring *ring) 24662306a36Sopenharmony_ci{ 24762306a36Sopenharmony_ci u32 val; 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci val = readl(&ring->rt->occ); 25062306a36Sopenharmony_ci 25162306a36Sopenharmony_ci ring->state.occ = val & K3_RINGACC_RT_OCC_MASK; 25262306a36Sopenharmony_ci ring->state.tdown_complete = !!(val & K3_DMARING_RT_OCC_TDOWN_COMPLETE); 25362306a36Sopenharmony_ci} 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_cistatic long k3_ringacc_ring_get_fifo_pos(struct k3_ring *ring) 25662306a36Sopenharmony_ci{ 25762306a36Sopenharmony_ci return K3_RINGACC_FIFO_WINDOW_SIZE_BYTES - 25862306a36Sopenharmony_ci (4 << ring->elm_size); 25962306a36Sopenharmony_ci} 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_cistatic void *k3_ringacc_get_elm_addr(struct k3_ring *ring, u32 idx) 26262306a36Sopenharmony_ci{ 26362306a36Sopenharmony_ci return (ring->ring_mem_virt + idx * (4 << ring->elm_size)); 26462306a36Sopenharmony_ci} 26562306a36Sopenharmony_ci 26662306a36Sopenharmony_cistatic int k3_ringacc_ring_push_mem(struct k3_ring *ring, void *elem); 26762306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_mem(struct k3_ring *ring, void *elem); 26862306a36Sopenharmony_cistatic int k3_dmaring_fwd_pop(struct k3_ring *ring, void *elem); 26962306a36Sopenharmony_cistatic int k3_dmaring_reverse_pop(struct k3_ring *ring, void *elem); 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_cistatic struct k3_ring_ops k3_ring_mode_ring_ops = { 27262306a36Sopenharmony_ci .push_tail = k3_ringacc_ring_push_mem, 27362306a36Sopenharmony_ci .pop_head = k3_ringacc_ring_pop_mem, 27462306a36Sopenharmony_ci}; 27562306a36Sopenharmony_ci 27662306a36Sopenharmony_cistatic struct k3_ring_ops k3_dmaring_fwd_ops = { 27762306a36Sopenharmony_ci .push_tail = k3_ringacc_ring_push_mem, 27862306a36Sopenharmony_ci .pop_head = k3_dmaring_fwd_pop, 27962306a36Sopenharmony_ci}; 28062306a36Sopenharmony_ci 28162306a36Sopenharmony_cistatic struct k3_ring_ops k3_dmaring_reverse_ops = { 28262306a36Sopenharmony_ci /* Reverse side of the DMA ring can only be popped by SW */ 28362306a36Sopenharmony_ci .pop_head = k3_dmaring_reverse_pop, 28462306a36Sopenharmony_ci}; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_cistatic int k3_ringacc_ring_push_io(struct k3_ring *ring, void *elem); 28762306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_io(struct k3_ring *ring, void *elem); 28862306a36Sopenharmony_cistatic int k3_ringacc_ring_push_head_io(struct k3_ring *ring, void *elem); 28962306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_tail_io(struct k3_ring *ring, void *elem); 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic struct k3_ring_ops k3_ring_mode_msg_ops = { 29262306a36Sopenharmony_ci .push_tail = k3_ringacc_ring_push_io, 29362306a36Sopenharmony_ci .push_head = k3_ringacc_ring_push_head_io, 29462306a36Sopenharmony_ci .pop_tail = k3_ringacc_ring_pop_tail_io, 29562306a36Sopenharmony_ci .pop_head = k3_ringacc_ring_pop_io, 29662306a36Sopenharmony_ci}; 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_cistatic int k3_ringacc_ring_push_head_proxy(struct k3_ring *ring, void *elem); 29962306a36Sopenharmony_cistatic int k3_ringacc_ring_push_tail_proxy(struct k3_ring *ring, void *elem); 30062306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_head_proxy(struct k3_ring *ring, void *elem); 30162306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_tail_proxy(struct k3_ring *ring, void *elem); 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_cistatic struct k3_ring_ops k3_ring_mode_proxy_ops = { 30462306a36Sopenharmony_ci .push_tail = k3_ringacc_ring_push_tail_proxy, 30562306a36Sopenharmony_ci .push_head = k3_ringacc_ring_push_head_proxy, 30662306a36Sopenharmony_ci .pop_tail = k3_ringacc_ring_pop_tail_proxy, 30762306a36Sopenharmony_ci .pop_head = k3_ringacc_ring_pop_head_proxy, 30862306a36Sopenharmony_ci}; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_cistatic void k3_ringacc_ring_dump(struct k3_ring *ring) 31162306a36Sopenharmony_ci{ 31262306a36Sopenharmony_ci struct device *dev = ring->parent->dev; 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci dev_dbg(dev, "dump ring: %d\n", ring->ring_id); 31562306a36Sopenharmony_ci dev_dbg(dev, "dump mem virt %p, dma %pad\n", ring->ring_mem_virt, 31662306a36Sopenharmony_ci &ring->ring_mem_dma); 31762306a36Sopenharmony_ci dev_dbg(dev, "dump elmsize %d, size %d, mode %d, proxy_id %d\n", 31862306a36Sopenharmony_ci ring->elm_size, ring->size, ring->mode, ring->proxy_id); 31962306a36Sopenharmony_ci dev_dbg(dev, "dump flags %08X\n", ring->flags); 32062306a36Sopenharmony_ci 32162306a36Sopenharmony_ci dev_dbg(dev, "dump ring_rt_regs: db%08x\n", readl(&ring->rt->db)); 32262306a36Sopenharmony_ci dev_dbg(dev, "dump occ%08x\n", readl(&ring->rt->occ)); 32362306a36Sopenharmony_ci dev_dbg(dev, "dump indx%08x\n", readl(&ring->rt->indx)); 32462306a36Sopenharmony_ci dev_dbg(dev, "dump hwocc%08x\n", readl(&ring->rt->hwocc)); 32562306a36Sopenharmony_ci dev_dbg(dev, "dump hwindx%08x\n", readl(&ring->rt->hwindx)); 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci if (ring->ring_mem_virt) 32862306a36Sopenharmony_ci print_hex_dump_debug("dump ring_mem_virt ", DUMP_PREFIX_NONE, 32962306a36Sopenharmony_ci 16, 1, ring->ring_mem_virt, 16 * 8, false); 33062306a36Sopenharmony_ci} 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_cistruct k3_ring *k3_ringacc_request_ring(struct k3_ringacc *ringacc, 33362306a36Sopenharmony_ci int id, u32 flags) 33462306a36Sopenharmony_ci{ 33562306a36Sopenharmony_ci int proxy_id = K3_RINGACC_PROXY_NOT_USED; 33662306a36Sopenharmony_ci 33762306a36Sopenharmony_ci mutex_lock(&ringacc->req_lock); 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci if (!try_module_get(ringacc->dev->driver->owner)) 34062306a36Sopenharmony_ci goto err_module_get; 34162306a36Sopenharmony_ci 34262306a36Sopenharmony_ci if (id == K3_RINGACC_RING_ID_ANY) { 34362306a36Sopenharmony_ci /* Request for any general purpose ring */ 34462306a36Sopenharmony_ci struct ti_sci_resource_desc *gp_rings = 34562306a36Sopenharmony_ci &ringacc->rm_gp_range->desc[0]; 34662306a36Sopenharmony_ci unsigned long size; 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci size = gp_rings->start + gp_rings->num; 34962306a36Sopenharmony_ci id = find_next_zero_bit(ringacc->rings_inuse, size, 35062306a36Sopenharmony_ci gp_rings->start); 35162306a36Sopenharmony_ci if (id == size) 35262306a36Sopenharmony_ci goto error; 35362306a36Sopenharmony_ci } else if (id < 0) { 35462306a36Sopenharmony_ci goto error; 35562306a36Sopenharmony_ci } 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_ci if (test_bit(id, ringacc->rings_inuse) && 35862306a36Sopenharmony_ci !(ringacc->rings[id].flags & K3_RING_FLAG_SHARED)) 35962306a36Sopenharmony_ci goto error; 36062306a36Sopenharmony_ci else if (ringacc->rings[id].flags & K3_RING_FLAG_SHARED) 36162306a36Sopenharmony_ci goto out; 36262306a36Sopenharmony_ci 36362306a36Sopenharmony_ci if (flags & K3_RINGACC_RING_USE_PROXY) { 36462306a36Sopenharmony_ci proxy_id = find_first_zero_bit(ringacc->proxy_inuse, 36562306a36Sopenharmony_ci ringacc->num_proxies); 36662306a36Sopenharmony_ci if (proxy_id == ringacc->num_proxies) 36762306a36Sopenharmony_ci goto error; 36862306a36Sopenharmony_ci } 36962306a36Sopenharmony_ci 37062306a36Sopenharmony_ci if (proxy_id != K3_RINGACC_PROXY_NOT_USED) { 37162306a36Sopenharmony_ci set_bit(proxy_id, ringacc->proxy_inuse); 37262306a36Sopenharmony_ci ringacc->rings[id].proxy_id = proxy_id; 37362306a36Sopenharmony_ci dev_dbg(ringacc->dev, "Giving ring#%d proxy#%d\n", id, 37462306a36Sopenharmony_ci proxy_id); 37562306a36Sopenharmony_ci } else { 37662306a36Sopenharmony_ci dev_dbg(ringacc->dev, "Giving ring#%d\n", id); 37762306a36Sopenharmony_ci } 37862306a36Sopenharmony_ci 37962306a36Sopenharmony_ci set_bit(id, ringacc->rings_inuse); 38062306a36Sopenharmony_ciout: 38162306a36Sopenharmony_ci ringacc->rings[id].use_count++; 38262306a36Sopenharmony_ci mutex_unlock(&ringacc->req_lock); 38362306a36Sopenharmony_ci return &ringacc->rings[id]; 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_cierror: 38662306a36Sopenharmony_ci module_put(ringacc->dev->driver->owner); 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_cierr_module_get: 38962306a36Sopenharmony_ci mutex_unlock(&ringacc->req_lock); 39062306a36Sopenharmony_ci return NULL; 39162306a36Sopenharmony_ci} 39262306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_request_ring); 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_cistatic int k3_dmaring_request_dual_ring(struct k3_ringacc *ringacc, int fwd_id, 39562306a36Sopenharmony_ci struct k3_ring **fwd_ring, 39662306a36Sopenharmony_ci struct k3_ring **compl_ring) 39762306a36Sopenharmony_ci{ 39862306a36Sopenharmony_ci int ret = 0; 39962306a36Sopenharmony_ci 40062306a36Sopenharmony_ci /* 40162306a36Sopenharmony_ci * DMA rings must be requested by ID, completion ring is the reverse 40262306a36Sopenharmony_ci * side of the forward ring 40362306a36Sopenharmony_ci */ 40462306a36Sopenharmony_ci if (fwd_id < 0) 40562306a36Sopenharmony_ci return -EINVAL; 40662306a36Sopenharmony_ci 40762306a36Sopenharmony_ci mutex_lock(&ringacc->req_lock); 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci if (!try_module_get(ringacc->dev->driver->owner)) { 41062306a36Sopenharmony_ci ret = -EINVAL; 41162306a36Sopenharmony_ci goto err_module_get; 41262306a36Sopenharmony_ci } 41362306a36Sopenharmony_ci 41462306a36Sopenharmony_ci if (test_bit(fwd_id, ringacc->rings_inuse)) { 41562306a36Sopenharmony_ci ret = -EBUSY; 41662306a36Sopenharmony_ci goto error; 41762306a36Sopenharmony_ci } 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci *fwd_ring = &ringacc->rings[fwd_id]; 42062306a36Sopenharmony_ci *compl_ring = &ringacc->rings[fwd_id + ringacc->num_rings]; 42162306a36Sopenharmony_ci set_bit(fwd_id, ringacc->rings_inuse); 42262306a36Sopenharmony_ci ringacc->rings[fwd_id].use_count++; 42362306a36Sopenharmony_ci dev_dbg(ringacc->dev, "Giving ring#%d\n", fwd_id); 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci mutex_unlock(&ringacc->req_lock); 42662306a36Sopenharmony_ci return 0; 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_cierror: 42962306a36Sopenharmony_ci module_put(ringacc->dev->driver->owner); 43062306a36Sopenharmony_cierr_module_get: 43162306a36Sopenharmony_ci mutex_unlock(&ringacc->req_lock); 43262306a36Sopenharmony_ci return ret; 43362306a36Sopenharmony_ci} 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ciint k3_ringacc_request_rings_pair(struct k3_ringacc *ringacc, 43662306a36Sopenharmony_ci int fwd_id, int compl_id, 43762306a36Sopenharmony_ci struct k3_ring **fwd_ring, 43862306a36Sopenharmony_ci struct k3_ring **compl_ring) 43962306a36Sopenharmony_ci{ 44062306a36Sopenharmony_ci int ret = 0; 44162306a36Sopenharmony_ci 44262306a36Sopenharmony_ci if (!fwd_ring || !compl_ring) 44362306a36Sopenharmony_ci return -EINVAL; 44462306a36Sopenharmony_ci 44562306a36Sopenharmony_ci if (ringacc->dma_rings) 44662306a36Sopenharmony_ci return k3_dmaring_request_dual_ring(ringacc, fwd_id, 44762306a36Sopenharmony_ci fwd_ring, compl_ring); 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_ci *fwd_ring = k3_ringacc_request_ring(ringacc, fwd_id, 0); 45062306a36Sopenharmony_ci if (!(*fwd_ring)) 45162306a36Sopenharmony_ci return -ENODEV; 45262306a36Sopenharmony_ci 45362306a36Sopenharmony_ci *compl_ring = k3_ringacc_request_ring(ringacc, compl_id, 0); 45462306a36Sopenharmony_ci if (!(*compl_ring)) { 45562306a36Sopenharmony_ci k3_ringacc_ring_free(*fwd_ring); 45662306a36Sopenharmony_ci ret = -ENODEV; 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci 45962306a36Sopenharmony_ci return ret; 46062306a36Sopenharmony_ci} 46162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_request_rings_pair); 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_cistatic void k3_ringacc_ring_reset_sci(struct k3_ring *ring) 46462306a36Sopenharmony_ci{ 46562306a36Sopenharmony_ci struct ti_sci_msg_rm_ring_cfg ring_cfg = { 0 }; 46662306a36Sopenharmony_ci struct k3_ringacc *ringacc = ring->parent; 46762306a36Sopenharmony_ci int ret; 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_ci ring_cfg.nav_id = ringacc->tisci_dev_id; 47062306a36Sopenharmony_ci ring_cfg.index = ring->ring_id; 47162306a36Sopenharmony_ci ring_cfg.valid_params = TI_SCI_MSG_VALUE_RM_RING_COUNT_VALID; 47262306a36Sopenharmony_ci ring_cfg.count = ring->size; 47362306a36Sopenharmony_ci 47462306a36Sopenharmony_ci ret = ringacc->tisci_ring_ops->set_cfg(ringacc->tisci, &ring_cfg); 47562306a36Sopenharmony_ci if (ret) 47662306a36Sopenharmony_ci dev_err(ringacc->dev, "TISCI reset ring fail (%d) ring_idx %d\n", 47762306a36Sopenharmony_ci ret, ring->ring_id); 47862306a36Sopenharmony_ci} 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_civoid k3_ringacc_ring_reset(struct k3_ring *ring) 48162306a36Sopenharmony_ci{ 48262306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 48362306a36Sopenharmony_ci return; 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci memset(&ring->state, 0, sizeof(ring->state)); 48662306a36Sopenharmony_ci 48762306a36Sopenharmony_ci k3_ringacc_ring_reset_sci(ring); 48862306a36Sopenharmony_ci} 48962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_reset); 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_cistatic void k3_ringacc_ring_reconfig_qmode_sci(struct k3_ring *ring, 49262306a36Sopenharmony_ci enum k3_ring_mode mode) 49362306a36Sopenharmony_ci{ 49462306a36Sopenharmony_ci struct ti_sci_msg_rm_ring_cfg ring_cfg = { 0 }; 49562306a36Sopenharmony_ci struct k3_ringacc *ringacc = ring->parent; 49662306a36Sopenharmony_ci int ret; 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci ring_cfg.nav_id = ringacc->tisci_dev_id; 49962306a36Sopenharmony_ci ring_cfg.index = ring->ring_id; 50062306a36Sopenharmony_ci ring_cfg.valid_params = TI_SCI_MSG_VALUE_RM_RING_MODE_VALID; 50162306a36Sopenharmony_ci ring_cfg.mode = mode; 50262306a36Sopenharmony_ci 50362306a36Sopenharmony_ci ret = ringacc->tisci_ring_ops->set_cfg(ringacc->tisci, &ring_cfg); 50462306a36Sopenharmony_ci if (ret) 50562306a36Sopenharmony_ci dev_err(ringacc->dev, "TISCI reconf qmode fail (%d) ring_idx %d\n", 50662306a36Sopenharmony_ci ret, ring->ring_id); 50762306a36Sopenharmony_ci} 50862306a36Sopenharmony_ci 50962306a36Sopenharmony_civoid k3_ringacc_ring_reset_dma(struct k3_ring *ring, u32 occ) 51062306a36Sopenharmony_ci{ 51162306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 51262306a36Sopenharmony_ci return; 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci if (!ring->parent->dma_ring_reset_quirk) 51562306a36Sopenharmony_ci goto reset; 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci if (!occ) 51862306a36Sopenharmony_ci occ = k3_ringacc_ring_read_occ(ring); 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci if (occ) { 52162306a36Sopenharmony_ci u32 db_ring_cnt, db_ring_cnt_cur; 52262306a36Sopenharmony_ci 52362306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "%s %u occ: %u\n", __func__, 52462306a36Sopenharmony_ci ring->ring_id, occ); 52562306a36Sopenharmony_ci /* TI-SCI ring reset */ 52662306a36Sopenharmony_ci k3_ringacc_ring_reset_sci(ring); 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci /* 52962306a36Sopenharmony_ci * Setup the ring in ring/doorbell mode (if not already in this 53062306a36Sopenharmony_ci * mode) 53162306a36Sopenharmony_ci */ 53262306a36Sopenharmony_ci if (ring->mode != K3_RINGACC_RING_MODE_RING) 53362306a36Sopenharmony_ci k3_ringacc_ring_reconfig_qmode_sci( 53462306a36Sopenharmony_ci ring, K3_RINGACC_RING_MODE_RING); 53562306a36Sopenharmony_ci /* 53662306a36Sopenharmony_ci * Ring the doorbell 2**22 – ringOcc times. 53762306a36Sopenharmony_ci * This will wrap the internal UDMAP ring state occupancy 53862306a36Sopenharmony_ci * counter (which is 21-bits wide) to 0. 53962306a36Sopenharmony_ci */ 54062306a36Sopenharmony_ci db_ring_cnt = (1U << 22) - occ; 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci while (db_ring_cnt != 0) { 54362306a36Sopenharmony_ci /* 54462306a36Sopenharmony_ci * Ring the doorbell with the maximum count each 54562306a36Sopenharmony_ci * iteration if possible to minimize the total 54662306a36Sopenharmony_ci * of writes 54762306a36Sopenharmony_ci */ 54862306a36Sopenharmony_ci if (db_ring_cnt > K3_RINGACC_MAX_DB_RING_CNT) 54962306a36Sopenharmony_ci db_ring_cnt_cur = K3_RINGACC_MAX_DB_RING_CNT; 55062306a36Sopenharmony_ci else 55162306a36Sopenharmony_ci db_ring_cnt_cur = db_ring_cnt; 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_ci writel(db_ring_cnt_cur, &ring->rt->db); 55462306a36Sopenharmony_ci db_ring_cnt -= db_ring_cnt_cur; 55562306a36Sopenharmony_ci } 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_ci /* Restore the original ring mode (if not ring mode) */ 55862306a36Sopenharmony_ci if (ring->mode != K3_RINGACC_RING_MODE_RING) 55962306a36Sopenharmony_ci k3_ringacc_ring_reconfig_qmode_sci(ring, ring->mode); 56062306a36Sopenharmony_ci } 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_cireset: 56362306a36Sopenharmony_ci /* Reset the ring */ 56462306a36Sopenharmony_ci k3_ringacc_ring_reset(ring); 56562306a36Sopenharmony_ci} 56662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_reset_dma); 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_cistatic void k3_ringacc_ring_free_sci(struct k3_ring *ring) 56962306a36Sopenharmony_ci{ 57062306a36Sopenharmony_ci struct ti_sci_msg_rm_ring_cfg ring_cfg = { 0 }; 57162306a36Sopenharmony_ci struct k3_ringacc *ringacc = ring->parent; 57262306a36Sopenharmony_ci int ret; 57362306a36Sopenharmony_ci 57462306a36Sopenharmony_ci ring_cfg.nav_id = ringacc->tisci_dev_id; 57562306a36Sopenharmony_ci ring_cfg.index = ring->ring_id; 57662306a36Sopenharmony_ci ring_cfg.valid_params = TI_SCI_MSG_VALUE_RM_ALL_NO_ORDER; 57762306a36Sopenharmony_ci 57862306a36Sopenharmony_ci ret = ringacc->tisci_ring_ops->set_cfg(ringacc->tisci, &ring_cfg); 57962306a36Sopenharmony_ci if (ret) 58062306a36Sopenharmony_ci dev_err(ringacc->dev, "TISCI ring free fail (%d) ring_idx %d\n", 58162306a36Sopenharmony_ci ret, ring->ring_id); 58262306a36Sopenharmony_ci} 58362306a36Sopenharmony_ci 58462306a36Sopenharmony_ciint k3_ringacc_ring_free(struct k3_ring *ring) 58562306a36Sopenharmony_ci{ 58662306a36Sopenharmony_ci struct k3_ringacc *ringacc; 58762306a36Sopenharmony_ci 58862306a36Sopenharmony_ci if (!ring) 58962306a36Sopenharmony_ci return -EINVAL; 59062306a36Sopenharmony_ci 59162306a36Sopenharmony_ci ringacc = ring->parent; 59262306a36Sopenharmony_ci 59362306a36Sopenharmony_ci /* 59462306a36Sopenharmony_ci * DMA rings: rings shared memory and configuration, only forward ring 59562306a36Sopenharmony_ci * is configured and reverse ring considered as slave. 59662306a36Sopenharmony_ci */ 59762306a36Sopenharmony_ci if (ringacc->dma_rings && (ring->flags & K3_RING_FLAG_REVERSE)) 59862306a36Sopenharmony_ci return 0; 59962306a36Sopenharmony_ci 60062306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "flags: 0x%08x\n", ring->flags); 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_ci if (!test_bit(ring->ring_id, ringacc->rings_inuse)) 60362306a36Sopenharmony_ci return -EINVAL; 60462306a36Sopenharmony_ci 60562306a36Sopenharmony_ci mutex_lock(&ringacc->req_lock); 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci if (--ring->use_count) 60862306a36Sopenharmony_ci goto out; 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_ci if (!(ring->flags & K3_RING_FLAG_BUSY)) 61162306a36Sopenharmony_ci goto no_init; 61262306a36Sopenharmony_ci 61362306a36Sopenharmony_ci k3_ringacc_ring_free_sci(ring); 61462306a36Sopenharmony_ci 61562306a36Sopenharmony_ci dma_free_coherent(ring->dma_dev, 61662306a36Sopenharmony_ci ring->size * (4 << ring->elm_size), 61762306a36Sopenharmony_ci ring->ring_mem_virt, ring->ring_mem_dma); 61862306a36Sopenharmony_ci ring->flags = 0; 61962306a36Sopenharmony_ci ring->ops = NULL; 62062306a36Sopenharmony_ci ring->dma_dev = NULL; 62162306a36Sopenharmony_ci ring->asel = 0; 62262306a36Sopenharmony_ci 62362306a36Sopenharmony_ci if (ring->proxy_id != K3_RINGACC_PROXY_NOT_USED) { 62462306a36Sopenharmony_ci clear_bit(ring->proxy_id, ringacc->proxy_inuse); 62562306a36Sopenharmony_ci ring->proxy = NULL; 62662306a36Sopenharmony_ci ring->proxy_id = K3_RINGACC_PROXY_NOT_USED; 62762306a36Sopenharmony_ci } 62862306a36Sopenharmony_ci 62962306a36Sopenharmony_cino_init: 63062306a36Sopenharmony_ci clear_bit(ring->ring_id, ringacc->rings_inuse); 63162306a36Sopenharmony_ci 63262306a36Sopenharmony_ci module_put(ringacc->dev->driver->owner); 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_ciout: 63562306a36Sopenharmony_ci mutex_unlock(&ringacc->req_lock); 63662306a36Sopenharmony_ci return 0; 63762306a36Sopenharmony_ci} 63862306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_free); 63962306a36Sopenharmony_ci 64062306a36Sopenharmony_ciu32 k3_ringacc_get_ring_id(struct k3_ring *ring) 64162306a36Sopenharmony_ci{ 64262306a36Sopenharmony_ci if (!ring) 64362306a36Sopenharmony_ci return -EINVAL; 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_ci return ring->ring_id; 64662306a36Sopenharmony_ci} 64762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_get_ring_id); 64862306a36Sopenharmony_ci 64962306a36Sopenharmony_ciu32 k3_ringacc_get_tisci_dev_id(struct k3_ring *ring) 65062306a36Sopenharmony_ci{ 65162306a36Sopenharmony_ci if (!ring) 65262306a36Sopenharmony_ci return -EINVAL; 65362306a36Sopenharmony_ci 65462306a36Sopenharmony_ci return ring->parent->tisci_dev_id; 65562306a36Sopenharmony_ci} 65662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_get_tisci_dev_id); 65762306a36Sopenharmony_ci 65862306a36Sopenharmony_ciint k3_ringacc_get_ring_irq_num(struct k3_ring *ring) 65962306a36Sopenharmony_ci{ 66062306a36Sopenharmony_ci int irq_num; 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci if (!ring) 66362306a36Sopenharmony_ci return -EINVAL; 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci irq_num = msi_get_virq(ring->parent->dev, ring->ring_id); 66662306a36Sopenharmony_ci if (irq_num <= 0) 66762306a36Sopenharmony_ci irq_num = -EINVAL; 66862306a36Sopenharmony_ci return irq_num; 66962306a36Sopenharmony_ci} 67062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_get_ring_irq_num); 67162306a36Sopenharmony_ci 67262306a36Sopenharmony_cistatic int k3_ringacc_ring_cfg_sci(struct k3_ring *ring) 67362306a36Sopenharmony_ci{ 67462306a36Sopenharmony_ci struct ti_sci_msg_rm_ring_cfg ring_cfg = { 0 }; 67562306a36Sopenharmony_ci struct k3_ringacc *ringacc = ring->parent; 67662306a36Sopenharmony_ci int ret; 67762306a36Sopenharmony_ci 67862306a36Sopenharmony_ci if (!ringacc->tisci) 67962306a36Sopenharmony_ci return -EINVAL; 68062306a36Sopenharmony_ci 68162306a36Sopenharmony_ci ring_cfg.nav_id = ringacc->tisci_dev_id; 68262306a36Sopenharmony_ci ring_cfg.index = ring->ring_id; 68362306a36Sopenharmony_ci ring_cfg.valid_params = TI_SCI_MSG_VALUE_RM_ALL_NO_ORDER; 68462306a36Sopenharmony_ci ring_cfg.addr_lo = lower_32_bits(ring->ring_mem_dma); 68562306a36Sopenharmony_ci ring_cfg.addr_hi = upper_32_bits(ring->ring_mem_dma); 68662306a36Sopenharmony_ci ring_cfg.count = ring->size; 68762306a36Sopenharmony_ci ring_cfg.mode = ring->mode; 68862306a36Sopenharmony_ci ring_cfg.size = ring->elm_size; 68962306a36Sopenharmony_ci ring_cfg.asel = ring->asel; 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_ci ret = ringacc->tisci_ring_ops->set_cfg(ringacc->tisci, &ring_cfg); 69262306a36Sopenharmony_ci if (ret) 69362306a36Sopenharmony_ci dev_err(ringacc->dev, "TISCI config ring fail (%d) ring_idx %d\n", 69462306a36Sopenharmony_ci ret, ring->ring_id); 69562306a36Sopenharmony_ci 69662306a36Sopenharmony_ci return ret; 69762306a36Sopenharmony_ci} 69862306a36Sopenharmony_ci 69962306a36Sopenharmony_cistatic int k3_dmaring_cfg(struct k3_ring *ring, struct k3_ring_cfg *cfg) 70062306a36Sopenharmony_ci{ 70162306a36Sopenharmony_ci struct k3_ringacc *ringacc; 70262306a36Sopenharmony_ci struct k3_ring *reverse_ring; 70362306a36Sopenharmony_ci int ret = 0; 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci if (cfg->elm_size != K3_RINGACC_RING_ELSIZE_8 || 70662306a36Sopenharmony_ci cfg->mode != K3_RINGACC_RING_MODE_RING || 70762306a36Sopenharmony_ci cfg->size & ~K3_DMARING_CFG_RING_SIZE_ELCNT_MASK) 70862306a36Sopenharmony_ci return -EINVAL; 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci ringacc = ring->parent; 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ci /* 71362306a36Sopenharmony_ci * DMA rings: rings shared memory and configuration, only forward ring 71462306a36Sopenharmony_ci * is configured and reverse ring considered as slave. 71562306a36Sopenharmony_ci */ 71662306a36Sopenharmony_ci if (ringacc->dma_rings && (ring->flags & K3_RING_FLAG_REVERSE)) 71762306a36Sopenharmony_ci return 0; 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci if (!test_bit(ring->ring_id, ringacc->rings_inuse)) 72062306a36Sopenharmony_ci return -EINVAL; 72162306a36Sopenharmony_ci 72262306a36Sopenharmony_ci ring->size = cfg->size; 72362306a36Sopenharmony_ci ring->elm_size = cfg->elm_size; 72462306a36Sopenharmony_ci ring->mode = cfg->mode; 72562306a36Sopenharmony_ci ring->asel = cfg->asel; 72662306a36Sopenharmony_ci ring->dma_dev = cfg->dma_dev; 72762306a36Sopenharmony_ci if (!ring->dma_dev) { 72862306a36Sopenharmony_ci dev_warn(ringacc->dev, "dma_dev is not provided for ring%d\n", 72962306a36Sopenharmony_ci ring->ring_id); 73062306a36Sopenharmony_ci ring->dma_dev = ringacc->dev; 73162306a36Sopenharmony_ci } 73262306a36Sopenharmony_ci 73362306a36Sopenharmony_ci memset(&ring->state, 0, sizeof(ring->state)); 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci ring->ops = &k3_dmaring_fwd_ops; 73662306a36Sopenharmony_ci 73762306a36Sopenharmony_ci ring->ring_mem_virt = dma_alloc_coherent(ring->dma_dev, 73862306a36Sopenharmony_ci ring->size * (4 << ring->elm_size), 73962306a36Sopenharmony_ci &ring->ring_mem_dma, GFP_KERNEL); 74062306a36Sopenharmony_ci if (!ring->ring_mem_virt) { 74162306a36Sopenharmony_ci dev_err(ringacc->dev, "Failed to alloc ring mem\n"); 74262306a36Sopenharmony_ci ret = -ENOMEM; 74362306a36Sopenharmony_ci goto err_free_ops; 74462306a36Sopenharmony_ci } 74562306a36Sopenharmony_ci 74662306a36Sopenharmony_ci ret = k3_ringacc_ring_cfg_sci(ring); 74762306a36Sopenharmony_ci if (ret) 74862306a36Sopenharmony_ci goto err_free_mem; 74962306a36Sopenharmony_ci 75062306a36Sopenharmony_ci ring->flags |= K3_RING_FLAG_BUSY; 75162306a36Sopenharmony_ci 75262306a36Sopenharmony_ci k3_ringacc_ring_dump(ring); 75362306a36Sopenharmony_ci 75462306a36Sopenharmony_ci /* DMA rings: configure reverse ring */ 75562306a36Sopenharmony_ci reverse_ring = &ringacc->rings[ring->ring_id + ringacc->num_rings]; 75662306a36Sopenharmony_ci reverse_ring->size = cfg->size; 75762306a36Sopenharmony_ci reverse_ring->elm_size = cfg->elm_size; 75862306a36Sopenharmony_ci reverse_ring->mode = cfg->mode; 75962306a36Sopenharmony_ci reverse_ring->asel = cfg->asel; 76062306a36Sopenharmony_ci memset(&reverse_ring->state, 0, sizeof(reverse_ring->state)); 76162306a36Sopenharmony_ci reverse_ring->ops = &k3_dmaring_reverse_ops; 76262306a36Sopenharmony_ci 76362306a36Sopenharmony_ci reverse_ring->ring_mem_virt = ring->ring_mem_virt; 76462306a36Sopenharmony_ci reverse_ring->ring_mem_dma = ring->ring_mem_dma; 76562306a36Sopenharmony_ci reverse_ring->flags |= K3_RING_FLAG_BUSY; 76662306a36Sopenharmony_ci k3_ringacc_ring_dump(reverse_ring); 76762306a36Sopenharmony_ci 76862306a36Sopenharmony_ci return 0; 76962306a36Sopenharmony_ci 77062306a36Sopenharmony_cierr_free_mem: 77162306a36Sopenharmony_ci dma_free_coherent(ring->dma_dev, 77262306a36Sopenharmony_ci ring->size * (4 << ring->elm_size), 77362306a36Sopenharmony_ci ring->ring_mem_virt, 77462306a36Sopenharmony_ci ring->ring_mem_dma); 77562306a36Sopenharmony_cierr_free_ops: 77662306a36Sopenharmony_ci ring->ops = NULL; 77762306a36Sopenharmony_ci ring->proxy = NULL; 77862306a36Sopenharmony_ci ring->dma_dev = NULL; 77962306a36Sopenharmony_ci ring->asel = 0; 78062306a36Sopenharmony_ci return ret; 78162306a36Sopenharmony_ci} 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ciint k3_ringacc_ring_cfg(struct k3_ring *ring, struct k3_ring_cfg *cfg) 78462306a36Sopenharmony_ci{ 78562306a36Sopenharmony_ci struct k3_ringacc *ringacc; 78662306a36Sopenharmony_ci int ret = 0; 78762306a36Sopenharmony_ci 78862306a36Sopenharmony_ci if (!ring || !cfg) 78962306a36Sopenharmony_ci return -EINVAL; 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_ci ringacc = ring->parent; 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_ci if (ringacc->dma_rings) 79462306a36Sopenharmony_ci return k3_dmaring_cfg(ring, cfg); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci if (cfg->elm_size > K3_RINGACC_RING_ELSIZE_256 || 79762306a36Sopenharmony_ci cfg->mode >= K3_RINGACC_RING_MODE_INVALID || 79862306a36Sopenharmony_ci cfg->size & ~K3_RINGACC_CFG_RING_SIZE_ELCNT_MASK || 79962306a36Sopenharmony_ci !test_bit(ring->ring_id, ringacc->rings_inuse)) 80062306a36Sopenharmony_ci return -EINVAL; 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_ci if (cfg->mode == K3_RINGACC_RING_MODE_MESSAGE && 80362306a36Sopenharmony_ci ring->proxy_id == K3_RINGACC_PROXY_NOT_USED && 80462306a36Sopenharmony_ci cfg->elm_size > K3_RINGACC_RING_ELSIZE_8) { 80562306a36Sopenharmony_ci dev_err(ringacc->dev, 80662306a36Sopenharmony_ci "Message mode must use proxy for %u element size\n", 80762306a36Sopenharmony_ci 4 << ring->elm_size); 80862306a36Sopenharmony_ci return -EINVAL; 80962306a36Sopenharmony_ci } 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci /* 81262306a36Sopenharmony_ci * In case of shared ring only the first user (master user) can 81362306a36Sopenharmony_ci * configure the ring. The sequence should be by the client: 81462306a36Sopenharmony_ci * ring = k3_ringacc_request_ring(ringacc, ring_id, 0); # master user 81562306a36Sopenharmony_ci * k3_ringacc_ring_cfg(ring, cfg); # master configuration 81662306a36Sopenharmony_ci * k3_ringacc_request_ring(ringacc, ring_id, K3_RING_FLAG_SHARED); 81762306a36Sopenharmony_ci * k3_ringacc_request_ring(ringacc, ring_id, K3_RING_FLAG_SHARED); 81862306a36Sopenharmony_ci */ 81962306a36Sopenharmony_ci if (ring->use_count != 1) 82062306a36Sopenharmony_ci return 0; 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_ci ring->size = cfg->size; 82362306a36Sopenharmony_ci ring->elm_size = cfg->elm_size; 82462306a36Sopenharmony_ci ring->mode = cfg->mode; 82562306a36Sopenharmony_ci memset(&ring->state, 0, sizeof(ring->state)); 82662306a36Sopenharmony_ci 82762306a36Sopenharmony_ci if (ring->proxy_id != K3_RINGACC_PROXY_NOT_USED) 82862306a36Sopenharmony_ci ring->proxy = ringacc->proxy_target_base + 82962306a36Sopenharmony_ci ring->proxy_id * K3_RINGACC_PROXY_TARGET_STEP; 83062306a36Sopenharmony_ci 83162306a36Sopenharmony_ci switch (ring->mode) { 83262306a36Sopenharmony_ci case K3_RINGACC_RING_MODE_RING: 83362306a36Sopenharmony_ci ring->ops = &k3_ring_mode_ring_ops; 83462306a36Sopenharmony_ci ring->dma_dev = cfg->dma_dev; 83562306a36Sopenharmony_ci if (!ring->dma_dev) 83662306a36Sopenharmony_ci ring->dma_dev = ringacc->dev; 83762306a36Sopenharmony_ci break; 83862306a36Sopenharmony_ci case K3_RINGACC_RING_MODE_MESSAGE: 83962306a36Sopenharmony_ci ring->dma_dev = ringacc->dev; 84062306a36Sopenharmony_ci if (ring->proxy) 84162306a36Sopenharmony_ci ring->ops = &k3_ring_mode_proxy_ops; 84262306a36Sopenharmony_ci else 84362306a36Sopenharmony_ci ring->ops = &k3_ring_mode_msg_ops; 84462306a36Sopenharmony_ci break; 84562306a36Sopenharmony_ci default: 84662306a36Sopenharmony_ci ring->ops = NULL; 84762306a36Sopenharmony_ci ret = -EINVAL; 84862306a36Sopenharmony_ci goto err_free_proxy; 84962306a36Sopenharmony_ci } 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_ci ring->ring_mem_virt = dma_alloc_coherent(ring->dma_dev, 85262306a36Sopenharmony_ci ring->size * (4 << ring->elm_size), 85362306a36Sopenharmony_ci &ring->ring_mem_dma, GFP_KERNEL); 85462306a36Sopenharmony_ci if (!ring->ring_mem_virt) { 85562306a36Sopenharmony_ci dev_err(ringacc->dev, "Failed to alloc ring mem\n"); 85662306a36Sopenharmony_ci ret = -ENOMEM; 85762306a36Sopenharmony_ci goto err_free_ops; 85862306a36Sopenharmony_ci } 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_ci ret = k3_ringacc_ring_cfg_sci(ring); 86162306a36Sopenharmony_ci 86262306a36Sopenharmony_ci if (ret) 86362306a36Sopenharmony_ci goto err_free_mem; 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci ring->flags |= K3_RING_FLAG_BUSY; 86662306a36Sopenharmony_ci ring->flags |= (cfg->flags & K3_RINGACC_RING_SHARED) ? 86762306a36Sopenharmony_ci K3_RING_FLAG_SHARED : 0; 86862306a36Sopenharmony_ci 86962306a36Sopenharmony_ci k3_ringacc_ring_dump(ring); 87062306a36Sopenharmony_ci 87162306a36Sopenharmony_ci return 0; 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_cierr_free_mem: 87462306a36Sopenharmony_ci dma_free_coherent(ring->dma_dev, 87562306a36Sopenharmony_ci ring->size * (4 << ring->elm_size), 87662306a36Sopenharmony_ci ring->ring_mem_virt, 87762306a36Sopenharmony_ci ring->ring_mem_dma); 87862306a36Sopenharmony_cierr_free_ops: 87962306a36Sopenharmony_ci ring->ops = NULL; 88062306a36Sopenharmony_ci ring->dma_dev = NULL; 88162306a36Sopenharmony_cierr_free_proxy: 88262306a36Sopenharmony_ci ring->proxy = NULL; 88362306a36Sopenharmony_ci return ret; 88462306a36Sopenharmony_ci} 88562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_cfg); 88662306a36Sopenharmony_ci 88762306a36Sopenharmony_ciu32 k3_ringacc_ring_get_size(struct k3_ring *ring) 88862306a36Sopenharmony_ci{ 88962306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 89062306a36Sopenharmony_ci return -EINVAL; 89162306a36Sopenharmony_ci 89262306a36Sopenharmony_ci return ring->size; 89362306a36Sopenharmony_ci} 89462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_get_size); 89562306a36Sopenharmony_ci 89662306a36Sopenharmony_ciu32 k3_ringacc_ring_get_free(struct k3_ring *ring) 89762306a36Sopenharmony_ci{ 89862306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 89962306a36Sopenharmony_ci return -EINVAL; 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_ci if (!ring->state.free) 90262306a36Sopenharmony_ci ring->state.free = ring->size - k3_ringacc_ring_read_occ(ring); 90362306a36Sopenharmony_ci 90462306a36Sopenharmony_ci return ring->state.free; 90562306a36Sopenharmony_ci} 90662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_get_free); 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ciu32 k3_ringacc_ring_get_occ(struct k3_ring *ring) 90962306a36Sopenharmony_ci{ 91062306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 91162306a36Sopenharmony_ci return -EINVAL; 91262306a36Sopenharmony_ci 91362306a36Sopenharmony_ci return k3_ringacc_ring_read_occ(ring); 91462306a36Sopenharmony_ci} 91562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_get_occ); 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_ciu32 k3_ringacc_ring_is_full(struct k3_ring *ring) 91862306a36Sopenharmony_ci{ 91962306a36Sopenharmony_ci return !k3_ringacc_ring_get_free(ring); 92062306a36Sopenharmony_ci} 92162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_is_full); 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_cienum k3_ringacc_access_mode { 92462306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_HEAD, 92562306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_HEAD, 92662306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_TAIL, 92762306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_TAIL, 92862306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PEEK_HEAD, 92962306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PEEK_TAIL, 93062306a36Sopenharmony_ci}; 93162306a36Sopenharmony_ci 93262306a36Sopenharmony_ci#define K3_RINGACC_PROXY_MODE(x) (((x) & 0x3) << 16) 93362306a36Sopenharmony_ci#define K3_RINGACC_PROXY_ELSIZE(x) (((x) & 0x7) << 24) 93462306a36Sopenharmony_cistatic int k3_ringacc_ring_cfg_proxy(struct k3_ring *ring, 93562306a36Sopenharmony_ci enum k3_ringacc_proxy_access_mode mode) 93662306a36Sopenharmony_ci{ 93762306a36Sopenharmony_ci u32 val; 93862306a36Sopenharmony_ci 93962306a36Sopenharmony_ci val = ring->ring_id; 94062306a36Sopenharmony_ci val |= K3_RINGACC_PROXY_MODE(mode); 94162306a36Sopenharmony_ci val |= K3_RINGACC_PROXY_ELSIZE(ring->elm_size); 94262306a36Sopenharmony_ci writel(val, &ring->proxy->control); 94362306a36Sopenharmony_ci return 0; 94462306a36Sopenharmony_ci} 94562306a36Sopenharmony_ci 94662306a36Sopenharmony_cistatic int k3_ringacc_ring_access_proxy(struct k3_ring *ring, void *elem, 94762306a36Sopenharmony_ci enum k3_ringacc_access_mode access_mode) 94862306a36Sopenharmony_ci{ 94962306a36Sopenharmony_ci void __iomem *ptr; 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci ptr = (void __iomem *)&ring->proxy->data; 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_ci switch (access_mode) { 95462306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_HEAD: 95562306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_HEAD: 95662306a36Sopenharmony_ci k3_ringacc_ring_cfg_proxy(ring, PROXY_ACCESS_MODE_HEAD); 95762306a36Sopenharmony_ci break; 95862306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_TAIL: 95962306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_TAIL: 96062306a36Sopenharmony_ci k3_ringacc_ring_cfg_proxy(ring, PROXY_ACCESS_MODE_TAIL); 96162306a36Sopenharmony_ci break; 96262306a36Sopenharmony_ci default: 96362306a36Sopenharmony_ci return -EINVAL; 96462306a36Sopenharmony_ci } 96562306a36Sopenharmony_ci 96662306a36Sopenharmony_ci ptr += k3_ringacc_ring_get_fifo_pos(ring); 96762306a36Sopenharmony_ci 96862306a36Sopenharmony_ci switch (access_mode) { 96962306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_HEAD: 97062306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_TAIL: 97162306a36Sopenharmony_ci dev_dbg(ring->parent->dev, 97262306a36Sopenharmony_ci "proxy:memcpy_fromio(x): --> ptr(%p), mode:%d\n", ptr, 97362306a36Sopenharmony_ci access_mode); 97462306a36Sopenharmony_ci memcpy_fromio(elem, ptr, (4 << ring->elm_size)); 97562306a36Sopenharmony_ci ring->state.occ--; 97662306a36Sopenharmony_ci break; 97762306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_TAIL: 97862306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_HEAD: 97962306a36Sopenharmony_ci dev_dbg(ring->parent->dev, 98062306a36Sopenharmony_ci "proxy:memcpy_toio(x): --> ptr(%p), mode:%d\n", ptr, 98162306a36Sopenharmony_ci access_mode); 98262306a36Sopenharmony_ci memcpy_toio(ptr, elem, (4 << ring->elm_size)); 98362306a36Sopenharmony_ci ring->state.free--; 98462306a36Sopenharmony_ci break; 98562306a36Sopenharmony_ci default: 98662306a36Sopenharmony_ci return -EINVAL; 98762306a36Sopenharmony_ci } 98862306a36Sopenharmony_ci 98962306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "proxy: free%d occ%d\n", ring->state.free, 99062306a36Sopenharmony_ci ring->state.occ); 99162306a36Sopenharmony_ci return 0; 99262306a36Sopenharmony_ci} 99362306a36Sopenharmony_ci 99462306a36Sopenharmony_cistatic int k3_ringacc_ring_push_head_proxy(struct k3_ring *ring, void *elem) 99562306a36Sopenharmony_ci{ 99662306a36Sopenharmony_ci return k3_ringacc_ring_access_proxy(ring, elem, 99762306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_HEAD); 99862306a36Sopenharmony_ci} 99962306a36Sopenharmony_ci 100062306a36Sopenharmony_cistatic int k3_ringacc_ring_push_tail_proxy(struct k3_ring *ring, void *elem) 100162306a36Sopenharmony_ci{ 100262306a36Sopenharmony_ci return k3_ringacc_ring_access_proxy(ring, elem, 100362306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_TAIL); 100462306a36Sopenharmony_ci} 100562306a36Sopenharmony_ci 100662306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_head_proxy(struct k3_ring *ring, void *elem) 100762306a36Sopenharmony_ci{ 100862306a36Sopenharmony_ci return k3_ringacc_ring_access_proxy(ring, elem, 100962306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_HEAD); 101062306a36Sopenharmony_ci} 101162306a36Sopenharmony_ci 101262306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_tail_proxy(struct k3_ring *ring, void *elem) 101362306a36Sopenharmony_ci{ 101462306a36Sopenharmony_ci return k3_ringacc_ring_access_proxy(ring, elem, 101562306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_HEAD); 101662306a36Sopenharmony_ci} 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_cistatic int k3_ringacc_ring_access_io(struct k3_ring *ring, void *elem, 101962306a36Sopenharmony_ci enum k3_ringacc_access_mode access_mode) 102062306a36Sopenharmony_ci{ 102162306a36Sopenharmony_ci void __iomem *ptr; 102262306a36Sopenharmony_ci 102362306a36Sopenharmony_ci switch (access_mode) { 102462306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_HEAD: 102562306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_HEAD: 102662306a36Sopenharmony_ci ptr = (void __iomem *)&ring->fifos->head_data; 102762306a36Sopenharmony_ci break; 102862306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_TAIL: 102962306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_TAIL: 103062306a36Sopenharmony_ci ptr = (void __iomem *)&ring->fifos->tail_data; 103162306a36Sopenharmony_ci break; 103262306a36Sopenharmony_ci default: 103362306a36Sopenharmony_ci return -EINVAL; 103462306a36Sopenharmony_ci } 103562306a36Sopenharmony_ci 103662306a36Sopenharmony_ci ptr += k3_ringacc_ring_get_fifo_pos(ring); 103762306a36Sopenharmony_ci 103862306a36Sopenharmony_ci switch (access_mode) { 103962306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_HEAD: 104062306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_POP_TAIL: 104162306a36Sopenharmony_ci dev_dbg(ring->parent->dev, 104262306a36Sopenharmony_ci "memcpy_fromio(x): --> ptr(%p), mode:%d\n", ptr, 104362306a36Sopenharmony_ci access_mode); 104462306a36Sopenharmony_ci memcpy_fromio(elem, ptr, (4 << ring->elm_size)); 104562306a36Sopenharmony_ci ring->state.occ--; 104662306a36Sopenharmony_ci break; 104762306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_TAIL: 104862306a36Sopenharmony_ci case K3_RINGACC_ACCESS_MODE_PUSH_HEAD: 104962306a36Sopenharmony_ci dev_dbg(ring->parent->dev, 105062306a36Sopenharmony_ci "memcpy_toio(x): --> ptr(%p), mode:%d\n", ptr, 105162306a36Sopenharmony_ci access_mode); 105262306a36Sopenharmony_ci memcpy_toio(ptr, elem, (4 << ring->elm_size)); 105362306a36Sopenharmony_ci ring->state.free--; 105462306a36Sopenharmony_ci break; 105562306a36Sopenharmony_ci default: 105662306a36Sopenharmony_ci return -EINVAL; 105762306a36Sopenharmony_ci } 105862306a36Sopenharmony_ci 105962306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "free%d index%d occ%d index%d\n", 106062306a36Sopenharmony_ci ring->state.free, ring->state.windex, ring->state.occ, 106162306a36Sopenharmony_ci ring->state.rindex); 106262306a36Sopenharmony_ci return 0; 106362306a36Sopenharmony_ci} 106462306a36Sopenharmony_ci 106562306a36Sopenharmony_cistatic int k3_ringacc_ring_push_head_io(struct k3_ring *ring, void *elem) 106662306a36Sopenharmony_ci{ 106762306a36Sopenharmony_ci return k3_ringacc_ring_access_io(ring, elem, 106862306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_HEAD); 106962306a36Sopenharmony_ci} 107062306a36Sopenharmony_ci 107162306a36Sopenharmony_cistatic int k3_ringacc_ring_push_io(struct k3_ring *ring, void *elem) 107262306a36Sopenharmony_ci{ 107362306a36Sopenharmony_ci return k3_ringacc_ring_access_io(ring, elem, 107462306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_PUSH_TAIL); 107562306a36Sopenharmony_ci} 107662306a36Sopenharmony_ci 107762306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_io(struct k3_ring *ring, void *elem) 107862306a36Sopenharmony_ci{ 107962306a36Sopenharmony_ci return k3_ringacc_ring_access_io(ring, elem, 108062306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_HEAD); 108162306a36Sopenharmony_ci} 108262306a36Sopenharmony_ci 108362306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_tail_io(struct k3_ring *ring, void *elem) 108462306a36Sopenharmony_ci{ 108562306a36Sopenharmony_ci return k3_ringacc_ring_access_io(ring, elem, 108662306a36Sopenharmony_ci K3_RINGACC_ACCESS_MODE_POP_HEAD); 108762306a36Sopenharmony_ci} 108862306a36Sopenharmony_ci 108962306a36Sopenharmony_ci/* 109062306a36Sopenharmony_ci * The element is 48 bits of address + ASEL bits in the ring. 109162306a36Sopenharmony_ci * ASEL is used by the DMAs and should be removed for the kernel as it is not 109262306a36Sopenharmony_ci * part of the physical memory address. 109362306a36Sopenharmony_ci */ 109462306a36Sopenharmony_cistatic void k3_dmaring_remove_asel_from_elem(u64 *elem) 109562306a36Sopenharmony_ci{ 109662306a36Sopenharmony_ci *elem &= GENMASK_ULL(K3_ADDRESS_ASEL_SHIFT - 1, 0); 109762306a36Sopenharmony_ci} 109862306a36Sopenharmony_ci 109962306a36Sopenharmony_cistatic int k3_dmaring_fwd_pop(struct k3_ring *ring, void *elem) 110062306a36Sopenharmony_ci{ 110162306a36Sopenharmony_ci void *elem_ptr; 110262306a36Sopenharmony_ci u32 elem_idx; 110362306a36Sopenharmony_ci 110462306a36Sopenharmony_ci /* 110562306a36Sopenharmony_ci * DMA rings: forward ring is always tied DMA channel and HW does not 110662306a36Sopenharmony_ci * maintain any state data required for POP operation and its unknown 110762306a36Sopenharmony_ci * how much elements were consumed by HW. So, to actually 110862306a36Sopenharmony_ci * do POP, the read pointer has to be recalculated every time. 110962306a36Sopenharmony_ci */ 111062306a36Sopenharmony_ci ring->state.occ = k3_ringacc_ring_read_occ(ring); 111162306a36Sopenharmony_ci if (ring->state.windex >= ring->state.occ) 111262306a36Sopenharmony_ci elem_idx = ring->state.windex - ring->state.occ; 111362306a36Sopenharmony_ci else 111462306a36Sopenharmony_ci elem_idx = ring->size - (ring->state.occ - ring->state.windex); 111562306a36Sopenharmony_ci 111662306a36Sopenharmony_ci elem_ptr = k3_ringacc_get_elm_addr(ring, elem_idx); 111762306a36Sopenharmony_ci memcpy(elem, elem_ptr, (4 << ring->elm_size)); 111862306a36Sopenharmony_ci k3_dmaring_remove_asel_from_elem(elem); 111962306a36Sopenharmony_ci 112062306a36Sopenharmony_ci ring->state.occ--; 112162306a36Sopenharmony_ci writel(-1, &ring->rt->db); 112262306a36Sopenharmony_ci 112362306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "%s: occ%d Windex%d Rindex%d pos_ptr%px\n", 112462306a36Sopenharmony_ci __func__, ring->state.occ, ring->state.windex, elem_idx, 112562306a36Sopenharmony_ci elem_ptr); 112662306a36Sopenharmony_ci return 0; 112762306a36Sopenharmony_ci} 112862306a36Sopenharmony_ci 112962306a36Sopenharmony_cistatic int k3_dmaring_reverse_pop(struct k3_ring *ring, void *elem) 113062306a36Sopenharmony_ci{ 113162306a36Sopenharmony_ci void *elem_ptr; 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci elem_ptr = k3_ringacc_get_elm_addr(ring, ring->state.rindex); 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_ci if (ring->state.occ) { 113662306a36Sopenharmony_ci memcpy(elem, elem_ptr, (4 << ring->elm_size)); 113762306a36Sopenharmony_ci k3_dmaring_remove_asel_from_elem(elem); 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci ring->state.rindex = (ring->state.rindex + 1) % ring->size; 114062306a36Sopenharmony_ci ring->state.occ--; 114162306a36Sopenharmony_ci writel(-1 & K3_DMARING_RT_DB_ENTRY_MASK, &ring->rt->db); 114262306a36Sopenharmony_ci } else if (ring->state.tdown_complete) { 114362306a36Sopenharmony_ci dma_addr_t *value = elem; 114462306a36Sopenharmony_ci 114562306a36Sopenharmony_ci *value = CPPI5_TDCM_MARKER; 114662306a36Sopenharmony_ci writel(K3_DMARING_RT_DB_TDOWN_ACK, &ring->rt->db); 114762306a36Sopenharmony_ci ring->state.tdown_complete = false; 114862306a36Sopenharmony_ci } 114962306a36Sopenharmony_ci 115062306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "%s: occ%d index%d pos_ptr%px\n", 115162306a36Sopenharmony_ci __func__, ring->state.occ, ring->state.rindex, elem_ptr); 115262306a36Sopenharmony_ci return 0; 115362306a36Sopenharmony_ci} 115462306a36Sopenharmony_ci 115562306a36Sopenharmony_cistatic int k3_ringacc_ring_push_mem(struct k3_ring *ring, void *elem) 115662306a36Sopenharmony_ci{ 115762306a36Sopenharmony_ci void *elem_ptr; 115862306a36Sopenharmony_ci 115962306a36Sopenharmony_ci elem_ptr = k3_ringacc_get_elm_addr(ring, ring->state.windex); 116062306a36Sopenharmony_ci 116162306a36Sopenharmony_ci memcpy(elem_ptr, elem, (4 << ring->elm_size)); 116262306a36Sopenharmony_ci if (ring->parent->dma_rings) { 116362306a36Sopenharmony_ci u64 *addr = elem_ptr; 116462306a36Sopenharmony_ci 116562306a36Sopenharmony_ci *addr |= ((u64)ring->asel << K3_ADDRESS_ASEL_SHIFT); 116662306a36Sopenharmony_ci } 116762306a36Sopenharmony_ci 116862306a36Sopenharmony_ci ring->state.windex = (ring->state.windex + 1) % ring->size; 116962306a36Sopenharmony_ci ring->state.free--; 117062306a36Sopenharmony_ci writel(1, &ring->rt->db); 117162306a36Sopenharmony_ci 117262306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_push_mem: free%d index%d\n", 117362306a36Sopenharmony_ci ring->state.free, ring->state.windex); 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci return 0; 117662306a36Sopenharmony_ci} 117762306a36Sopenharmony_ci 117862306a36Sopenharmony_cistatic int k3_ringacc_ring_pop_mem(struct k3_ring *ring, void *elem) 117962306a36Sopenharmony_ci{ 118062306a36Sopenharmony_ci void *elem_ptr; 118162306a36Sopenharmony_ci 118262306a36Sopenharmony_ci elem_ptr = k3_ringacc_get_elm_addr(ring, ring->state.rindex); 118362306a36Sopenharmony_ci 118462306a36Sopenharmony_ci memcpy(elem, elem_ptr, (4 << ring->elm_size)); 118562306a36Sopenharmony_ci 118662306a36Sopenharmony_ci ring->state.rindex = (ring->state.rindex + 1) % ring->size; 118762306a36Sopenharmony_ci ring->state.occ--; 118862306a36Sopenharmony_ci writel(-1, &ring->rt->db); 118962306a36Sopenharmony_ci 119062306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_pop_mem: occ%d index%d pos_ptr%p\n", 119162306a36Sopenharmony_ci ring->state.occ, ring->state.rindex, elem_ptr); 119262306a36Sopenharmony_ci return 0; 119362306a36Sopenharmony_ci} 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ciint k3_ringacc_ring_push(struct k3_ring *ring, void *elem) 119662306a36Sopenharmony_ci{ 119762306a36Sopenharmony_ci int ret = -EOPNOTSUPP; 119862306a36Sopenharmony_ci 119962306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 120062306a36Sopenharmony_ci return -EINVAL; 120162306a36Sopenharmony_ci 120262306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_push: free%d index%d\n", 120362306a36Sopenharmony_ci ring->state.free, ring->state.windex); 120462306a36Sopenharmony_ci 120562306a36Sopenharmony_ci if (k3_ringacc_ring_is_full(ring)) 120662306a36Sopenharmony_ci return -ENOMEM; 120762306a36Sopenharmony_ci 120862306a36Sopenharmony_ci if (ring->ops && ring->ops->push_tail) 120962306a36Sopenharmony_ci ret = ring->ops->push_tail(ring, elem); 121062306a36Sopenharmony_ci 121162306a36Sopenharmony_ci return ret; 121262306a36Sopenharmony_ci} 121362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_push); 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ciint k3_ringacc_ring_push_head(struct k3_ring *ring, void *elem) 121662306a36Sopenharmony_ci{ 121762306a36Sopenharmony_ci int ret = -EOPNOTSUPP; 121862306a36Sopenharmony_ci 121962306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 122062306a36Sopenharmony_ci return -EINVAL; 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_push_head: free%d index%d\n", 122362306a36Sopenharmony_ci ring->state.free, ring->state.windex); 122462306a36Sopenharmony_ci 122562306a36Sopenharmony_ci if (k3_ringacc_ring_is_full(ring)) 122662306a36Sopenharmony_ci return -ENOMEM; 122762306a36Sopenharmony_ci 122862306a36Sopenharmony_ci if (ring->ops && ring->ops->push_head) 122962306a36Sopenharmony_ci ret = ring->ops->push_head(ring, elem); 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ci return ret; 123262306a36Sopenharmony_ci} 123362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_push_head); 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ciint k3_ringacc_ring_pop(struct k3_ring *ring, void *elem) 123662306a36Sopenharmony_ci{ 123762306a36Sopenharmony_ci int ret = -EOPNOTSUPP; 123862306a36Sopenharmony_ci 123962306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 124062306a36Sopenharmony_ci return -EINVAL; 124162306a36Sopenharmony_ci 124262306a36Sopenharmony_ci if (!ring->state.occ) 124362306a36Sopenharmony_ci k3_ringacc_ring_update_occ(ring); 124462306a36Sopenharmony_ci 124562306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_pop: occ%d index%d\n", ring->state.occ, 124662306a36Sopenharmony_ci ring->state.rindex); 124762306a36Sopenharmony_ci 124862306a36Sopenharmony_ci if (!ring->state.occ && !ring->state.tdown_complete) 124962306a36Sopenharmony_ci return -ENODATA; 125062306a36Sopenharmony_ci 125162306a36Sopenharmony_ci if (ring->ops && ring->ops->pop_head) 125262306a36Sopenharmony_ci ret = ring->ops->pop_head(ring, elem); 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_ci return ret; 125562306a36Sopenharmony_ci} 125662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_pop); 125762306a36Sopenharmony_ci 125862306a36Sopenharmony_ciint k3_ringacc_ring_pop_tail(struct k3_ring *ring, void *elem) 125962306a36Sopenharmony_ci{ 126062306a36Sopenharmony_ci int ret = -EOPNOTSUPP; 126162306a36Sopenharmony_ci 126262306a36Sopenharmony_ci if (!ring || !(ring->flags & K3_RING_FLAG_BUSY)) 126362306a36Sopenharmony_ci return -EINVAL; 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_ci if (!ring->state.occ) 126662306a36Sopenharmony_ci k3_ringacc_ring_update_occ(ring); 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci dev_dbg(ring->parent->dev, "ring_pop_tail: occ%d index%d\n", 126962306a36Sopenharmony_ci ring->state.occ, ring->state.rindex); 127062306a36Sopenharmony_ci 127162306a36Sopenharmony_ci if (!ring->state.occ) 127262306a36Sopenharmony_ci return -ENODATA; 127362306a36Sopenharmony_ci 127462306a36Sopenharmony_ci if (ring->ops && ring->ops->pop_tail) 127562306a36Sopenharmony_ci ret = ring->ops->pop_tail(ring, elem); 127662306a36Sopenharmony_ci 127762306a36Sopenharmony_ci return ret; 127862306a36Sopenharmony_ci} 127962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_ring_pop_tail); 128062306a36Sopenharmony_ci 128162306a36Sopenharmony_cistruct k3_ringacc *of_k3_ringacc_get_by_phandle(struct device_node *np, 128262306a36Sopenharmony_ci const char *property) 128362306a36Sopenharmony_ci{ 128462306a36Sopenharmony_ci struct device_node *ringacc_np; 128562306a36Sopenharmony_ci struct k3_ringacc *ringacc = ERR_PTR(-EPROBE_DEFER); 128662306a36Sopenharmony_ci struct k3_ringacc *entry; 128762306a36Sopenharmony_ci 128862306a36Sopenharmony_ci ringacc_np = of_parse_phandle(np, property, 0); 128962306a36Sopenharmony_ci if (!ringacc_np) 129062306a36Sopenharmony_ci return ERR_PTR(-ENODEV); 129162306a36Sopenharmony_ci 129262306a36Sopenharmony_ci mutex_lock(&k3_ringacc_list_lock); 129362306a36Sopenharmony_ci list_for_each_entry(entry, &k3_ringacc_list, list) 129462306a36Sopenharmony_ci if (entry->dev->of_node == ringacc_np) { 129562306a36Sopenharmony_ci ringacc = entry; 129662306a36Sopenharmony_ci break; 129762306a36Sopenharmony_ci } 129862306a36Sopenharmony_ci mutex_unlock(&k3_ringacc_list_lock); 129962306a36Sopenharmony_ci of_node_put(ringacc_np); 130062306a36Sopenharmony_ci 130162306a36Sopenharmony_ci return ringacc; 130262306a36Sopenharmony_ci} 130362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(of_k3_ringacc_get_by_phandle); 130462306a36Sopenharmony_ci 130562306a36Sopenharmony_cistatic int k3_ringacc_probe_dt(struct k3_ringacc *ringacc) 130662306a36Sopenharmony_ci{ 130762306a36Sopenharmony_ci struct device_node *node = ringacc->dev->of_node; 130862306a36Sopenharmony_ci struct device *dev = ringacc->dev; 130962306a36Sopenharmony_ci struct platform_device *pdev = to_platform_device(dev); 131062306a36Sopenharmony_ci int ret; 131162306a36Sopenharmony_ci 131262306a36Sopenharmony_ci if (!node) { 131362306a36Sopenharmony_ci dev_err(dev, "device tree info unavailable\n"); 131462306a36Sopenharmony_ci return -ENODEV; 131562306a36Sopenharmony_ci } 131662306a36Sopenharmony_ci 131762306a36Sopenharmony_ci ret = of_property_read_u32(node, "ti,num-rings", &ringacc->num_rings); 131862306a36Sopenharmony_ci if (ret) { 131962306a36Sopenharmony_ci dev_err(dev, "ti,num-rings read failure %d\n", ret); 132062306a36Sopenharmony_ci return ret; 132162306a36Sopenharmony_ci } 132262306a36Sopenharmony_ci 132362306a36Sopenharmony_ci ringacc->tisci = ti_sci_get_by_phandle(node, "ti,sci"); 132462306a36Sopenharmony_ci if (IS_ERR(ringacc->tisci)) { 132562306a36Sopenharmony_ci ret = PTR_ERR(ringacc->tisci); 132662306a36Sopenharmony_ci if (ret != -EPROBE_DEFER) 132762306a36Sopenharmony_ci dev_err(dev, "ti,sci read fail %d\n", ret); 132862306a36Sopenharmony_ci ringacc->tisci = NULL; 132962306a36Sopenharmony_ci return ret; 133062306a36Sopenharmony_ci } 133162306a36Sopenharmony_ci 133262306a36Sopenharmony_ci ret = of_property_read_u32(node, "ti,sci-dev-id", 133362306a36Sopenharmony_ci &ringacc->tisci_dev_id); 133462306a36Sopenharmony_ci if (ret) { 133562306a36Sopenharmony_ci dev_err(dev, "ti,sci-dev-id read fail %d\n", ret); 133662306a36Sopenharmony_ci return ret; 133762306a36Sopenharmony_ci } 133862306a36Sopenharmony_ci 133962306a36Sopenharmony_ci pdev->id = ringacc->tisci_dev_id; 134062306a36Sopenharmony_ci 134162306a36Sopenharmony_ci ringacc->rm_gp_range = devm_ti_sci_get_of_resource(ringacc->tisci, dev, 134262306a36Sopenharmony_ci ringacc->tisci_dev_id, 134362306a36Sopenharmony_ci "ti,sci-rm-range-gp-rings"); 134462306a36Sopenharmony_ci if (IS_ERR(ringacc->rm_gp_range)) { 134562306a36Sopenharmony_ci dev_err(dev, "Failed to allocate MSI interrupts\n"); 134662306a36Sopenharmony_ci return PTR_ERR(ringacc->rm_gp_range); 134762306a36Sopenharmony_ci } 134862306a36Sopenharmony_ci 134962306a36Sopenharmony_ci return ti_sci_inta_msi_domain_alloc_irqs(ringacc->dev, 135062306a36Sopenharmony_ci ringacc->rm_gp_range); 135162306a36Sopenharmony_ci} 135262306a36Sopenharmony_ci 135362306a36Sopenharmony_cistatic const struct k3_ringacc_soc_data k3_ringacc_soc_data_sr1 = { 135462306a36Sopenharmony_ci .dma_ring_reset_quirk = 1, 135562306a36Sopenharmony_ci}; 135662306a36Sopenharmony_ci 135762306a36Sopenharmony_cistatic const struct soc_device_attribute k3_ringacc_socinfo[] = { 135862306a36Sopenharmony_ci { .family = "AM65X", 135962306a36Sopenharmony_ci .revision = "SR1.0", 136062306a36Sopenharmony_ci .data = &k3_ringacc_soc_data_sr1 136162306a36Sopenharmony_ci }, 136262306a36Sopenharmony_ci {/* sentinel */} 136362306a36Sopenharmony_ci}; 136462306a36Sopenharmony_ci 136562306a36Sopenharmony_cistatic int k3_ringacc_init(struct platform_device *pdev, 136662306a36Sopenharmony_ci struct k3_ringacc *ringacc) 136762306a36Sopenharmony_ci{ 136862306a36Sopenharmony_ci const struct soc_device_attribute *soc; 136962306a36Sopenharmony_ci void __iomem *base_fifo, *base_rt; 137062306a36Sopenharmony_ci struct device *dev = &pdev->dev; 137162306a36Sopenharmony_ci int ret, i; 137262306a36Sopenharmony_ci 137362306a36Sopenharmony_ci dev->msi.domain = of_msi_get_domain(dev, dev->of_node, 137462306a36Sopenharmony_ci DOMAIN_BUS_TI_SCI_INTA_MSI); 137562306a36Sopenharmony_ci if (!dev->msi.domain) 137662306a36Sopenharmony_ci return -EPROBE_DEFER; 137762306a36Sopenharmony_ci 137862306a36Sopenharmony_ci ret = k3_ringacc_probe_dt(ringacc); 137962306a36Sopenharmony_ci if (ret) 138062306a36Sopenharmony_ci return ret; 138162306a36Sopenharmony_ci 138262306a36Sopenharmony_ci soc = soc_device_match(k3_ringacc_socinfo); 138362306a36Sopenharmony_ci if (soc && soc->data) { 138462306a36Sopenharmony_ci const struct k3_ringacc_soc_data *soc_data = soc->data; 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci ringacc->dma_ring_reset_quirk = soc_data->dma_ring_reset_quirk; 138762306a36Sopenharmony_ci } 138862306a36Sopenharmony_ci 138962306a36Sopenharmony_ci base_rt = devm_platform_ioremap_resource_byname(pdev, "rt"); 139062306a36Sopenharmony_ci if (IS_ERR(base_rt)) 139162306a36Sopenharmony_ci return PTR_ERR(base_rt); 139262306a36Sopenharmony_ci 139362306a36Sopenharmony_ci base_fifo = devm_platform_ioremap_resource_byname(pdev, "fifos"); 139462306a36Sopenharmony_ci if (IS_ERR(base_fifo)) 139562306a36Sopenharmony_ci return PTR_ERR(base_fifo); 139662306a36Sopenharmony_ci 139762306a36Sopenharmony_ci ringacc->proxy_gcfg = devm_platform_ioremap_resource_byname(pdev, "proxy_gcfg"); 139862306a36Sopenharmony_ci if (IS_ERR(ringacc->proxy_gcfg)) 139962306a36Sopenharmony_ci return PTR_ERR(ringacc->proxy_gcfg); 140062306a36Sopenharmony_ci 140162306a36Sopenharmony_ci ringacc->proxy_target_base = devm_platform_ioremap_resource_byname(pdev, 140262306a36Sopenharmony_ci "proxy_target"); 140362306a36Sopenharmony_ci if (IS_ERR(ringacc->proxy_target_base)) 140462306a36Sopenharmony_ci return PTR_ERR(ringacc->proxy_target_base); 140562306a36Sopenharmony_ci 140662306a36Sopenharmony_ci ringacc->num_proxies = readl(&ringacc->proxy_gcfg->config) & 140762306a36Sopenharmony_ci K3_RINGACC_PROXY_CFG_THREADS_MASK; 140862306a36Sopenharmony_ci 140962306a36Sopenharmony_ci ringacc->rings = devm_kzalloc(dev, 141062306a36Sopenharmony_ci sizeof(*ringacc->rings) * 141162306a36Sopenharmony_ci ringacc->num_rings, 141262306a36Sopenharmony_ci GFP_KERNEL); 141362306a36Sopenharmony_ci ringacc->rings_inuse = devm_bitmap_zalloc(dev, ringacc->num_rings, 141462306a36Sopenharmony_ci GFP_KERNEL); 141562306a36Sopenharmony_ci ringacc->proxy_inuse = devm_bitmap_zalloc(dev, ringacc->num_proxies, 141662306a36Sopenharmony_ci GFP_KERNEL); 141762306a36Sopenharmony_ci 141862306a36Sopenharmony_ci if (!ringacc->rings || !ringacc->rings_inuse || !ringacc->proxy_inuse) 141962306a36Sopenharmony_ci return -ENOMEM; 142062306a36Sopenharmony_ci 142162306a36Sopenharmony_ci for (i = 0; i < ringacc->num_rings; i++) { 142262306a36Sopenharmony_ci ringacc->rings[i].rt = base_rt + 142362306a36Sopenharmony_ci K3_RINGACC_RT_REGS_STEP * i; 142462306a36Sopenharmony_ci ringacc->rings[i].fifos = base_fifo + 142562306a36Sopenharmony_ci K3_RINGACC_FIFO_REGS_STEP * i; 142662306a36Sopenharmony_ci ringacc->rings[i].parent = ringacc; 142762306a36Sopenharmony_ci ringacc->rings[i].ring_id = i; 142862306a36Sopenharmony_ci ringacc->rings[i].proxy_id = K3_RINGACC_PROXY_NOT_USED; 142962306a36Sopenharmony_ci } 143062306a36Sopenharmony_ci 143162306a36Sopenharmony_ci ringacc->tisci_ring_ops = &ringacc->tisci->ops.rm_ring_ops; 143262306a36Sopenharmony_ci 143362306a36Sopenharmony_ci dev_info(dev, "Ring Accelerator probed rings:%u, gp-rings[%u,%u] sci-dev-id:%u\n", 143462306a36Sopenharmony_ci ringacc->num_rings, 143562306a36Sopenharmony_ci ringacc->rm_gp_range->desc[0].start, 143662306a36Sopenharmony_ci ringacc->rm_gp_range->desc[0].num, 143762306a36Sopenharmony_ci ringacc->tisci_dev_id); 143862306a36Sopenharmony_ci dev_info(dev, "dma-ring-reset-quirk: %s\n", 143962306a36Sopenharmony_ci ringacc->dma_ring_reset_quirk ? "enabled" : "disabled"); 144062306a36Sopenharmony_ci dev_info(dev, "RA Proxy rev. %08x, num_proxies:%u\n", 144162306a36Sopenharmony_ci readl(&ringacc->proxy_gcfg->revision), ringacc->num_proxies); 144262306a36Sopenharmony_ci 144362306a36Sopenharmony_ci return 0; 144462306a36Sopenharmony_ci} 144562306a36Sopenharmony_ci 144662306a36Sopenharmony_cistruct ringacc_match_data { 144762306a36Sopenharmony_ci struct k3_ringacc_ops ops; 144862306a36Sopenharmony_ci}; 144962306a36Sopenharmony_ci 145062306a36Sopenharmony_cistatic struct ringacc_match_data k3_ringacc_data = { 145162306a36Sopenharmony_ci .ops = { 145262306a36Sopenharmony_ci .init = k3_ringacc_init, 145362306a36Sopenharmony_ci }, 145462306a36Sopenharmony_ci}; 145562306a36Sopenharmony_ci 145662306a36Sopenharmony_ci/* Match table for of_platform binding */ 145762306a36Sopenharmony_cistatic const struct of_device_id k3_ringacc_of_match[] = { 145862306a36Sopenharmony_ci { .compatible = "ti,am654-navss-ringacc", .data = &k3_ringacc_data, }, 145962306a36Sopenharmony_ci {}, 146062306a36Sopenharmony_ci}; 146162306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, k3_ringacc_of_match); 146262306a36Sopenharmony_ci 146362306a36Sopenharmony_cistruct k3_ringacc *k3_ringacc_dmarings_init(struct platform_device *pdev, 146462306a36Sopenharmony_ci struct k3_ringacc_init_data *data) 146562306a36Sopenharmony_ci{ 146662306a36Sopenharmony_ci struct device *dev = &pdev->dev; 146762306a36Sopenharmony_ci struct k3_ringacc *ringacc; 146862306a36Sopenharmony_ci void __iomem *base_rt; 146962306a36Sopenharmony_ci int i; 147062306a36Sopenharmony_ci 147162306a36Sopenharmony_ci ringacc = devm_kzalloc(dev, sizeof(*ringacc), GFP_KERNEL); 147262306a36Sopenharmony_ci if (!ringacc) 147362306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 147462306a36Sopenharmony_ci 147562306a36Sopenharmony_ci ringacc->dev = dev; 147662306a36Sopenharmony_ci ringacc->dma_rings = true; 147762306a36Sopenharmony_ci ringacc->num_rings = data->num_rings; 147862306a36Sopenharmony_ci ringacc->tisci = data->tisci; 147962306a36Sopenharmony_ci ringacc->tisci_dev_id = data->tisci_dev_id; 148062306a36Sopenharmony_ci 148162306a36Sopenharmony_ci mutex_init(&ringacc->req_lock); 148262306a36Sopenharmony_ci 148362306a36Sopenharmony_ci base_rt = devm_platform_ioremap_resource_byname(pdev, "ringrt"); 148462306a36Sopenharmony_ci if (IS_ERR(base_rt)) 148562306a36Sopenharmony_ci return ERR_CAST(base_rt); 148662306a36Sopenharmony_ci 148762306a36Sopenharmony_ci ringacc->rings = devm_kzalloc(dev, 148862306a36Sopenharmony_ci sizeof(*ringacc->rings) * 148962306a36Sopenharmony_ci ringacc->num_rings * 2, 149062306a36Sopenharmony_ci GFP_KERNEL); 149162306a36Sopenharmony_ci ringacc->rings_inuse = devm_bitmap_zalloc(dev, ringacc->num_rings, 149262306a36Sopenharmony_ci GFP_KERNEL); 149362306a36Sopenharmony_ci 149462306a36Sopenharmony_ci if (!ringacc->rings || !ringacc->rings_inuse) 149562306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 149662306a36Sopenharmony_ci 149762306a36Sopenharmony_ci for (i = 0; i < ringacc->num_rings; i++) { 149862306a36Sopenharmony_ci struct k3_ring *ring = &ringacc->rings[i]; 149962306a36Sopenharmony_ci 150062306a36Sopenharmony_ci ring->rt = base_rt + K3_DMARING_RT_REGS_STEP * i; 150162306a36Sopenharmony_ci ring->parent = ringacc; 150262306a36Sopenharmony_ci ring->ring_id = i; 150362306a36Sopenharmony_ci ring->proxy_id = K3_RINGACC_PROXY_NOT_USED; 150462306a36Sopenharmony_ci 150562306a36Sopenharmony_ci ring = &ringacc->rings[ringacc->num_rings + i]; 150662306a36Sopenharmony_ci ring->rt = base_rt + K3_DMARING_RT_REGS_STEP * i + 150762306a36Sopenharmony_ci K3_DMARING_RT_REGS_REVERSE_OFS; 150862306a36Sopenharmony_ci ring->parent = ringacc; 150962306a36Sopenharmony_ci ring->ring_id = i; 151062306a36Sopenharmony_ci ring->proxy_id = K3_RINGACC_PROXY_NOT_USED; 151162306a36Sopenharmony_ci ring->flags = K3_RING_FLAG_REVERSE; 151262306a36Sopenharmony_ci } 151362306a36Sopenharmony_ci 151462306a36Sopenharmony_ci ringacc->tisci_ring_ops = &ringacc->tisci->ops.rm_ring_ops; 151562306a36Sopenharmony_ci 151662306a36Sopenharmony_ci dev_info(dev, "Number of rings: %u\n", ringacc->num_rings); 151762306a36Sopenharmony_ci 151862306a36Sopenharmony_ci return ringacc; 151962306a36Sopenharmony_ci} 152062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(k3_ringacc_dmarings_init); 152162306a36Sopenharmony_ci 152262306a36Sopenharmony_cistatic int k3_ringacc_probe(struct platform_device *pdev) 152362306a36Sopenharmony_ci{ 152462306a36Sopenharmony_ci const struct ringacc_match_data *match_data; 152562306a36Sopenharmony_ci struct device *dev = &pdev->dev; 152662306a36Sopenharmony_ci struct k3_ringacc *ringacc; 152762306a36Sopenharmony_ci int ret; 152862306a36Sopenharmony_ci 152962306a36Sopenharmony_ci match_data = of_device_get_match_data(&pdev->dev); 153062306a36Sopenharmony_ci if (!match_data) 153162306a36Sopenharmony_ci return -ENODEV; 153262306a36Sopenharmony_ci 153362306a36Sopenharmony_ci ringacc = devm_kzalloc(dev, sizeof(*ringacc), GFP_KERNEL); 153462306a36Sopenharmony_ci if (!ringacc) 153562306a36Sopenharmony_ci return -ENOMEM; 153662306a36Sopenharmony_ci 153762306a36Sopenharmony_ci ringacc->dev = dev; 153862306a36Sopenharmony_ci mutex_init(&ringacc->req_lock); 153962306a36Sopenharmony_ci ringacc->ops = &match_data->ops; 154062306a36Sopenharmony_ci 154162306a36Sopenharmony_ci ret = ringacc->ops->init(pdev, ringacc); 154262306a36Sopenharmony_ci if (ret) 154362306a36Sopenharmony_ci return ret; 154462306a36Sopenharmony_ci 154562306a36Sopenharmony_ci dev_set_drvdata(dev, ringacc); 154662306a36Sopenharmony_ci 154762306a36Sopenharmony_ci mutex_lock(&k3_ringacc_list_lock); 154862306a36Sopenharmony_ci list_add_tail(&ringacc->list, &k3_ringacc_list); 154962306a36Sopenharmony_ci mutex_unlock(&k3_ringacc_list_lock); 155062306a36Sopenharmony_ci 155162306a36Sopenharmony_ci return 0; 155262306a36Sopenharmony_ci} 155362306a36Sopenharmony_ci 155462306a36Sopenharmony_cistatic int k3_ringacc_remove(struct platform_device *pdev) 155562306a36Sopenharmony_ci{ 155662306a36Sopenharmony_ci struct k3_ringacc *ringacc = dev_get_drvdata(&pdev->dev); 155762306a36Sopenharmony_ci 155862306a36Sopenharmony_ci mutex_lock(&k3_ringacc_list_lock); 155962306a36Sopenharmony_ci list_del(&ringacc->list); 156062306a36Sopenharmony_ci mutex_unlock(&k3_ringacc_list_lock); 156162306a36Sopenharmony_ci return 0; 156262306a36Sopenharmony_ci} 156362306a36Sopenharmony_ci 156462306a36Sopenharmony_cistatic struct platform_driver k3_ringacc_driver = { 156562306a36Sopenharmony_ci .probe = k3_ringacc_probe, 156662306a36Sopenharmony_ci .remove = k3_ringacc_remove, 156762306a36Sopenharmony_ci .driver = { 156862306a36Sopenharmony_ci .name = "k3-ringacc", 156962306a36Sopenharmony_ci .of_match_table = k3_ringacc_of_match, 157062306a36Sopenharmony_ci .suppress_bind_attrs = true, 157162306a36Sopenharmony_ci }, 157262306a36Sopenharmony_ci}; 157362306a36Sopenharmony_cimodule_platform_driver(k3_ringacc_driver); 157462306a36Sopenharmony_ci 157562306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 157662306a36Sopenharmony_ciMODULE_DESCRIPTION("TI Ringacc driver for K3 SOCs"); 157762306a36Sopenharmony_ciMODULE_AUTHOR("Grygorii Strashko <grygorii.strashko@ti.com>"); 1578