// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2017-2020, The Linux Foundation. All rights reserved. * Copyright (c) 2020, Linaro Limited */ #include #include #include #include #include #include #include #include #include #include #include "../dmaengine.h" #include "../virt-dma.h" #define TRE_TYPE_DMA 0x10 #define TRE_TYPE_GO 0x20 #define TRE_TYPE_CONFIG0 0x22 /* TRE flags */ #define TRE_FLAGS_CHAIN BIT(0) #define TRE_FLAGS_IEOB BIT(8) #define TRE_FLAGS_IEOT BIT(9) #define TRE_FLAGS_BEI BIT(10) #define TRE_FLAGS_LINK BIT(11) #define TRE_FLAGS_TYPE GENMASK(23, 16) /* SPI CONFIG0 WD0 */ #define TRE_SPI_C0_WORD_SZ GENMASK(4, 0) #define TRE_SPI_C0_LOOPBACK BIT(8) #define TRE_SPI_C0_CS BIT(11) #define TRE_SPI_C0_CPHA BIT(12) #define TRE_SPI_C0_CPOL BIT(13) #define TRE_SPI_C0_TX_PACK BIT(24) #define TRE_SPI_C0_RX_PACK BIT(25) /* CONFIG0 WD2 */ #define TRE_C0_CLK_DIV GENMASK(11, 0) #define TRE_C0_CLK_SRC GENMASK(19, 16) /* SPI GO WD0 */ #define TRE_SPI_GO_CMD GENMASK(4, 0) #define TRE_SPI_GO_CS GENMASK(10, 8) #define TRE_SPI_GO_FRAG BIT(26) /* GO WD2 */ #define TRE_RX_LEN GENMASK(23, 0) /* I2C Config0 WD0 */ #define TRE_I2C_C0_TLOW GENMASK(7, 0) #define TRE_I2C_C0_THIGH GENMASK(15, 8) #define TRE_I2C_C0_TCYL GENMASK(23, 16) #define TRE_I2C_C0_TX_PACK BIT(24) #define TRE_I2C_C0_RX_PACK BIT(25) /* I2C GO WD0 */ #define TRE_I2C_GO_CMD GENMASK(4, 0) #define TRE_I2C_GO_ADDR GENMASK(14, 8) #define TRE_I2C_GO_STRETCH BIT(26) /* DMA TRE */ #define TRE_DMA_LEN GENMASK(23, 0) /* Register offsets from gpi-top */ #define GPII_n_CH_k_CNTXT_0_OFFS(n, k) (0x20000 + (0x4000 * (n)) + (0x80 * (k))) #define GPII_n_CH_k_CNTXT_0_EL_SIZE GENMASK(31, 24) #define GPII_n_CH_k_CNTXT_0_CHSTATE GENMASK(23, 20) #define GPII_n_CH_k_CNTXT_0_ERIDX GENMASK(18, 14) #define GPII_n_CH_k_CNTXT_0_DIR BIT(3) #define GPII_n_CH_k_CNTXT_0_PROTO GENMASK(2, 0) #define GPII_n_CH_k_CNTXT_0(el_size, erindex, dir, chtype_proto) \ (FIELD_PREP(GPII_n_CH_k_CNTXT_0_EL_SIZE, el_size) | \ FIELD_PREP(GPII_n_CH_k_CNTXT_0_ERIDX, erindex) | \ FIELD_PREP(GPII_n_CH_k_CNTXT_0_DIR, dir) | \ FIELD_PREP(GPII_n_CH_k_CNTXT_0_PROTO, chtype_proto)) #define GPI_CHTYPE_DIR_IN (0) #define GPI_CHTYPE_DIR_OUT (1) #define GPI_CHTYPE_PROTO_GPI (0x2) #define GPII_n_CH_k_DOORBELL_0_OFFS(n, k) (0x22000 + (0x4000 * (n)) + (0x8 * (k))) #define GPII_n_CH_CMD_OFFS(n) (0x23008 + (0x4000 * (n))) #define GPII_n_CH_CMD_OPCODE GENMASK(31, 24) #define GPII_n_CH_CMD_CHID GENMASK(7, 0) #define GPII_n_CH_CMD(opcode, chid) \ (FIELD_PREP(GPII_n_CH_CMD_OPCODE, opcode) | \ FIELD_PREP(GPII_n_CH_CMD_CHID, chid)) #define GPII_n_CH_CMD_ALLOCATE (0) #define GPII_n_CH_CMD_START (1) #define GPII_n_CH_CMD_STOP (2) #define GPII_n_CH_CMD_RESET (9) #define GPII_n_CH_CMD_DE_ALLOC (10) #define GPII_n_CH_CMD_UART_SW_STALE (32) #define GPII_n_CH_CMD_UART_RFR_READY (33) #define GPII_n_CH_CMD_UART_RFR_NOT_READY (34) /* EV Context Array */ #define GPII_n_EV_CH_k_CNTXT_0_OFFS(n, k) (0x21000 + (0x4000 * (n)) + (0x80 * (k))) #define GPII_n_EV_k_CNTXT_0_EL_SIZE GENMASK(31, 24) #define GPII_n_EV_k_CNTXT_0_CHSTATE GENMASK(23, 20) #define GPII_n_EV_k_CNTXT_0_INTYPE BIT(16) #define GPII_n_EV_k_CNTXT_0_CHTYPE GENMASK(3, 0) #define GPII_n_EV_k_CNTXT_0(el_size, inttype, chtype) \ (FIELD_PREP(GPII_n_EV_k_CNTXT_0_EL_SIZE, el_size) | \ FIELD_PREP(GPII_n_EV_k_CNTXT_0_INTYPE, inttype) | \ FIELD_PREP(GPII_n_EV_k_CNTXT_0_CHTYPE, chtype)) #define GPI_INTTYPE_IRQ (1) #define GPI_CHTYPE_GPI_EV (0x2) enum CNTXT_OFFS { CNTXT_0_CONFIG = 0x0, CNTXT_1_R_LENGTH = 0x4, CNTXT_2_RING_BASE_LSB = 0x8, CNTXT_3_RING_BASE_MSB = 0xC, CNTXT_4_RING_RP_LSB = 0x10, CNTXT_5_RING_RP_MSB = 0x14, CNTXT_6_RING_WP_LSB = 0x18, CNTXT_7_RING_WP_MSB = 0x1C, CNTXT_8_RING_INT_MOD = 0x20, CNTXT_9_RING_INTVEC = 0x24, CNTXT_10_RING_MSI_LSB = 0x28, CNTXT_11_RING_MSI_MSB = 0x2C, CNTXT_12_RING_RP_UPDATE_LSB = 0x30, CNTXT_13_RING_RP_UPDATE_MSB = 0x34, }; #define GPII_n_EV_CH_k_DOORBELL_0_OFFS(n, k) (0x22100 + (0x4000 * (n)) + (0x8 * (k))) #define GPII_n_EV_CH_CMD_OFFS(n) (0x23010 + (0x4000 * (n))) #define GPII_n_EV_CMD_OPCODE GENMASK(31, 24) #define GPII_n_EV_CMD_CHID GENMASK(7, 0) #define GPII_n_EV_CMD(opcode, chid) \ (FIELD_PREP(GPII_n_EV_CMD_OPCODE, opcode) | \ FIELD_PREP(GPII_n_EV_CMD_CHID, chid)) #define GPII_n_EV_CH_CMD_ALLOCATE (0x00) #define GPII_n_EV_CH_CMD_RESET (0x09) #define GPII_n_EV_CH_CMD_DE_ALLOC (0x0A) #define GPII_n_CNTXT_TYPE_IRQ_OFFS(n) (0x23080 + (0x4000 * (n))) /* mask type register */ #define GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(n) (0x23088 + (0x4000 * (n))) #define GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK GENMASK(6, 0) #define GPII_n_CNTXT_TYPE_IRQ_MSK_GENERAL BIT(6) #define GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB BIT(3) #define GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB BIT(2) #define GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL BIT(1) #define GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL BIT(0) #define GPII_n_CNTXT_SRC_GPII_CH_IRQ_OFFS(n) (0x23090 + (0x4000 * (n))) #define GPII_n_CNTXT_SRC_EV_CH_IRQ_OFFS(n) (0x23094 + (0x4000 * (n))) /* Mask channel control interrupt register */ #define GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(n) (0x23098 + (0x4000 * (n))) #define GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK GENMASK(1, 0) /* Mask event control interrupt register */ #define GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(n) (0x2309C + (0x4000 * (n))) #define GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK BIT(0) #define GPII_n_CNTXT_SRC_CH_IRQ_CLR_OFFS(n) (0x230A0 + (0x4000 * (n))) #define GPII_n_CNTXT_SRC_EV_CH_IRQ_CLR_OFFS(n) (0x230A4 + (0x4000 * (n))) /* Mask event interrupt register */ #define GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(n) (0x230B8 + (0x4000 * (n))) #define GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK BIT(0) #define GPII_n_CNTXT_SRC_IEOB_IRQ_CLR_OFFS(n) (0x230C0 + (0x4000 * (n))) #define GPII_n_CNTXT_GLOB_IRQ_STTS_OFFS(n) (0x23100 + (0x4000 * (n))) #define GPI_GLOB_IRQ_ERROR_INT_MSK BIT(0) /* GPII specific Global - Enable bit register */ #define GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(n) (0x23108 + (0x4000 * (n))) #define GPII_n_CNTXT_GLOB_IRQ_CLR_OFFS(n) (0x23110 + (0x4000 * (n))) #define GPII_n_CNTXT_GPII_IRQ_STTS_OFFS(n) (0x23118 + (0x4000 * (n))) /* GPII general interrupt - Enable bit register */ #define GPII_n_CNTXT_GPII_IRQ_EN_OFFS(n) (0x23120 + (0x4000 * (n))) #define GPII_n_CNTXT_GPII_IRQ_EN_BMSK GENMASK(3, 0) #define GPII_n_CNTXT_GPII_IRQ_CLR_OFFS(n) (0x23128 + (0x4000 * (n))) /* GPII Interrupt Type register */ #define GPII_n_CNTXT_INTSET_OFFS(n) (0x23180 + (0x4000 * (n))) #define GPII_n_CNTXT_INTSET_BMSK BIT(0) #define GPII_n_CNTXT_MSI_BASE_LSB_OFFS(n) (0x23188 + (0x4000 * (n))) #define GPII_n_CNTXT_MSI_BASE_MSB_OFFS(n) (0x2318C + (0x4000 * (n))) #define GPII_n_CNTXT_SCRATCH_0_OFFS(n) (0x23400 + (0x4000 * (n))) #define GPII_n_CNTXT_SCRATCH_1_OFFS(n) (0x23404 + (0x4000 * (n))) #define GPII_n_ERROR_LOG_OFFS(n) (0x23200 + (0x4000 * (n))) /* QOS Registers */ #define GPII_n_CH_k_QOS_OFFS(n, k) (0x2005C + (0x4000 * (n)) + (0x80 * (k))) /* Scratch registers */ #define GPII_n_CH_k_SCRATCH_0_OFFS(n, k) (0x20060 + (0x4000 * (n)) + (0x80 * (k))) #define GPII_n_CH_k_SCRATCH_0_SEID GENMASK(2, 0) #define GPII_n_CH_k_SCRATCH_0_PROTO GENMASK(7, 4) #define GPII_n_CH_k_SCRATCH_0_PAIR GENMASK(20, 16) #define GPII_n_CH_k_SCRATCH_0(pair, proto, seid) \ (FIELD_PREP(GPII_n_CH_k_SCRATCH_0_PAIR, pair) | \ FIELD_PREP(GPII_n_CH_k_SCRATCH_0_PROTO, proto) | \ FIELD_PREP(GPII_n_CH_k_SCRATCH_0_SEID, seid)) #define GPII_n_CH_k_SCRATCH_1_OFFS(n, k) (0x20064 + (0x4000 * (n)) + (0x80 * (k))) #define GPII_n_CH_k_SCRATCH_2_OFFS(n, k) (0x20068 + (0x4000 * (n)) + (0x80 * (k))) #define GPII_n_CH_k_SCRATCH_3_OFFS(n, k) (0x2006C + (0x4000 * (n)) + (0x80 * (k))) struct __packed gpi_tre { u32 dword[4]; }; enum msm_gpi_tce_code { MSM_GPI_TCE_SUCCESS = 1, MSM_GPI_TCE_EOT = 2, MSM_GPI_TCE_EOB = 4, MSM_GPI_TCE_UNEXP_ERR = 16, }; #define CMD_TIMEOUT_MS (250) #define MAX_CHANNELS_PER_GPII (2) #define GPI_TX_CHAN (0) #define GPI_RX_CHAN (1) #define STATE_IGNORE (U32_MAX) #define EV_FACTOR (2) #define REQ_OF_DMA_ARGS (5) /* # of arguments required from client */ #define CHAN_TRES 64 struct __packed xfer_compl_event { u64 ptr; u32 length:24; u8 code; u16 status; u8 type; u8 chid; }; struct __packed immediate_data_event { u8 data_bytes[8]; u8 length:4; u8 resvd:4; u16 tre_index; u8 code; u16 status; u8 type; u8 chid; }; struct __packed qup_notif_event { u32 status; u32 time; u32 count:24; u8 resvd; u16 resvd1; u8 type; u8 chid; }; struct __packed gpi_ere { u32 dword[4]; }; enum GPI_EV_TYPE { XFER_COMPLETE_EV_TYPE = 0x22, IMMEDIATE_DATA_EV_TYPE = 0x30, QUP_NOTIF_EV_TYPE = 0x31, STALE_EV_TYPE = 0xFF, }; union __packed gpi_event { struct __packed xfer_compl_event xfer_compl_event; struct __packed immediate_data_event immediate_data_event; struct __packed qup_notif_event qup_notif_event; struct __packed gpi_ere gpi_ere; }; enum gpii_irq_settings { DEFAULT_IRQ_SETTINGS, MASK_IEOB_SETTINGS, }; enum gpi_ev_state { DEFAULT_EV_CH_STATE = 0, EV_STATE_NOT_ALLOCATED = DEFAULT_EV_CH_STATE, EV_STATE_ALLOCATED, MAX_EV_STATES }; static const char *const gpi_ev_state_str[MAX_EV_STATES] = { [EV_STATE_NOT_ALLOCATED] = "NOT ALLOCATED", [EV_STATE_ALLOCATED] = "ALLOCATED", }; #define TO_GPI_EV_STATE_STR(_state) (((_state) >= MAX_EV_STATES) ? \ "INVALID" : gpi_ev_state_str[(_state)]) enum gpi_ch_state { DEFAULT_CH_STATE = 0x0, CH_STATE_NOT_ALLOCATED = DEFAULT_CH_STATE, CH_STATE_ALLOCATED = 0x1, CH_STATE_STARTED = 0x2, CH_STATE_STOPPED = 0x3, CH_STATE_STOP_IN_PROC = 0x4, CH_STATE_ERROR = 0xf, MAX_CH_STATES }; enum gpi_cmd { GPI_CH_CMD_BEGIN, GPI_CH_CMD_ALLOCATE = GPI_CH_CMD_BEGIN, GPI_CH_CMD_START, GPI_CH_CMD_STOP, GPI_CH_CMD_RESET, GPI_CH_CMD_DE_ALLOC, GPI_CH_CMD_UART_SW_STALE, GPI_CH_CMD_UART_RFR_READY, GPI_CH_CMD_UART_RFR_NOT_READY, GPI_CH_CMD_END = GPI_CH_CMD_UART_RFR_NOT_READY, GPI_EV_CMD_BEGIN, GPI_EV_CMD_ALLOCATE = GPI_EV_CMD_BEGIN, GPI_EV_CMD_RESET, GPI_EV_CMD_DEALLOC, GPI_EV_CMD_END = GPI_EV_CMD_DEALLOC, GPI_MAX_CMD, }; #define IS_CHAN_CMD(_cmd) ((_cmd) <= GPI_CH_CMD_END) static const char *const gpi_cmd_str[GPI_MAX_CMD] = { [GPI_CH_CMD_ALLOCATE] = "CH ALLOCATE", [GPI_CH_CMD_START] = "CH START", [GPI_CH_CMD_STOP] = "CH STOP", [GPI_CH_CMD_RESET] = "CH_RESET", [GPI_CH_CMD_DE_ALLOC] = "DE ALLOC", [GPI_CH_CMD_UART_SW_STALE] = "UART SW STALE", [GPI_CH_CMD_UART_RFR_READY] = "UART RFR READY", [GPI_CH_CMD_UART_RFR_NOT_READY] = "UART RFR NOT READY", [GPI_EV_CMD_ALLOCATE] = "EV ALLOCATE", [GPI_EV_CMD_RESET] = "EV RESET", [GPI_EV_CMD_DEALLOC] = "EV DEALLOC", }; #define TO_GPI_CMD_STR(_cmd) (((_cmd) >= GPI_MAX_CMD) ? "INVALID" : \ gpi_cmd_str[(_cmd)]) /* * @DISABLE_STATE: no register access allowed * @CONFIG_STATE: client has configured the channel * @PREP_HARDWARE: register access is allowed * however, no processing EVENTS * @ACTIVE_STATE: channels are fully operational * @PREPARE_TERMINATE: graceful termination of channels * register access is allowed * @PAUSE_STATE: channels are active, but not processing any events */ enum gpi_pm_state { DISABLE_STATE, CONFIG_STATE, PREPARE_HARDWARE, ACTIVE_STATE, PREPARE_TERMINATE, PAUSE_STATE, MAX_PM_STATE }; #define REG_ACCESS_VALID(_pm_state) ((_pm_state) >= PREPARE_HARDWARE) static const char *const gpi_pm_state_str[MAX_PM_STATE] = { [DISABLE_STATE] = "DISABLE", [CONFIG_STATE] = "CONFIG", [PREPARE_HARDWARE] = "PREPARE HARDWARE", [ACTIVE_STATE] = "ACTIVE", [PREPARE_TERMINATE] = "PREPARE TERMINATE", [PAUSE_STATE] = "PAUSE", }; #define TO_GPI_PM_STR(_state) (((_state) >= MAX_PM_STATE) ? \ "INVALID" : gpi_pm_state_str[(_state)]) static const struct { enum gpi_cmd gpi_cmd; u32 opcode; u32 state; } gpi_cmd_info[GPI_MAX_CMD] = { { GPI_CH_CMD_ALLOCATE, GPII_n_CH_CMD_ALLOCATE, CH_STATE_ALLOCATED, }, { GPI_CH_CMD_START, GPII_n_CH_CMD_START, CH_STATE_STARTED, }, { GPI_CH_CMD_STOP, GPII_n_CH_CMD_STOP, CH_STATE_STOPPED, }, { GPI_CH_CMD_RESET, GPII_n_CH_CMD_RESET, CH_STATE_ALLOCATED, }, { GPI_CH_CMD_DE_ALLOC, GPII_n_CH_CMD_DE_ALLOC, CH_STATE_NOT_ALLOCATED, }, { GPI_CH_CMD_UART_SW_STALE, GPII_n_CH_CMD_UART_SW_STALE, STATE_IGNORE, }, { GPI_CH_CMD_UART_RFR_READY, GPII_n_CH_CMD_UART_RFR_READY, STATE_IGNORE, }, { GPI_CH_CMD_UART_RFR_NOT_READY, GPII_n_CH_CMD_UART_RFR_NOT_READY, STATE_IGNORE, }, { GPI_EV_CMD_ALLOCATE, GPII_n_EV_CH_CMD_ALLOCATE, EV_STATE_ALLOCATED, }, { GPI_EV_CMD_RESET, GPII_n_EV_CH_CMD_RESET, EV_STATE_ALLOCATED, }, { GPI_EV_CMD_DEALLOC, GPII_n_EV_CH_CMD_DE_ALLOC, EV_STATE_NOT_ALLOCATED, }, }; struct gpi_ring { void *pre_aligned; size_t alloc_size; phys_addr_t phys_addr; dma_addr_t dma_handle; void *base; void *wp; void *rp; u32 len; u32 el_size; u32 elements; bool configured; }; struct gpi_dev { struct dma_device dma_device; struct device *dev; struct resource *res; void __iomem *regs; void __iomem *ee_base; /*ee register base address*/ u32 max_gpii; /* maximum # of gpii instances available per gpi block */ u32 gpii_mask; /* gpii instances available for apps */ u32 ev_factor; /* ev ring length factor */ struct gpii *gpiis; }; struct gchan { struct virt_dma_chan vc; u32 chid; u32 seid; u32 protocol; struct gpii *gpii; enum gpi_ch_state ch_state; enum gpi_pm_state pm_state; void __iomem *ch_cntxt_base_reg; void __iomem *ch_cntxt_db_reg; void __iomem *ch_cmd_reg; u32 dir; struct gpi_ring ch_ring; void *config; }; struct gpii { u32 gpii_id; struct gchan gchan[MAX_CHANNELS_PER_GPII]; struct gpi_dev *gpi_dev; int irq; void __iomem *regs; /* points to gpi top */ void __iomem *ev_cntxt_base_reg; void __iomem *ev_cntxt_db_reg; void __iomem *ev_ring_rp_lsb_reg; void __iomem *ev_cmd_reg; void __iomem *ieob_clr_reg; struct mutex ctrl_lock; enum gpi_ev_state ev_state; bool configured_irq; enum gpi_pm_state pm_state; rwlock_t pm_lock; struct gpi_ring ev_ring; struct tasklet_struct ev_task; /* event processing tasklet */ struct completion cmd_completion; enum gpi_cmd gpi_cmd; u32 cntxt_type_irq_msk; bool ieob_set; }; #define MAX_TRE 3 struct gpi_desc { struct virt_dma_desc vd; size_t len; void *db; /* DB register to program */ struct gchan *gchan; struct gpi_tre tre[MAX_TRE]; u32 num_tre; }; static const u32 GPII_CHAN_DIR[MAX_CHANNELS_PER_GPII] = { GPI_CHTYPE_DIR_OUT, GPI_CHTYPE_DIR_IN }; static irqreturn_t gpi_handle_irq(int irq, void *data); static void gpi_ring_recycle_ev_element(struct gpi_ring *ring); static int gpi_ring_add_element(struct gpi_ring *ring, void **wp); static void gpi_process_events(struct gpii *gpii); static inline struct gchan *to_gchan(struct dma_chan *dma_chan) { return container_of(dma_chan, struct gchan, vc.chan); } static inline struct gpi_desc *to_gpi_desc(struct virt_dma_desc *vd) { return container_of(vd, struct gpi_desc, vd); } static inline phys_addr_t to_physical(const struct gpi_ring *const ring, void *addr) { return ring->phys_addr + (addr - ring->base); } static inline void *to_virtual(const struct gpi_ring *const ring, phys_addr_t addr) { return ring->base + (addr - ring->phys_addr); } static inline u32 gpi_read_reg(struct gpii *gpii, void __iomem *addr) { return readl_relaxed(addr); } static inline void gpi_write_reg(struct gpii *gpii, void __iomem *addr, u32 val) { writel_relaxed(val, addr); } /* gpi_write_reg_field - write to specific bit field */ static inline void gpi_write_reg_field(struct gpii *gpii, void __iomem *addr, u32 mask, u32 shift, u32 val) { u32 tmp = gpi_read_reg(gpii, addr); tmp &= ~mask; val = tmp | ((val << shift) & mask); gpi_write_reg(gpii, addr, val); } static __always_inline void gpi_update_reg(struct gpii *gpii, u32 offset, u32 mask, u32 val) { void __iomem *addr = gpii->regs + offset; u32 tmp = gpi_read_reg(gpii, addr); tmp &= ~mask; tmp |= u32_encode_bits(val, mask); gpi_write_reg(gpii, addr, tmp); } static void gpi_disable_interrupts(struct gpii *gpii) { gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(gpii->gpii_id), GPII_n_CNTXT_GPII_IRQ_EN_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_GPII_IRQ_EN_OFFS(gpii->gpii_id), GPII_n_CNTXT_GPII_IRQ_EN_BMSK, 0); gpi_update_reg(gpii, GPII_n_CNTXT_INTSET_OFFS(gpii->gpii_id), GPII_n_CNTXT_INTSET_BMSK, 0); gpii->cntxt_type_irq_msk = 0; devm_free_irq(gpii->gpi_dev->dev, gpii->irq, gpii); gpii->configured_irq = false; } /* configure and enable interrupts */ static int gpi_config_interrupts(struct gpii *gpii, enum gpii_irq_settings settings, bool mask) { const u32 enable = (GPII_n_CNTXT_TYPE_IRQ_MSK_GENERAL | GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB | GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB | GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL | GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL); int ret; if (!gpii->configured_irq) { ret = devm_request_irq(gpii->gpi_dev->dev, gpii->irq, gpi_handle_irq, IRQF_TRIGGER_HIGH, "gpi-dma", gpii); if (ret < 0) { dev_err(gpii->gpi_dev->dev, "error request irq:%d ret:%d\n", gpii->irq, ret); return ret; } } if (settings == MASK_IEOB_SETTINGS) { /* * GPII only uses one EV ring per gpii so we can globally * enable/disable IEOB interrupt */ if (mask) gpii->cntxt_type_irq_msk |= GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB; else gpii->cntxt_type_irq_msk &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB); gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, gpii->cntxt_type_irq_msk); } else { gpi_update_reg(gpii, GPII_n_CNTXT_TYPE_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_TYPE_IRQ_MSK_BMSK, enable); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK, GPII_n_CNTXT_SRC_IEOB_IRQ_MSK_BMSK); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_CH_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK, GPII_n_CNTXT_SRC_CH_IRQ_MSK_BMSK); gpi_update_reg(gpii, GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_OFFS(gpii->gpii_id), GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK, GPII_n_CNTXT_SRC_EV_CH_IRQ_MSK_BMSK); gpi_update_reg(gpii, GPII_n_CNTXT_GLOB_IRQ_EN_OFFS(gpii->gpii_id), GPII_n_CNTXT_GPII_IRQ_EN_BMSK, GPII_n_CNTXT_GPII_IRQ_EN_BMSK); gpi_update_reg(gpii, GPII_n_CNTXT_GPII_IRQ_EN_OFFS(gpii->gpii_id), GPII_n_CNTXT_GPII_IRQ_EN_BMSK, GPII_n_CNTXT_GPII_IRQ_EN_BMSK); gpi_update_reg(gpii, GPII_n_CNTXT_MSI_BASE_LSB_OFFS(gpii->gpii_id), U32_MAX, 0); gpi_update_reg(gpii, GPII_n_CNTXT_MSI_BASE_MSB_OFFS(gpii->gpii_id), U32_MAX, 0); gpi_update_reg(gpii, GPII_n_CNTXT_SCRATCH_0_OFFS(gpii->gpii_id), U32_MAX, 0); gpi_update_reg(gpii, GPII_n_CNTXT_SCRATCH_1_OFFS(gpii->gpii_id), U32_MAX, 0); gpi_update_reg(gpii, GPII_n_CNTXT_INTSET_OFFS(gpii->gpii_id), GPII_n_CNTXT_INTSET_BMSK, 1); gpi_update_reg(gpii, GPII_n_ERROR_LOG_OFFS(gpii->gpii_id), U32_MAX, 0); gpii->cntxt_type_irq_msk = enable; } gpii->configured_irq = true; return 0; } /* Sends gpii event or channel command */ static int gpi_send_cmd(struct gpii *gpii, struct gchan *gchan, enum gpi_cmd gpi_cmd) { u32 chid = MAX_CHANNELS_PER_GPII; unsigned long timeout; void __iomem *cmd_reg; u32 cmd; if (gpi_cmd >= GPI_MAX_CMD) return -EINVAL; if (IS_CHAN_CMD(gpi_cmd)) chid = gchan->chid; dev_dbg(gpii->gpi_dev->dev, "sending cmd: %s:%u\n", TO_GPI_CMD_STR(gpi_cmd), chid); /* send opcode and wait for completion */ reinit_completion(&gpii->cmd_completion); gpii->gpi_cmd = gpi_cmd; cmd_reg = IS_CHAN_CMD(gpi_cmd) ? gchan->ch_cmd_reg : gpii->ev_cmd_reg; cmd = IS_CHAN_CMD(gpi_cmd) ? GPII_n_CH_CMD(gpi_cmd_info[gpi_cmd].opcode, chid) : GPII_n_EV_CMD(gpi_cmd_info[gpi_cmd].opcode, 0); gpi_write_reg(gpii, cmd_reg, cmd); timeout = wait_for_completion_timeout(&gpii->cmd_completion, msecs_to_jiffies(CMD_TIMEOUT_MS)); if (!timeout) { dev_err(gpii->gpi_dev->dev, "cmd: %s completion timeout:%u\n", TO_GPI_CMD_STR(gpi_cmd), chid); return -EIO; } /* confirm new ch state is correct , if the cmd is a state change cmd */ if (gpi_cmd_info[gpi_cmd].state == STATE_IGNORE) return 0; if (IS_CHAN_CMD(gpi_cmd) && gchan->ch_state == gpi_cmd_info[gpi_cmd].state) return 0; if (!IS_CHAN_CMD(gpi_cmd) && gpii->ev_state == gpi_cmd_info[gpi_cmd].state) return 0; return -EIO; } /* program transfer ring DB register */ static inline void gpi_write_ch_db(struct gchan *gchan, struct gpi_ring *ring, void *wp) { struct gpii *gpii = gchan->gpii; phys_addr_t p_wp; p_wp = to_physical(ring, wp); gpi_write_reg(gpii, gchan->ch_cntxt_db_reg, p_wp); } /* program event ring DB register */ static inline void gpi_write_ev_db(struct gpii *gpii, struct gpi_ring *ring, void *wp) { phys_addr_t p_wp; p_wp = ring->phys_addr + (wp - ring->base); gpi_write_reg(gpii, gpii->ev_cntxt_db_reg, p_wp); } /* process transfer completion interrupt */ static void gpi_process_ieob(struct gpii *gpii) { gpi_write_reg(gpii, gpii->ieob_clr_reg, BIT(0)); gpi_config_interrupts(gpii, MASK_IEOB_SETTINGS, 0); tasklet_hi_schedule(&gpii->ev_task); } /* process channel control interrupt */ static void gpi_process_ch_ctrl_irq(struct gpii *gpii) { u32 gpii_id = gpii->gpii_id; u32 offset = GPII_n_CNTXT_SRC_GPII_CH_IRQ_OFFS(gpii_id); u32 ch_irq = gpi_read_reg(gpii, gpii->regs + offset); struct gchan *gchan; u32 chid, state; /* clear the status */ offset = GPII_n_CNTXT_SRC_CH_IRQ_CLR_OFFS(gpii_id); gpi_write_reg(gpii, gpii->regs + offset, (u32)ch_irq); for (chid = 0; chid < MAX_CHANNELS_PER_GPII; chid++) { if (!(BIT(chid) & ch_irq)) continue; gchan = &gpii->gchan[chid]; state = gpi_read_reg(gpii, gchan->ch_cntxt_base_reg + CNTXT_0_CONFIG); state = FIELD_GET(GPII_n_CH_k_CNTXT_0_CHSTATE, state); /* * CH_CMD_DEALLOC cmd always successful. However cmd does * not change hardware status. So overwriting software state * to default state. */ if (gpii->gpi_cmd == GPI_CH_CMD_DE_ALLOC) state = DEFAULT_CH_STATE; gchan->ch_state = state; /* * Triggering complete all if ch_state is not a stop in process. * Stop in process is a transition state and we will wait for * stop interrupt before notifying. */ if (gchan->ch_state != CH_STATE_STOP_IN_PROC) complete_all(&gpii->cmd_completion); } } /* processing gpi general error interrupts */ static void gpi_process_gen_err_irq(struct gpii *gpii) { u32 gpii_id = gpii->gpii_id; u32 offset = GPII_n_CNTXT_GPII_IRQ_STTS_OFFS(gpii_id); u32 irq_stts = gpi_read_reg(gpii, gpii->regs + offset); /* clear the status */ dev_dbg(gpii->gpi_dev->dev, "irq_stts:0x%x\n", irq_stts); /* Clear the register */ offset = GPII_n_CNTXT_GPII_IRQ_CLR_OFFS(gpii_id); gpi_write_reg(gpii, gpii->regs + offset, irq_stts); } /* processing gpi level error interrupts */ static void gpi_process_glob_err_irq(struct gpii *gpii) { u32 gpii_id = gpii->gpii_id; u32 offset = GPII_n_CNTXT_GLOB_IRQ_STTS_OFFS(gpii_id); u32 irq_stts = gpi_read_reg(gpii, gpii->regs + offset); offset = GPII_n_CNTXT_GLOB_IRQ_CLR_OFFS(gpii_id); gpi_write_reg(gpii, gpii->regs + offset, irq_stts); /* only error interrupt should be set */ if (irq_stts & ~GPI_GLOB_IRQ_ERROR_INT_MSK) { dev_err(gpii->gpi_dev->dev, "invalid error status:0x%x\n", irq_stts); return; } offset = GPII_n_ERROR_LOG_OFFS(gpii_id); gpi_write_reg(gpii, gpii->regs + offset, 0); } /* gpii interrupt handler */ static irqreturn_t gpi_handle_irq(int irq, void *data) { struct gpii *gpii = data; u32 gpii_id = gpii->gpii_id; u32 type, offset; unsigned long flags; read_lock_irqsave(&gpii->pm_lock, flags); /* * States are out of sync to receive interrupt * while software state is in DISABLE state, bailing out. */ if (!REG_ACCESS_VALID(gpii->pm_state)) { dev_err(gpii->gpi_dev->dev, "receive interrupt while in %s state\n", TO_GPI_PM_STR(gpii->pm_state)); goto exit_irq; } offset = GPII_n_CNTXT_TYPE_IRQ_OFFS(gpii->gpii_id); type = gpi_read_reg(gpii, gpii->regs + offset); do { /* global gpii error */ if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB) { gpi_process_glob_err_irq(gpii); type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_GLOB); } /* transfer complete interrupt */ if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB) { gpi_process_ieob(gpii); type &= ~GPII_n_CNTXT_TYPE_IRQ_MSK_IEOB; } /* event control irq */ if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL) { u32 ev_state; u32 ev_ch_irq; dev_dbg(gpii->gpi_dev->dev, "processing EV CTRL interrupt\n"); offset = GPII_n_CNTXT_SRC_EV_CH_IRQ_OFFS(gpii_id); ev_ch_irq = gpi_read_reg(gpii, gpii->regs + offset); offset = GPII_n_CNTXT_SRC_EV_CH_IRQ_CLR_OFFS (gpii_id); gpi_write_reg(gpii, gpii->regs + offset, ev_ch_irq); ev_state = gpi_read_reg(gpii, gpii->ev_cntxt_base_reg + CNTXT_0_CONFIG); ev_state = FIELD_GET(GPII_n_EV_k_CNTXT_0_CHSTATE, ev_state); /* * CMD EV_CMD_DEALLOC is always successful. However * cmd does not change hardware status. So overwriting * software state to default state. */ if (gpii->gpi_cmd == GPI_EV_CMD_DEALLOC) ev_state = DEFAULT_EV_CH_STATE; gpii->ev_state = ev_state; dev_dbg(gpii->gpi_dev->dev, "setting EV state to %s\n", TO_GPI_EV_STATE_STR(gpii->ev_state)); complete_all(&gpii->cmd_completion); type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_EV_CTRL); } /* channel control irq */ if (type & GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL) { dev_dbg(gpii->gpi_dev->dev, "process CH CTRL interrupts\n"); gpi_process_ch_ctrl_irq(gpii); type &= ~(GPII_n_CNTXT_TYPE_IRQ_MSK_CH_CTRL); } if (type) { dev_err(gpii->gpi_dev->dev, "Unhandled interrupt status:0x%x\n", type); gpi_process_gen_err_irq(gpii); goto exit_irq; } offset = GPII_n_CNTXT_TYPE_IRQ_OFFS(gpii->gpii_id); type = gpi_read_reg(gpii, gpii->regs + offset); } while (type); exit_irq: read_unlock_irqrestore(&gpii->pm_lock, flags); return IRQ_HANDLED; } /* process DMA Immediate completion data events */ static void gpi_process_imed_data_event(struct gchan *gchan, struct immediate_data_event *imed_event) { struct gpii *gpii = gchan->gpii; struct gpi_ring *ch_ring = &gchan->ch_ring; void *tre = ch_ring->base + (ch_ring->el_size * imed_event->tre_index); struct dmaengine_result result; struct gpi_desc *gpi_desc; struct virt_dma_desc *vd; unsigned long flags; u32 chid; /* * If channel not active don't process event */ if (gchan->pm_state != ACTIVE_STATE) { dev_err(gpii->gpi_dev->dev, "skipping processing event because ch @ %s state\n", TO_GPI_PM_STR(gchan->pm_state)); return; } spin_lock_irqsave(&gchan->vc.lock, flags); vd = vchan_next_desc(&gchan->vc); if (!vd) { struct gpi_ere *gpi_ere; struct gpi_tre *gpi_tre; spin_unlock_irqrestore(&gchan->vc.lock, flags); dev_dbg(gpii->gpi_dev->dev, "event without a pending descriptor!\n"); gpi_ere = (struct gpi_ere *)imed_event; dev_dbg(gpii->gpi_dev->dev, "Event: %08x %08x %08x %08x\n", gpi_ere->dword[0], gpi_ere->dword[1], gpi_ere->dword[2], gpi_ere->dword[3]); gpi_tre = tre; dev_dbg(gpii->gpi_dev->dev, "Pending TRE: %08x %08x %08x %08x\n", gpi_tre->dword[0], gpi_tre->dword[1], gpi_tre->dword[2], gpi_tre->dword[3]); return; } gpi_desc = to_gpi_desc(vd); spin_unlock_irqrestore(&gchan->vc.lock, flags); /* * RP pointed by Event is to last TRE processed, * we need to update ring rp to tre + 1 */ tre += ch_ring->el_size; if (tre >= (ch_ring->base + ch_ring->len)) tre = ch_ring->base; ch_ring->rp = tre; /* make sure rp updates are immediately visible to all cores */ smp_wmb(); chid = imed_event->chid; if (imed_event->code == MSM_GPI_TCE_EOT && gpii->ieob_set) { if (chid == GPI_RX_CHAN) goto gpi_free_desc; else return; } if (imed_event->code == MSM_GPI_TCE_UNEXP_ERR) result.result = DMA_TRANS_ABORTED; else result.result = DMA_TRANS_NOERROR; result.residue = gpi_desc->len - imed_event->length; dma_cookie_complete(&vd->tx); dmaengine_desc_get_callback_invoke(&vd->tx, &result); gpi_free_desc: spin_lock_irqsave(&gchan->vc.lock, flags); list_del(&vd->node); spin_unlock_irqrestore(&gchan->vc.lock, flags); kfree(gpi_desc); gpi_desc = NULL; } /* processing transfer completion events */ static void gpi_process_xfer_compl_event(struct gchan *gchan, struct xfer_compl_event *compl_event) { struct gpii *gpii = gchan->gpii; struct gpi_ring *ch_ring = &gchan->ch_ring; void *ev_rp = to_virtual(ch_ring, compl_event->ptr); struct virt_dma_desc *vd; struct gpi_desc *gpi_desc; struct dmaengine_result result; unsigned long flags; u32 chid; /* only process events on active channel */ if (unlikely(gchan->pm_state != ACTIVE_STATE)) { dev_err(gpii->gpi_dev->dev, "skipping processing event because ch @ %s state\n", TO_GPI_PM_STR(gchan->pm_state)); return; } spin_lock_irqsave(&gchan->vc.lock, flags); vd = vchan_next_desc(&gchan->vc); if (!vd) { struct gpi_ere *gpi_ere; spin_unlock_irqrestore(&gchan->vc.lock, flags); dev_err(gpii->gpi_dev->dev, "Event without a pending descriptor!\n"); gpi_ere = (struct gpi_ere *)compl_event; dev_err(gpii->gpi_dev->dev, "Event: %08x %08x %08x %08x\n", gpi_ere->dword[0], gpi_ere->dword[1], gpi_ere->dword[2], gpi_ere->dword[3]); return; } gpi_desc = to_gpi_desc(vd); spin_unlock_irqrestore(&gchan->vc.lock, flags); /* * RP pointed by Event is to last TRE processed, * we need to update ring rp to ev_rp + 1 */ ev_rp += ch_ring->el_size; if (ev_rp >= (ch_ring->base + ch_ring->len)) ev_rp = ch_ring->base; ch_ring->rp = ev_rp; /* update must be visible to other cores */ smp_wmb(); chid = compl_event->chid; if (compl_event->code == MSM_GPI_TCE_EOT && gpii->ieob_set) { if (chid == GPI_RX_CHAN) goto gpi_free_desc; else return; } if (compl_event->code == MSM_GPI_TCE_UNEXP_ERR) { dev_err(gpii->gpi_dev->dev, "Error in Transaction\n"); result.result = DMA_TRANS_ABORTED; } else { dev_dbg(gpii->gpi_dev->dev, "Transaction Success\n"); result.result = DMA_TRANS_NOERROR; } result.residue = gpi_desc->len - compl_event->length; dev_dbg(gpii->gpi_dev->dev, "Residue %d\n", result.residue); dma_cookie_complete(&vd->tx); dmaengine_desc_get_callback_invoke(&vd->tx, &result); gpi_free_desc: spin_lock_irqsave(&gchan->vc.lock, flags); list_del(&vd->node); spin_unlock_irqrestore(&gchan->vc.lock, flags); kfree(gpi_desc); gpi_desc = NULL; } /* process all events */ static void gpi_process_events(struct gpii *gpii) { struct gpi_ring *ev_ring = &gpii->ev_ring; phys_addr_t cntxt_rp; void *rp; union gpi_event *gpi_event; struct gchan *gchan; u32 chid, type; cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg); rp = to_virtual(ev_ring, cntxt_rp); do { while (rp != ev_ring->rp) { gpi_event = ev_ring->rp; chid = gpi_event->xfer_compl_event.chid; type = gpi_event->xfer_compl_event.type; dev_dbg(gpii->gpi_dev->dev, "Event: CHID:%u, type:%x %08x %08x %08x %08x\n", chid, type, gpi_event->gpi_ere.dword[0], gpi_event->gpi_ere.dword[1], gpi_event->gpi_ere.dword[2], gpi_event->gpi_ere.dword[3]); switch (type) { case XFER_COMPLETE_EV_TYPE: gchan = &gpii->gchan[chid]; gpi_process_xfer_compl_event(gchan, &gpi_event->xfer_compl_event); break; case STALE_EV_TYPE: dev_dbg(gpii->gpi_dev->dev, "stale event, not processing\n"); break; case IMMEDIATE_DATA_EV_TYPE: gchan = &gpii->gchan[chid]; gpi_process_imed_data_event(gchan, &gpi_event->immediate_data_event); break; case QUP_NOTIF_EV_TYPE: dev_dbg(gpii->gpi_dev->dev, "QUP_NOTIF_EV_TYPE\n"); break; default: dev_dbg(gpii->gpi_dev->dev, "not supported event type:0x%x\n", type); } gpi_ring_recycle_ev_element(ev_ring); } gpi_write_ev_db(gpii, ev_ring, ev_ring->wp); /* clear pending IEOB events */ gpi_write_reg(gpii, gpii->ieob_clr_reg, BIT(0)); cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg); rp = to_virtual(ev_ring, cntxt_rp); } while (rp != ev_ring->rp); } /* processing events using tasklet */ static void gpi_ev_tasklet(unsigned long data) { struct gpii *gpii = (struct gpii *)data; read_lock(&gpii->pm_lock); if (!REG_ACCESS_VALID(gpii->pm_state)) { read_unlock(&gpii->pm_lock); dev_err(gpii->gpi_dev->dev, "not processing any events, pm_state:%s\n", TO_GPI_PM_STR(gpii->pm_state)); return; } /* process the events */ gpi_process_events(gpii); /* enable IEOB, switching back to interrupts */ gpi_config_interrupts(gpii, MASK_IEOB_SETTINGS, 1); read_unlock(&gpii->pm_lock); } /* marks all pending events for the channel as stale */ static void gpi_mark_stale_events(struct gchan *gchan) { struct gpii *gpii = gchan->gpii; struct gpi_ring *ev_ring = &gpii->ev_ring; u32 cntxt_rp, local_rp; void *ev_rp; cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg); ev_rp = ev_ring->rp; local_rp = (u32)to_physical(ev_ring, ev_rp); while (local_rp != cntxt_rp) { union gpi_event *gpi_event = ev_rp; u32 chid = gpi_event->xfer_compl_event.chid; if (chid == gchan->chid) gpi_event->xfer_compl_event.type = STALE_EV_TYPE; ev_rp += ev_ring->el_size; if (ev_rp >= (ev_ring->base + ev_ring->len)) ev_rp = ev_ring->base; cntxt_rp = gpi_read_reg(gpii, gpii->ev_ring_rp_lsb_reg); local_rp = (u32)to_physical(ev_ring, ev_rp); } } /* reset sw state and issue channel reset or de-alloc */ static int gpi_reset_chan(struct gchan *gchan, enum gpi_cmd gpi_cmd) { struct gpii *gpii = gchan->gpii; struct gpi_ring *ch_ring = &gchan->ch_ring; LIST_HEAD(list); int ret; ret = gpi_send_cmd(gpii, gchan, gpi_cmd); if (ret) { dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n", TO_GPI_CMD_STR(gpi_cmd), ret); return ret; } /* initialize the local ring ptrs */ ch_ring->rp = ch_ring->base; ch_ring->wp = ch_ring->base; /* visible to other cores */ smp_wmb(); /* check event ring for any stale events */ write_lock_irq(&gpii->pm_lock); gpi_mark_stale_events(gchan); /* remove all async descriptors */ spin_lock(&gchan->vc.lock); vchan_get_all_descriptors(&gchan->vc, &list); spin_unlock(&gchan->vc.lock); write_unlock_irq(&gpii->pm_lock); vchan_dma_desc_free_list(&gchan->vc, &list); return 0; } static int gpi_start_chan(struct gchan *gchan) { struct gpii *gpii = gchan->gpii; int ret; ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_START); if (ret) { dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n", TO_GPI_CMD_STR(GPI_CH_CMD_START), ret); return ret; } /* gpii CH is active now */ write_lock_irq(&gpii->pm_lock); gchan->pm_state = ACTIVE_STATE; write_unlock_irq(&gpii->pm_lock); return 0; } static int gpi_stop_chan(struct gchan *gchan) { struct gpii *gpii = gchan->gpii; int ret; ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_STOP); if (ret) { dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n", TO_GPI_CMD_STR(GPI_CH_CMD_STOP), ret); return ret; } return 0; } /* allocate and configure the transfer channel */ static int gpi_alloc_chan(struct gchan *chan, bool send_alloc_cmd) { struct gpii *gpii = chan->gpii; struct gpi_ring *ring = &chan->ch_ring; int ret; u32 id = gpii->gpii_id; u32 chid = chan->chid; u32 pair_chid = !chid; if (send_alloc_cmd) { ret = gpi_send_cmd(gpii, chan, GPI_CH_CMD_ALLOCATE); if (ret) { dev_err(gpii->gpi_dev->dev, "Error with cmd:%s ret:%d\n", TO_GPI_CMD_STR(GPI_CH_CMD_ALLOCATE), ret); return ret; } } gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_0_CONFIG, GPII_n_CH_k_CNTXT_0(ring->el_size, 0, chan->dir, GPI_CHTYPE_PROTO_GPI)); gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_1_R_LENGTH, ring->len); gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_2_RING_BASE_LSB, ring->phys_addr); gpi_write_reg(gpii, chan->ch_cntxt_base_reg + CNTXT_3_RING_BASE_MSB, upper_32_bits(ring->phys_addr)); gpi_write_reg(gpii, chan->ch_cntxt_db_reg + CNTXT_5_RING_RP_MSB - CNTXT_4_RING_RP_LSB, upper_32_bits(ring->phys_addr)); gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_0_OFFS(id, chid), GPII_n_CH_k_SCRATCH_0(pair_chid, chan->protocol, chan->seid)); gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_1_OFFS(id, chid), 0); gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_2_OFFS(id, chid), 0); gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_SCRATCH_3_OFFS(id, chid), 0); gpi_write_reg(gpii, gpii->regs + GPII_n_CH_k_QOS_OFFS(id, chid), 1); /* flush all the writes */ wmb(); return 0; } /* allocate and configure event ring */ static int gpi_alloc_ev_chan(struct gpii *gpii) { struct gpi_ring *ring = &gpii->ev_ring; void __iomem *base = gpii->ev_cntxt_base_reg; int ret; ret = gpi_send_cmd(gpii, NULL, GPI_EV_CMD_ALLOCATE); if (ret) { dev_err(gpii->gpi_dev->dev, "error with cmd:%s ret:%d\n", TO_GPI_CMD_STR(GPI_EV_CMD_ALLOCATE), ret); return ret; } /* program event context */ gpi_write_reg(gpii, base + CNTXT_0_CONFIG, GPII_n_EV_k_CNTXT_0(ring->el_size, GPI_INTTYPE_IRQ, GPI_CHTYPE_GPI_EV)); gpi_write_reg(gpii, base + CNTXT_1_R_LENGTH, ring->len); gpi_write_reg(gpii, base + CNTXT_2_RING_BASE_LSB, lower_32_bits(ring->phys_addr)); gpi_write_reg(gpii, base + CNTXT_3_RING_BASE_MSB, upper_32_bits(ring->phys_addr)); gpi_write_reg(gpii, gpii->ev_cntxt_db_reg + CNTXT_5_RING_RP_MSB - CNTXT_4_RING_RP_LSB, upper_32_bits(ring->phys_addr)); gpi_write_reg(gpii, base + CNTXT_8_RING_INT_MOD, 0); gpi_write_reg(gpii, base + CNTXT_10_RING_MSI_LSB, 0); gpi_write_reg(gpii, base + CNTXT_11_RING_MSI_MSB, 0); gpi_write_reg(gpii, base + CNTXT_8_RING_INT_MOD, 0); gpi_write_reg(gpii, base + CNTXT_12_RING_RP_UPDATE_LSB, 0); gpi_write_reg(gpii, base + CNTXT_13_RING_RP_UPDATE_MSB, 0); /* add events to ring */ ring->wp = (ring->base + ring->len - ring->el_size); /* flush all the writes */ wmb(); /* gpii is active now */ write_lock_irq(&gpii->pm_lock); gpii->pm_state = ACTIVE_STATE; write_unlock_irq(&gpii->pm_lock); gpi_write_ev_db(gpii, ring, ring->wp); return 0; } /* calculate # of ERE/TRE available to queue */ static int gpi_ring_num_elements_avail(const struct gpi_ring * const ring) { int elements = 0; if (ring->wp < ring->rp) { elements = ((ring->rp - ring->wp) / ring->el_size) - 1; } else { elements = (ring->rp - ring->base) / ring->el_size; elements += ((ring->base + ring->len - ring->wp) / ring->el_size) - 1; } return elements; } static int gpi_ring_add_element(struct gpi_ring *ring, void **wp) { if (gpi_ring_num_elements_avail(ring) <= 0) return -ENOMEM; *wp = ring->wp; ring->wp += ring->el_size; if (ring->wp >= (ring->base + ring->len)) ring->wp = ring->base; /* visible to other cores */ smp_wmb(); return 0; } static void gpi_ring_recycle_ev_element(struct gpi_ring *ring) { /* Update the WP */ ring->wp += ring->el_size; if (ring->wp >= (ring->base + ring->len)) ring->wp = ring->base; /* Update the RP */ ring->rp += ring->el_size; if (ring->rp >= (ring->base + ring->len)) ring->rp = ring->base; /* visible to other cores */ smp_wmb(); } static void gpi_free_ring(struct gpi_ring *ring, struct gpii *gpii) { dma_free_coherent(gpii->gpi_dev->dev, ring->alloc_size, ring->pre_aligned, ring->dma_handle); memset(ring, 0, sizeof(*ring)); } /* allocate memory for transfer and event rings */ static int gpi_alloc_ring(struct gpi_ring *ring, u32 elements, u32 el_size, struct gpii *gpii) { u64 len = elements * el_size; int bit; /* ring len must be power of 2 */ bit = find_last_bit((unsigned long *)&len, 32); if (((1 << bit) - 1) & len) bit++; len = 1 << bit; ring->alloc_size = (len + (len - 1)); dev_dbg(gpii->gpi_dev->dev, "#el:%u el_size:%u len:%u actual_len:%llu alloc_size:%zu\n", elements, el_size, (elements * el_size), len, ring->alloc_size); ring->pre_aligned = dma_alloc_coherent(gpii->gpi_dev->dev, ring->alloc_size, &ring->dma_handle, GFP_KERNEL); if (!ring->pre_aligned) { dev_err(gpii->gpi_dev->dev, "could not alloc size:%zu mem for ring\n", ring->alloc_size); return -ENOMEM; } /* align the physical mem */ ring->phys_addr = (ring->dma_handle + (len - 1)) & ~(len - 1); ring->base = ring->pre_aligned + (ring->phys_addr - ring->dma_handle); ring->rp = ring->base; ring->wp = ring->base; ring->len = len; ring->el_size = el_size; ring->elements = ring->len / ring->el_size; memset(ring->base, 0, ring->len); ring->configured = true; /* update to other cores */ smp_wmb(); dev_dbg(gpii->gpi_dev->dev, "phy_pre:%pad phy_alig:%pa len:%u el_size:%u elements:%u\n", &ring->dma_handle, &ring->phys_addr, ring->len, ring->el_size, ring->elements); return 0; } /* copy tre into transfer ring */ static void gpi_queue_xfer(struct gpii *gpii, struct gchan *gchan, struct gpi_tre *gpi_tre, void **wp) { struct gpi_tre *ch_tre; int ret; /* get next tre location we can copy */ ret = gpi_ring_add_element(&gchan->ch_ring, (void **)&ch_tre); if (unlikely(ret)) { dev_err(gpii->gpi_dev->dev, "Error adding ring element to xfer ring\n"); return; } /* copy the tre info */ memcpy(ch_tre, gpi_tre, sizeof(*ch_tre)); *wp = ch_tre; } /* reset and restart transfer channel */ static int gpi_terminate_all(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; int schid, echid, i; int ret = 0; mutex_lock(&gpii->ctrl_lock); /* * treat both channels as a group if its protocol is not UART * STOP, RESET, or START needs to be in lockstep */ schid = (gchan->protocol == QCOM_GPI_UART) ? gchan->chid : 0; echid = (gchan->protocol == QCOM_GPI_UART) ? schid + 1 : MAX_CHANNELS_PER_GPII; /* stop the channel */ for (i = schid; i < echid; i++) { gchan = &gpii->gchan[i]; /* disable ch state so no more TRE processing */ write_lock_irq(&gpii->pm_lock); gchan->pm_state = PREPARE_TERMINATE; write_unlock_irq(&gpii->pm_lock); /* send command to Stop the channel */ ret = gpi_stop_chan(gchan); } /* reset the channels (clears any pending tre) */ for (i = schid; i < echid; i++) { gchan = &gpii->gchan[i]; ret = gpi_reset_chan(gchan, GPI_CH_CMD_RESET); if (ret) { dev_err(gpii->gpi_dev->dev, "Error resetting channel ret:%d\n", ret); goto terminate_exit; } /* reprogram channel CNTXT */ ret = gpi_alloc_chan(gchan, false); if (ret) { dev_err(gpii->gpi_dev->dev, "Error alloc_channel ret:%d\n", ret); goto terminate_exit; } } /* restart the channels */ for (i = schid; i < echid; i++) { gchan = &gpii->gchan[i]; ret = gpi_start_chan(gchan); if (ret) { dev_err(gpii->gpi_dev->dev, "Error Starting Channel ret:%d\n", ret); goto terminate_exit; } } terminate_exit: mutex_unlock(&gpii->ctrl_lock); return ret; } /* pause dma transfer for all channels */ static int gpi_pause(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; int i, ret; mutex_lock(&gpii->ctrl_lock); /* * pause/resume are per gpii not per channel, so * client needs to call pause only once */ if (gpii->pm_state == PAUSE_STATE) { dev_dbg(gpii->gpi_dev->dev, "channel is already paused\n"); mutex_unlock(&gpii->ctrl_lock); return 0; } /* send stop command to stop the channels */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) { ret = gpi_stop_chan(&gpii->gchan[i]); if (ret) { mutex_unlock(&gpii->ctrl_lock); return ret; } } disable_irq(gpii->irq); /* Wait for threads to complete out */ tasklet_kill(&gpii->ev_task); write_lock_irq(&gpii->pm_lock); gpii->pm_state = PAUSE_STATE; write_unlock_irq(&gpii->pm_lock); mutex_unlock(&gpii->ctrl_lock); return 0; } /* resume dma transfer */ static int gpi_resume(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; int i, ret; mutex_lock(&gpii->ctrl_lock); if (gpii->pm_state == ACTIVE_STATE) { dev_dbg(gpii->gpi_dev->dev, "channel is already active\n"); mutex_unlock(&gpii->ctrl_lock); return 0; } enable_irq(gpii->irq); /* send start command to start the channels */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) { ret = gpi_send_cmd(gpii, &gpii->gchan[i], GPI_CH_CMD_START); if (ret) { dev_err(gpii->gpi_dev->dev, "Error starting chan, ret:%d\n", ret); mutex_unlock(&gpii->ctrl_lock); return ret; } } write_lock_irq(&gpii->pm_lock); gpii->pm_state = ACTIVE_STATE; write_unlock_irq(&gpii->pm_lock); mutex_unlock(&gpii->ctrl_lock); return 0; } static void gpi_desc_free(struct virt_dma_desc *vd) { struct gpi_desc *gpi_desc = to_gpi_desc(vd); kfree(gpi_desc); gpi_desc = NULL; } static int gpi_peripheral_config(struct dma_chan *chan, struct dma_slave_config *config) { struct gchan *gchan = to_gchan(chan); if (!config->peripheral_config) return -EINVAL; gchan->config = krealloc(gchan->config, config->peripheral_size, GFP_NOWAIT); if (!gchan->config) return -ENOMEM; memcpy(gchan->config, config->peripheral_config, config->peripheral_size); return 0; } static int gpi_create_i2c_tre(struct gchan *chan, struct gpi_desc *desc, struct scatterlist *sgl, enum dma_transfer_direction direction) { struct gpi_i2c_config *i2c = chan->config; struct device *dev = chan->gpii->gpi_dev->dev; unsigned int tre_idx = 0; dma_addr_t address; struct gpi_tre *tre; unsigned int i; /* first create config tre if applicable */ if (i2c->set_config) { tre = &desc->tre[tre_idx]; tre_idx++; tre->dword[0] = u32_encode_bits(i2c->low_count, TRE_I2C_C0_TLOW); tre->dword[0] |= u32_encode_bits(i2c->high_count, TRE_I2C_C0_THIGH); tre->dword[0] |= u32_encode_bits(i2c->cycle_count, TRE_I2C_C0_TCYL); tre->dword[0] |= u32_encode_bits(i2c->pack_enable, TRE_I2C_C0_TX_PACK); tre->dword[0] |= u32_encode_bits(i2c->pack_enable, TRE_I2C_C0_RX_PACK); tre->dword[1] = 0; tre->dword[2] = u32_encode_bits(i2c->clk_div, TRE_C0_CLK_DIV); tre->dword[3] = u32_encode_bits(TRE_TYPE_CONFIG0, TRE_FLAGS_TYPE); tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN); } /* create the GO tre for Tx */ if (i2c->op == I2C_WRITE) { tre = &desc->tre[tre_idx]; tre_idx++; if (i2c->multi_msg) tre->dword[0] = u32_encode_bits(I2C_READ, TRE_I2C_GO_CMD); else tre->dword[0] = u32_encode_bits(i2c->op, TRE_I2C_GO_CMD); tre->dword[0] |= u32_encode_bits(i2c->addr, TRE_I2C_GO_ADDR); tre->dword[0] |= u32_encode_bits(i2c->stretch, TRE_I2C_GO_STRETCH); tre->dword[1] = 0; tre->dword[2] = u32_encode_bits(i2c->rx_len, TRE_RX_LEN); tre->dword[3] = u32_encode_bits(TRE_TYPE_GO, TRE_FLAGS_TYPE); if (i2c->multi_msg) tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK); else tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN); } if (i2c->op == I2C_READ || i2c->multi_msg == false) { /* create the DMA TRE */ tre = &desc->tre[tre_idx]; tre_idx++; address = sg_dma_address(sgl); tre->dword[0] = lower_32_bits(address); tre->dword[1] = upper_32_bits(address); tre->dword[2] = u32_encode_bits(sg_dma_len(sgl), TRE_DMA_LEN); tre->dword[3] = u32_encode_bits(TRE_TYPE_DMA, TRE_FLAGS_TYPE); tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOT); } for (i = 0; i < tre_idx; i++) dev_dbg(dev, "TRE:%d %x:%x:%x:%x\n", i, desc->tre[i].dword[0], desc->tre[i].dword[1], desc->tre[i].dword[2], desc->tre[i].dword[3]); return tre_idx; } static int gpi_create_spi_tre(struct gchan *chan, struct gpi_desc *desc, struct scatterlist *sgl, enum dma_transfer_direction direction) { struct gpi_spi_config *spi = chan->config; struct device *dev = chan->gpii->gpi_dev->dev; unsigned int tre_idx = 0; dma_addr_t address; struct gpi_tre *tre; unsigned int i; /* first create config tre if applicable */ if (direction == DMA_MEM_TO_DEV && spi->set_config) { tre = &desc->tre[tre_idx]; tre_idx++; tre->dword[0] = u32_encode_bits(spi->word_len, TRE_SPI_C0_WORD_SZ); tre->dword[0] |= u32_encode_bits(spi->loopback_en, TRE_SPI_C0_LOOPBACK); tre->dword[0] |= u32_encode_bits(spi->clock_pol_high, TRE_SPI_C0_CPOL); tre->dword[0] |= u32_encode_bits(spi->data_pol_high, TRE_SPI_C0_CPHA); tre->dword[0] |= u32_encode_bits(spi->pack_en, TRE_SPI_C0_TX_PACK); tre->dword[0] |= u32_encode_bits(spi->pack_en, TRE_SPI_C0_RX_PACK); tre->dword[1] = 0; tre->dword[2] = u32_encode_bits(spi->clk_div, TRE_C0_CLK_DIV); tre->dword[2] |= u32_encode_bits(spi->clk_src, TRE_C0_CLK_SRC); tre->dword[3] = u32_encode_bits(TRE_TYPE_CONFIG0, TRE_FLAGS_TYPE); tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN); } /* create the GO tre for Tx */ if (direction == DMA_MEM_TO_DEV) { tre = &desc->tre[tre_idx]; tre_idx++; tre->dword[0] = u32_encode_bits(spi->fragmentation, TRE_SPI_GO_FRAG); tre->dword[0] |= u32_encode_bits(spi->cs, TRE_SPI_GO_CS); tre->dword[0] |= u32_encode_bits(spi->cmd, TRE_SPI_GO_CMD); tre->dword[1] = 0; tre->dword[2] = u32_encode_bits(spi->rx_len, TRE_RX_LEN); tre->dword[3] = u32_encode_bits(TRE_TYPE_GO, TRE_FLAGS_TYPE); if (spi->cmd == SPI_RX) { tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOB); tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK); } else if (spi->cmd == SPI_TX) { tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN); } else { /* SPI_DUPLEX */ tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_CHAIN); tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_LINK); } } /* create the dma tre */ tre = &desc->tre[tre_idx]; tre_idx++; address = sg_dma_address(sgl); tre->dword[0] = lower_32_bits(address); tre->dword[1] = upper_32_bits(address); tre->dword[2] = u32_encode_bits(sg_dma_len(sgl), TRE_DMA_LEN); tre->dword[3] = u32_encode_bits(TRE_TYPE_DMA, TRE_FLAGS_TYPE); if (direction == DMA_MEM_TO_DEV) tre->dword[3] |= u32_encode_bits(1, TRE_FLAGS_IEOT); for (i = 0; i < tre_idx; i++) dev_dbg(dev, "TRE:%d %x:%x:%x:%x\n", i, desc->tre[i].dword[0], desc->tre[i].dword[1], desc->tre[i].dword[2], desc->tre[i].dword[3]); return tre_idx; } /* copy tre into transfer ring */ static struct dma_async_tx_descriptor * gpi_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl, unsigned int sg_len, enum dma_transfer_direction direction, unsigned long flags, void *context) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; struct device *dev = gpii->gpi_dev->dev; struct gpi_ring *ch_ring = &gchan->ch_ring; struct gpi_desc *gpi_desc; u32 nr, nr_tre = 0; u8 set_config; int i; gpii->ieob_set = false; if (!is_slave_direction(direction)) { dev_err(gpii->gpi_dev->dev, "invalid dma direction: %d\n", direction); return NULL; } if (sg_len > 1) { dev_err(dev, "Multi sg sent, we support only one atm: %d\n", sg_len); return NULL; } nr_tre = 3; set_config = *(u32 *)gchan->config; if (!set_config) nr_tre = 2; if (direction == DMA_DEV_TO_MEM) /* rx */ nr_tre = 1; /* calculate # of elements required & available */ nr = gpi_ring_num_elements_avail(ch_ring); if (nr < nr_tre) { dev_err(dev, "not enough space in ring, avail:%u required:%u\n", nr, nr_tre); return NULL; } gpi_desc = kzalloc(sizeof(*gpi_desc), GFP_NOWAIT); if (!gpi_desc) return NULL; /* create TREs for xfer */ if (gchan->protocol == QCOM_GPI_SPI) { i = gpi_create_spi_tre(gchan, gpi_desc, sgl, direction); } else if (gchan->protocol == QCOM_GPI_I2C) { i = gpi_create_i2c_tre(gchan, gpi_desc, sgl, direction); } else { dev_err(dev, "invalid peripheral: %d\n", gchan->protocol); kfree(gpi_desc); return NULL; } /* set up the descriptor */ gpi_desc->gchan = gchan; gpi_desc->len = sg_dma_len(sgl); gpi_desc->num_tre = i; return vchan_tx_prep(&gchan->vc, &gpi_desc->vd, flags); } /* rings transfer ring db to being transfer */ static void gpi_issue_pending(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; unsigned long flags, pm_lock_flags; struct virt_dma_desc *vd = NULL; struct gpi_desc *gpi_desc; struct gpi_ring *ch_ring = &gchan->ch_ring; void *tre, *wp = NULL; int i; read_lock_irqsave(&gpii->pm_lock, pm_lock_flags); /* move all submitted descriptors to issued list */ spin_lock_irqsave(&gchan->vc.lock, flags); if (vchan_issue_pending(&gchan->vc)) vd = list_last_entry(&gchan->vc.desc_issued, struct virt_dma_desc, node); spin_unlock_irqrestore(&gchan->vc.lock, flags); /* nothing to do list is empty */ if (!vd) { read_unlock_irqrestore(&gpii->pm_lock, pm_lock_flags); return; } gpi_desc = to_gpi_desc(vd); for (i = 0; i < gpi_desc->num_tre; i++) { tre = &gpi_desc->tre[i]; gpi_queue_xfer(gpii, gchan, tre, &wp); } gpi_desc->db = ch_ring->wp; gpi_write_ch_db(gchan, &gchan->ch_ring, gpi_desc->db); read_unlock_irqrestore(&gpii->pm_lock, pm_lock_flags); } static int gpi_ch_init(struct gchan *gchan) { struct gpii *gpii = gchan->gpii; const int ev_factor = gpii->gpi_dev->ev_factor; u32 elements; int i = 0, ret = 0; gchan->pm_state = CONFIG_STATE; /* check if both channels are configured before continue */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) if (gpii->gchan[i].pm_state != CONFIG_STATE) goto exit_gpi_init; /* protocol must be same for both channels */ if (gpii->gchan[0].protocol != gpii->gchan[1].protocol) { dev_err(gpii->gpi_dev->dev, "protocol did not match protocol %u != %u\n", gpii->gchan[0].protocol, gpii->gchan[1].protocol); ret = -EINVAL; goto exit_gpi_init; } /* allocate memory for event ring */ elements = CHAN_TRES << ev_factor; ret = gpi_alloc_ring(&gpii->ev_ring, elements, sizeof(union gpi_event), gpii); if (ret) goto exit_gpi_init; /* configure interrupts */ write_lock_irq(&gpii->pm_lock); gpii->pm_state = PREPARE_HARDWARE; write_unlock_irq(&gpii->pm_lock); ret = gpi_config_interrupts(gpii, DEFAULT_IRQ_SETTINGS, 0); if (ret) { dev_err(gpii->gpi_dev->dev, "error config. interrupts, ret:%d\n", ret); goto error_config_int; } /* allocate event rings */ ret = gpi_alloc_ev_chan(gpii); if (ret) { dev_err(gpii->gpi_dev->dev, "error alloc_ev_chan:%d\n", ret); goto error_alloc_ev_ring; } /* Allocate all channels */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) { ret = gpi_alloc_chan(&gpii->gchan[i], true); if (ret) { dev_err(gpii->gpi_dev->dev, "Error allocating chan:%d\n", ret); goto error_alloc_chan; } } /* start channels */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) { ret = gpi_start_chan(&gpii->gchan[i]); if (ret) { dev_err(gpii->gpi_dev->dev, "Error start chan:%d\n", ret); goto error_start_chan; } } return ret; error_start_chan: for (i = i - 1; i >= 0; i--) { gpi_stop_chan(&gpii->gchan[i]); gpi_send_cmd(gpii, gchan, GPI_CH_CMD_RESET); } i = 2; error_alloc_chan: for (i = i - 1; i >= 0; i--) gpi_reset_chan(gchan, GPI_CH_CMD_DE_ALLOC); error_alloc_ev_ring: gpi_disable_interrupts(gpii); error_config_int: gpi_free_ring(&gpii->ev_ring, gpii); exit_gpi_init: return ret; } /* release all channel resources */ static void gpi_free_chan_resources(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; enum gpi_pm_state cur_state; int ret, i; mutex_lock(&gpii->ctrl_lock); cur_state = gchan->pm_state; /* disable ch state so no more TRE processing for this channel */ write_lock_irq(&gpii->pm_lock); gchan->pm_state = PREPARE_TERMINATE; write_unlock_irq(&gpii->pm_lock); /* attempt to do graceful hardware shutdown */ if (cur_state == ACTIVE_STATE) { gpi_stop_chan(gchan); ret = gpi_send_cmd(gpii, gchan, GPI_CH_CMD_RESET); if (ret) dev_err(gpii->gpi_dev->dev, "error resetting channel:%d\n", ret); gpi_reset_chan(gchan, GPI_CH_CMD_DE_ALLOC); } /* free all allocated memory */ gpi_free_ring(&gchan->ch_ring, gpii); vchan_free_chan_resources(&gchan->vc); kfree(gchan->config); write_lock_irq(&gpii->pm_lock); gchan->pm_state = DISABLE_STATE; write_unlock_irq(&gpii->pm_lock); /* if other rings are still active exit */ for (i = 0; i < MAX_CHANNELS_PER_GPII; i++) if (gpii->gchan[i].ch_ring.configured) goto exit_free; /* deallocate EV Ring */ cur_state = gpii->pm_state; write_lock_irq(&gpii->pm_lock); gpii->pm_state = PREPARE_TERMINATE; write_unlock_irq(&gpii->pm_lock); /* wait for threads to complete out */ tasklet_kill(&gpii->ev_task); /* send command to de allocate event ring */ if (cur_state == ACTIVE_STATE) gpi_send_cmd(gpii, NULL, GPI_EV_CMD_DEALLOC); gpi_free_ring(&gpii->ev_ring, gpii); /* disable interrupts */ if (cur_state == ACTIVE_STATE) gpi_disable_interrupts(gpii); /* set final state to disable */ write_lock_irq(&gpii->pm_lock); gpii->pm_state = DISABLE_STATE; write_unlock_irq(&gpii->pm_lock); exit_free: mutex_unlock(&gpii->ctrl_lock); } /* allocate channel resources */ static int gpi_alloc_chan_resources(struct dma_chan *chan) { struct gchan *gchan = to_gchan(chan); struct gpii *gpii = gchan->gpii; int ret; mutex_lock(&gpii->ctrl_lock); /* allocate memory for transfer ring */ ret = gpi_alloc_ring(&gchan->ch_ring, CHAN_TRES, sizeof(struct gpi_tre), gpii); if (ret) goto xfer_alloc_err; ret = gpi_ch_init(gchan); mutex_unlock(&gpii->ctrl_lock); return ret; xfer_alloc_err: mutex_unlock(&gpii->ctrl_lock); return ret; } static int gpi_find_avail_gpii(struct gpi_dev *gpi_dev, u32 seid) { struct gchan *tx_chan, *rx_chan; unsigned int gpii; /* check if same seid is already configured for another chid */ for (gpii = 0; gpii < gpi_dev->max_gpii; gpii++) { if (!((1 << gpii) & gpi_dev->gpii_mask)) continue; tx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_TX_CHAN]; rx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_RX_CHAN]; if (rx_chan->vc.chan.client_count && rx_chan->seid == seid) return gpii; if (tx_chan->vc.chan.client_count && tx_chan->seid == seid) return gpii; } /* no channels configured with same seid, return next avail gpii */ for (gpii = 0; gpii < gpi_dev->max_gpii; gpii++) { if (!((1 << gpii) & gpi_dev->gpii_mask)) continue; tx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_TX_CHAN]; rx_chan = &gpi_dev->gpiis[gpii].gchan[GPI_RX_CHAN]; /* check if gpii is configured */ if (tx_chan->vc.chan.client_count || rx_chan->vc.chan.client_count) continue; /* found a free gpii */ return gpii; } /* no gpii instance available to use */ return -EIO; } /* gpi_of_dma_xlate: open client requested channel */ static struct dma_chan *gpi_of_dma_xlate(struct of_phandle_args *args, struct of_dma *of_dma) { struct gpi_dev *gpi_dev = (struct gpi_dev *)of_dma->of_dma_data; u32 seid, chid; int gpii; struct gchan *gchan; if (args->args_count < 3) { dev_err(gpi_dev->dev, "gpii require minimum 2 args, client passed:%d args\n", args->args_count); return NULL; } chid = args->args[0]; if (chid >= MAX_CHANNELS_PER_GPII) { dev_err(gpi_dev->dev, "gpii channel:%d not valid\n", chid); return NULL; } seid = args->args[1]; /* find next available gpii to use */ gpii = gpi_find_avail_gpii(gpi_dev, seid); if (gpii < 0) { dev_err(gpi_dev->dev, "no available gpii instances\n"); return NULL; } gchan = &gpi_dev->gpiis[gpii].gchan[chid]; if (gchan->vc.chan.client_count) { dev_err(gpi_dev->dev, "gpii:%d chid:%d seid:%d already configured\n", gpii, chid, gchan->seid); return NULL; } gchan->seid = seid; gchan->protocol = args->args[2]; return dma_get_slave_channel(&gchan->vc.chan); } static int gpi_probe(struct platform_device *pdev) { struct gpi_dev *gpi_dev; unsigned int i; u32 ee_offset; int ret; gpi_dev = devm_kzalloc(&pdev->dev, sizeof(*gpi_dev), GFP_KERNEL); if (!gpi_dev) return -ENOMEM; gpi_dev->dev = &pdev->dev; gpi_dev->regs = devm_platform_get_and_ioremap_resource(pdev, 0, &gpi_dev->res); if (IS_ERR(gpi_dev->regs)) return PTR_ERR(gpi_dev->regs); gpi_dev->ee_base = gpi_dev->regs; ret = of_property_read_u32(gpi_dev->dev->of_node, "dma-channels", &gpi_dev->max_gpii); if (ret) { dev_err(gpi_dev->dev, "missing 'max-no-gpii' DT node\n"); return ret; } ret = of_property_read_u32(gpi_dev->dev->of_node, "dma-channel-mask", &gpi_dev->gpii_mask); if (ret) { dev_err(gpi_dev->dev, "missing 'gpii-mask' DT node\n"); return ret; } ee_offset = (uintptr_t)device_get_match_data(gpi_dev->dev); gpi_dev->ee_base = gpi_dev->ee_base - ee_offset; gpi_dev->ev_factor = EV_FACTOR; ret = dma_set_mask(gpi_dev->dev, DMA_BIT_MASK(64)); if (ret) { dev_err(gpi_dev->dev, "Error setting dma_mask to 64, ret:%d\n", ret); return ret; } gpi_dev->gpiis = devm_kzalloc(gpi_dev->dev, sizeof(*gpi_dev->gpiis) * gpi_dev->max_gpii, GFP_KERNEL); if (!gpi_dev->gpiis) return -ENOMEM; /* setup all the supported gpii */ INIT_LIST_HEAD(&gpi_dev->dma_device.channels); for (i = 0; i < gpi_dev->max_gpii; i++) { struct gpii *gpii = &gpi_dev->gpiis[i]; int chan; if (!((1 << i) & gpi_dev->gpii_mask)) continue; /* set up ev cntxt register map */ gpii->ev_cntxt_base_reg = gpi_dev->ee_base + GPII_n_EV_CH_k_CNTXT_0_OFFS(i, 0); gpii->ev_cntxt_db_reg = gpi_dev->ee_base + GPII_n_EV_CH_k_DOORBELL_0_OFFS(i, 0); gpii->ev_ring_rp_lsb_reg = gpii->ev_cntxt_base_reg + CNTXT_4_RING_RP_LSB; gpii->ev_cmd_reg = gpi_dev->ee_base + GPII_n_EV_CH_CMD_OFFS(i); gpii->ieob_clr_reg = gpi_dev->ee_base + GPII_n_CNTXT_SRC_IEOB_IRQ_CLR_OFFS(i); /* set up irq */ ret = platform_get_irq(pdev, i); if (ret < 0) return ret; gpii->irq = ret; /* set up channel specific register info */ for (chan = 0; chan < MAX_CHANNELS_PER_GPII; chan++) { struct gchan *gchan = &gpii->gchan[chan]; /* set up ch cntxt register map */ gchan->ch_cntxt_base_reg = gpi_dev->ee_base + GPII_n_CH_k_CNTXT_0_OFFS(i, chan); gchan->ch_cntxt_db_reg = gpi_dev->ee_base + GPII_n_CH_k_DOORBELL_0_OFFS(i, chan); gchan->ch_cmd_reg = gpi_dev->ee_base + GPII_n_CH_CMD_OFFS(i); /* vchan setup */ vchan_init(&gchan->vc, &gpi_dev->dma_device); gchan->vc.desc_free = gpi_desc_free; gchan->chid = chan; gchan->gpii = gpii; gchan->dir = GPII_CHAN_DIR[chan]; } mutex_init(&gpii->ctrl_lock); rwlock_init(&gpii->pm_lock); tasklet_init(&gpii->ev_task, gpi_ev_tasklet, (unsigned long)gpii); init_completion(&gpii->cmd_completion); gpii->gpii_id = i; gpii->regs = gpi_dev->ee_base; gpii->gpi_dev = gpi_dev; } platform_set_drvdata(pdev, gpi_dev); /* clear and Set capabilities */ dma_cap_zero(gpi_dev->dma_device.cap_mask); dma_cap_set(DMA_SLAVE, gpi_dev->dma_device.cap_mask); /* configure dmaengine apis */ gpi_dev->dma_device.directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV); gpi_dev->dma_device.residue_granularity = DMA_RESIDUE_GRANULARITY_DESCRIPTOR; gpi_dev->dma_device.src_addr_widths = DMA_SLAVE_BUSWIDTH_8_BYTES; gpi_dev->dma_device.dst_addr_widths = DMA_SLAVE_BUSWIDTH_8_BYTES; gpi_dev->dma_device.device_alloc_chan_resources = gpi_alloc_chan_resources; gpi_dev->dma_device.device_free_chan_resources = gpi_free_chan_resources; gpi_dev->dma_device.device_tx_status = dma_cookie_status; gpi_dev->dma_device.device_issue_pending = gpi_issue_pending; gpi_dev->dma_device.device_prep_slave_sg = gpi_prep_slave_sg; gpi_dev->dma_device.device_config = gpi_peripheral_config; gpi_dev->dma_device.device_terminate_all = gpi_terminate_all; gpi_dev->dma_device.dev = gpi_dev->dev; gpi_dev->dma_device.device_pause = gpi_pause; gpi_dev->dma_device.device_resume = gpi_resume; /* register with dmaengine framework */ ret = dma_async_device_register(&gpi_dev->dma_device); if (ret) { dev_err(gpi_dev->dev, "async_device_register failed ret:%d", ret); return ret; } ret = of_dma_controller_register(gpi_dev->dev->of_node, gpi_of_dma_xlate, gpi_dev); if (ret) { dev_err(gpi_dev->dev, "of_dma_controller_reg failed ret:%d", ret); return ret; } return ret; } static const struct of_device_id gpi_of_match[] = { { .compatible = "qcom,sdm845-gpi-dma", .data = (void *)0x0 }, { .compatible = "qcom,sm6350-gpi-dma", .data = (void *)0x10000 }, /* * Do not grow the list for compatible devices. Instead use * qcom,sdm845-gpi-dma (for ee_offset = 0x0) or qcom,sm6350-gpi-dma * (for ee_offset = 0x10000). */ { .compatible = "qcom,sc7280-gpi-dma", .data = (void *)0x10000 }, { .compatible = "qcom,sm8150-gpi-dma", .data = (void *)0x0 }, { .compatible = "qcom,sm8250-gpi-dma", .data = (void *)0x0 }, { .compatible = "qcom,sm8350-gpi-dma", .data = (void *)0x10000 }, { .compatible = "qcom,sm8450-gpi-dma", .data = (void *)0x10000 }, { }, }; MODULE_DEVICE_TABLE(of, gpi_of_match); static struct platform_driver gpi_driver = { .probe = gpi_probe, .driver = { .name = KBUILD_MODNAME, .of_match_table = gpi_of_match, }, }; static int __init gpi_init(void) { return platform_driver_register(&gpi_driver); } subsys_initcall(gpi_init) MODULE_DESCRIPTION("QCOM GPI DMA engine driver"); MODULE_LICENSE("GPL v2");