1650d1603SAlex Elder // SPDX-License-Identifier: GPL-2.0 2650d1603SAlex Elder 3650d1603SAlex Elder /* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved. 4650d1603SAlex Elder * Copyright (C) 2018-2020 Linaro Ltd. 5650d1603SAlex Elder */ 6650d1603SAlex Elder 7650d1603SAlex Elder #include <linux/types.h> 8650d1603SAlex Elder #include <linux/bits.h> 9650d1603SAlex Elder #include <linux/bitfield.h> 10650d1603SAlex Elder #include <linux/mutex.h> 11650d1603SAlex Elder #include <linux/completion.h> 12650d1603SAlex Elder #include <linux/io.h> 13650d1603SAlex Elder #include <linux/bug.h> 14650d1603SAlex Elder #include <linux/interrupt.h> 15650d1603SAlex Elder #include <linux/platform_device.h> 16650d1603SAlex Elder #include <linux/netdevice.h> 17650d1603SAlex Elder 18650d1603SAlex Elder #include "gsi.h" 19650d1603SAlex Elder #include "gsi_reg.h" 20650d1603SAlex Elder #include "gsi_private.h" 21650d1603SAlex Elder #include "gsi_trans.h" 22650d1603SAlex Elder #include "ipa_gsi.h" 23650d1603SAlex Elder #include "ipa_data.h" 24650d1603SAlex Elder 25650d1603SAlex Elder /** 26650d1603SAlex Elder * DOC: The IPA Generic Software Interface 27650d1603SAlex Elder * 28650d1603SAlex Elder * The generic software interface (GSI) is an integral component of the IPA, 29650d1603SAlex Elder * providing a well-defined communication layer between the AP subsystem 30650d1603SAlex Elder * and the IPA core. The modem uses the GSI layer as well. 31650d1603SAlex Elder * 32650d1603SAlex Elder * -------- --------- 33650d1603SAlex Elder * | | | | 34650d1603SAlex Elder * | AP +<---. .----+ Modem | 35650d1603SAlex Elder * | +--. | | .->+ | 36650d1603SAlex Elder * | | | | | | | | 37650d1603SAlex Elder * -------- | | | | --------- 38650d1603SAlex Elder * v | v | 39650d1603SAlex Elder * --+-+---+-+-- 40650d1603SAlex Elder * | GSI | 41650d1603SAlex Elder * |-----------| 42650d1603SAlex Elder * | | 43650d1603SAlex Elder * | IPA | 44650d1603SAlex Elder * | | 45650d1603SAlex Elder * ------------- 46650d1603SAlex Elder * 47650d1603SAlex Elder * In the above diagram, the AP and Modem represent "execution environments" 48650d1603SAlex Elder * (EEs), which are independent operating environments that use the IPA for 49650d1603SAlex Elder * data transfer. 50650d1603SAlex Elder * 51650d1603SAlex Elder * Each EE uses a set of unidirectional GSI "channels," which allow transfer 52650d1603SAlex Elder * of data to or from the IPA. A channel is implemented as a ring buffer, 53650d1603SAlex Elder * with a DRAM-resident array of "transfer elements" (TREs) available to 54650d1603SAlex Elder * describe transfers to or from other EEs through the IPA. A transfer 55650d1603SAlex Elder * element can also contain an immediate command, requesting the IPA perform 56650d1603SAlex Elder * actions other than data transfer. 57650d1603SAlex Elder * 58650d1603SAlex Elder * Each TRE refers to a block of data--also located DRAM. After writing one 59650d1603SAlex Elder * or more TREs to a channel, the writer (either the IPA or an EE) writes a 60650d1603SAlex Elder * doorbell register to inform the receiving side how many elements have 61650d1603SAlex Elder * been written. 62650d1603SAlex Elder * 63650d1603SAlex Elder * Each channel has a GSI "event ring" associated with it. An event ring 64650d1603SAlex Elder * is implemented very much like a channel ring, but is always directed from 65650d1603SAlex Elder * the IPA to an EE. The IPA notifies an EE (such as the AP) about channel 66650d1603SAlex Elder * events by adding an entry to the event ring associated with the channel. 67650d1603SAlex Elder * The GSI then writes its doorbell for the event ring, causing the target 68650d1603SAlex Elder * EE to be interrupted. Each entry in an event ring contains a pointer 69650d1603SAlex Elder * to the channel TRE whose completion the event represents. 70650d1603SAlex Elder * 71650d1603SAlex Elder * Each TRE in a channel ring has a set of flags. One flag indicates whether 72650d1603SAlex Elder * the completion of the transfer operation generates an entry (and possibly 73650d1603SAlex Elder * an interrupt) in the channel's event ring. Other flags allow transfer 74650d1603SAlex Elder * elements to be chained together, forming a single logical transaction. 75650d1603SAlex Elder * TRE flags are used to control whether and when interrupts are generated 76650d1603SAlex Elder * to signal completion of channel transfers. 77650d1603SAlex Elder * 78650d1603SAlex Elder * Elements in channel and event rings are completed (or consumed) strictly 79650d1603SAlex Elder * in order. Completion of one entry implies the completion of all preceding 80650d1603SAlex Elder * entries. A single completion interrupt can therefore communicate the 81650d1603SAlex Elder * completion of many transfers. 82650d1603SAlex Elder * 83650d1603SAlex Elder * Note that all GSI registers are little-endian, which is the assumed 84650d1603SAlex Elder * endianness of I/O space accesses. The accessor functions perform byte 85650d1603SAlex Elder * swapping if needed (i.e., for a big endian CPU). 86650d1603SAlex Elder */ 87650d1603SAlex Elder 88650d1603SAlex Elder /* Delay period for interrupt moderation (in 32KHz IPA internal timer ticks) */ 89650d1603SAlex Elder #define GSI_EVT_RING_INT_MODT (32 * 1) /* 1ms under 32KHz clock */ 90650d1603SAlex Elder 91650d1603SAlex Elder #define GSI_CMD_TIMEOUT 5 /* seconds */ 92650d1603SAlex Elder 93650d1603SAlex Elder #define GSI_CHANNEL_STOP_RX_RETRIES 10 94650d1603SAlex Elder 95650d1603SAlex Elder #define GSI_MHI_EVENT_ID_START 10 /* 1st reserved event id */ 96650d1603SAlex Elder #define GSI_MHI_EVENT_ID_END 16 /* Last reserved event id */ 97650d1603SAlex Elder 98650d1603SAlex Elder #define GSI_ISR_MAX_ITER 50 /* Detect interrupt storms */ 99650d1603SAlex Elder 100650d1603SAlex Elder /* An entry in an event ring */ 101650d1603SAlex Elder struct gsi_event { 102650d1603SAlex Elder __le64 xfer_ptr; 103650d1603SAlex Elder __le16 len; 104650d1603SAlex Elder u8 reserved1; 105650d1603SAlex Elder u8 code; 106650d1603SAlex Elder __le16 reserved2; 107650d1603SAlex Elder u8 type; 108650d1603SAlex Elder u8 chid; 109650d1603SAlex Elder }; 110650d1603SAlex Elder 111650d1603SAlex Elder /* Hardware values from the error log register error code field */ 112650d1603SAlex Elder enum gsi_err_code { 113650d1603SAlex Elder GSI_INVALID_TRE_ERR = 0x1, 114650d1603SAlex Elder GSI_OUT_OF_BUFFERS_ERR = 0x2, 115650d1603SAlex Elder GSI_OUT_OF_RESOURCES_ERR = 0x3, 116650d1603SAlex Elder GSI_UNSUPPORTED_INTER_EE_OP_ERR = 0x4, 117650d1603SAlex Elder GSI_EVT_RING_EMPTY_ERR = 0x5, 118650d1603SAlex Elder GSI_NON_ALLOCATED_EVT_ACCESS_ERR = 0x6, 119650d1603SAlex Elder GSI_HWO_1_ERR = 0x8, 120650d1603SAlex Elder }; 121650d1603SAlex Elder 122650d1603SAlex Elder /* Hardware values from the error log register error type field */ 123650d1603SAlex Elder enum gsi_err_type { 124650d1603SAlex Elder GSI_ERR_TYPE_GLOB = 0x1, 125650d1603SAlex Elder GSI_ERR_TYPE_CHAN = 0x2, 126650d1603SAlex Elder GSI_ERR_TYPE_EVT = 0x3, 127650d1603SAlex Elder }; 128650d1603SAlex Elder 129650d1603SAlex Elder /* Hardware values used when programming an event ring */ 130650d1603SAlex Elder enum gsi_evt_chtype { 131650d1603SAlex Elder GSI_EVT_CHTYPE_MHI_EV = 0x0, 132650d1603SAlex Elder GSI_EVT_CHTYPE_XHCI_EV = 0x1, 133650d1603SAlex Elder GSI_EVT_CHTYPE_GPI_EV = 0x2, 134650d1603SAlex Elder GSI_EVT_CHTYPE_XDCI_EV = 0x3, 135650d1603SAlex Elder }; 136650d1603SAlex Elder 137650d1603SAlex Elder /* Hardware values used when programming a channel */ 138650d1603SAlex Elder enum gsi_channel_protocol { 139650d1603SAlex Elder GSI_CHANNEL_PROTOCOL_MHI = 0x0, 140650d1603SAlex Elder GSI_CHANNEL_PROTOCOL_XHCI = 0x1, 141650d1603SAlex Elder GSI_CHANNEL_PROTOCOL_GPI = 0x2, 142650d1603SAlex Elder GSI_CHANNEL_PROTOCOL_XDCI = 0x3, 143650d1603SAlex Elder }; 144650d1603SAlex Elder 145650d1603SAlex Elder /* Hardware values representing an event ring immediate command opcode */ 146650d1603SAlex Elder enum gsi_evt_cmd_opcode { 147650d1603SAlex Elder GSI_EVT_ALLOCATE = 0x0, 148650d1603SAlex Elder GSI_EVT_RESET = 0x9, 149650d1603SAlex Elder GSI_EVT_DE_ALLOC = 0xa, 150650d1603SAlex Elder }; 151650d1603SAlex Elder 152650d1603SAlex Elder /* Hardware values representing a generic immediate command opcode */ 153650d1603SAlex Elder enum gsi_generic_cmd_opcode { 154650d1603SAlex Elder GSI_GENERIC_HALT_CHANNEL = 0x1, 155650d1603SAlex Elder GSI_GENERIC_ALLOCATE_CHANNEL = 0x2, 156650d1603SAlex Elder }; 157650d1603SAlex Elder 158650d1603SAlex Elder /* Hardware values representing a channel immediate command opcode */ 159650d1603SAlex Elder enum gsi_ch_cmd_opcode { 160650d1603SAlex Elder GSI_CH_ALLOCATE = 0x0, 161650d1603SAlex Elder GSI_CH_START = 0x1, 162650d1603SAlex Elder GSI_CH_STOP = 0x2, 163650d1603SAlex Elder GSI_CH_RESET = 0x9, 164650d1603SAlex Elder GSI_CH_DE_ALLOC = 0xa, 165650d1603SAlex Elder }; 166650d1603SAlex Elder 167650d1603SAlex Elder /** gsi_channel_scratch_gpi - GPI protocol scratch register 168650d1603SAlex Elder * @max_outstanding_tre: 169650d1603SAlex Elder * Defines the maximum number of TREs allowed in a single transaction 170650d1603SAlex Elder * on a channel (in bytes). This determines the amount of prefetch 171650d1603SAlex Elder * performed by the hardware. We configure this to equal the size of 172650d1603SAlex Elder * the TLV FIFO for the channel. 173650d1603SAlex Elder * @outstanding_threshold: 174650d1603SAlex Elder * Defines the threshold (in bytes) determining when the sequencer 175650d1603SAlex Elder * should update the channel doorbell. We configure this to equal 176650d1603SAlex Elder * the size of two TREs. 177650d1603SAlex Elder */ 178650d1603SAlex Elder struct gsi_channel_scratch_gpi { 179650d1603SAlex Elder u64 reserved1; 180650d1603SAlex Elder u16 reserved2; 181650d1603SAlex Elder u16 max_outstanding_tre; 182650d1603SAlex Elder u16 reserved3; 183650d1603SAlex Elder u16 outstanding_threshold; 184650d1603SAlex Elder }; 185650d1603SAlex Elder 186650d1603SAlex Elder /** gsi_channel_scratch - channel scratch configuration area 187650d1603SAlex Elder * 188650d1603SAlex Elder * The exact interpretation of this register is protocol-specific. 189650d1603SAlex Elder * We only use GPI channels; see struct gsi_channel_scratch_gpi, above. 190650d1603SAlex Elder */ 191650d1603SAlex Elder union gsi_channel_scratch { 192650d1603SAlex Elder struct gsi_channel_scratch_gpi gpi; 193650d1603SAlex Elder struct { 194650d1603SAlex Elder u32 word1; 195650d1603SAlex Elder u32 word2; 196650d1603SAlex Elder u32 word3; 197650d1603SAlex Elder u32 word4; 198650d1603SAlex Elder } data; 199650d1603SAlex Elder }; 200650d1603SAlex Elder 201650d1603SAlex Elder /* Check things that can be validated at build time. */ 202650d1603SAlex Elder static void gsi_validate_build(void) 203650d1603SAlex Elder { 204650d1603SAlex Elder /* This is used as a divisor */ 205650d1603SAlex Elder BUILD_BUG_ON(!GSI_RING_ELEMENT_SIZE); 206650d1603SAlex Elder 207650d1603SAlex Elder /* Code assumes the size of channel and event ring element are 208650d1603SAlex Elder * the same (and fixed). Make sure the size of an event ring 209650d1603SAlex Elder * element is what's expected. 210650d1603SAlex Elder */ 211650d1603SAlex Elder BUILD_BUG_ON(sizeof(struct gsi_event) != GSI_RING_ELEMENT_SIZE); 212650d1603SAlex Elder 213650d1603SAlex Elder /* Hardware requires a 2^n ring size. We ensure the number of 214650d1603SAlex Elder * elements in an event ring is a power of 2 elsewhere; this 215650d1603SAlex Elder * ensure the elements themselves meet the requirement. 216650d1603SAlex Elder */ 217650d1603SAlex Elder BUILD_BUG_ON(!is_power_of_2(GSI_RING_ELEMENT_SIZE)); 218650d1603SAlex Elder 219650d1603SAlex Elder /* The channel element size must fit in this field */ 220650d1603SAlex Elder BUILD_BUG_ON(GSI_RING_ELEMENT_SIZE > field_max(ELEMENT_SIZE_FMASK)); 221650d1603SAlex Elder 222650d1603SAlex Elder /* The event ring element size must fit in this field */ 223650d1603SAlex Elder BUILD_BUG_ON(GSI_RING_ELEMENT_SIZE > field_max(EV_ELEMENT_SIZE_FMASK)); 224650d1603SAlex Elder } 225650d1603SAlex Elder 226650d1603SAlex Elder /* Return the channel id associated with a given channel */ 227650d1603SAlex Elder static u32 gsi_channel_id(struct gsi_channel *channel) 228650d1603SAlex Elder { 229650d1603SAlex Elder return channel - &channel->gsi->channel[0]; 230650d1603SAlex Elder } 231650d1603SAlex Elder 232650d1603SAlex Elder static void gsi_irq_ieob_enable(struct gsi *gsi, u32 evt_ring_id) 233650d1603SAlex Elder { 234650d1603SAlex Elder u32 val; 235650d1603SAlex Elder 236650d1603SAlex Elder gsi->event_enable_bitmap |= BIT(evt_ring_id); 237650d1603SAlex Elder val = gsi->event_enable_bitmap; 238650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 239650d1603SAlex Elder } 240650d1603SAlex Elder 241650d1603SAlex Elder static void gsi_irq_ieob_disable(struct gsi *gsi, u32 evt_ring_id) 242650d1603SAlex Elder { 243650d1603SAlex Elder u32 val; 244650d1603SAlex Elder 245650d1603SAlex Elder gsi->event_enable_bitmap &= ~BIT(evt_ring_id); 246650d1603SAlex Elder val = gsi->event_enable_bitmap; 247650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 248650d1603SAlex Elder } 249650d1603SAlex Elder 250650d1603SAlex Elder /* Enable all GSI_interrupt types */ 251650d1603SAlex Elder static void gsi_irq_enable(struct gsi *gsi) 252650d1603SAlex Elder { 253650d1603SAlex Elder u32 val; 254650d1603SAlex Elder 255650d1603SAlex Elder /* We don't use inter-EE channel or event interrupts */ 256650d1603SAlex Elder val = GSI_CNTXT_TYPE_IRQ_MSK_ALL; 257650d1603SAlex Elder val &= ~MSK_INTER_EE_CH_CTRL_FMASK; 258650d1603SAlex Elder val &= ~MSK_INTER_EE_EV_CTRL_FMASK; 259650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_TYPE_IRQ_MSK_OFFSET); 260650d1603SAlex Elder 261650d1603SAlex Elder val = GENMASK(gsi->channel_count - 1, 0); 262650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_MSK_OFFSET); 263650d1603SAlex Elder 264650d1603SAlex Elder val = GENMASK(gsi->evt_ring_count - 1, 0); 265650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_MSK_OFFSET); 266650d1603SAlex Elder 267650d1603SAlex Elder /* Each IEOB interrupt is enabled (later) as needed by channels */ 268650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 269650d1603SAlex Elder 270650d1603SAlex Elder val = GSI_CNTXT_GLOB_IRQ_ALL; 271650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 272650d1603SAlex Elder 273650d1603SAlex Elder /* Never enable GSI_BREAK_POINT */ 274650d1603SAlex Elder val = GSI_CNTXT_GSI_IRQ_ALL & ~EN_BREAK_POINT_FMASK; 275650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GSI_IRQ_EN_OFFSET); 276650d1603SAlex Elder } 277650d1603SAlex Elder 278650d1603SAlex Elder /* Disable all GSI_interrupt types */ 279650d1603SAlex Elder static void gsi_irq_disable(struct gsi *gsi) 280650d1603SAlex Elder { 281650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GSI_IRQ_EN_OFFSET); 282650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 283650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 284650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_MSK_OFFSET); 285650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_MSK_OFFSET); 286650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_TYPE_IRQ_MSK_OFFSET); 287650d1603SAlex Elder } 288650d1603SAlex Elder 289650d1603SAlex Elder /* Return the virtual address associated with a ring index */ 290650d1603SAlex Elder void *gsi_ring_virt(struct gsi_ring *ring, u32 index) 291650d1603SAlex Elder { 292650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 293650d1603SAlex Elder return ring->virt + (index % ring->count) * GSI_RING_ELEMENT_SIZE; 294650d1603SAlex Elder } 295650d1603SAlex Elder 296650d1603SAlex Elder /* Return the 32-bit DMA address associated with a ring index */ 297650d1603SAlex Elder static u32 gsi_ring_addr(struct gsi_ring *ring, u32 index) 298650d1603SAlex Elder { 299650d1603SAlex Elder return (ring->addr & GENMASK(31, 0)) + index * GSI_RING_ELEMENT_SIZE; 300650d1603SAlex Elder } 301650d1603SAlex Elder 302650d1603SAlex Elder /* Return the ring index of a 32-bit ring offset */ 303650d1603SAlex Elder static u32 gsi_ring_index(struct gsi_ring *ring, u32 offset) 304650d1603SAlex Elder { 305650d1603SAlex Elder return (offset - gsi_ring_addr(ring, 0)) / GSI_RING_ELEMENT_SIZE; 306650d1603SAlex Elder } 307650d1603SAlex Elder 308650d1603SAlex Elder /* Issue a GSI command by writing a value to a register, then wait for 309650d1603SAlex Elder * completion to be signaled. Returns true if the command completes 310650d1603SAlex Elder * or false if it times out. 311650d1603SAlex Elder */ 312650d1603SAlex Elder static bool 313650d1603SAlex Elder gsi_command(struct gsi *gsi, u32 reg, u32 val, struct completion *completion) 314650d1603SAlex Elder { 315650d1603SAlex Elder reinit_completion(completion); 316650d1603SAlex Elder 317650d1603SAlex Elder iowrite32(val, gsi->virt + reg); 318650d1603SAlex Elder 319650d1603SAlex Elder return !!wait_for_completion_timeout(completion, GSI_CMD_TIMEOUT * HZ); 320650d1603SAlex Elder } 321650d1603SAlex Elder 322650d1603SAlex Elder /* Return the hardware's notion of the current state of an event ring */ 323650d1603SAlex Elder static enum gsi_evt_ring_state 324650d1603SAlex Elder gsi_evt_ring_state(struct gsi *gsi, u32 evt_ring_id) 325650d1603SAlex Elder { 326650d1603SAlex Elder u32 val; 327650d1603SAlex Elder 328650d1603SAlex Elder val = ioread32(gsi->virt + GSI_EV_CH_E_CNTXT_0_OFFSET(evt_ring_id)); 329650d1603SAlex Elder 330650d1603SAlex Elder return u32_get_bits(val, EV_CHSTATE_FMASK); 331650d1603SAlex Elder } 332650d1603SAlex Elder 333650d1603SAlex Elder /* Issue an event ring command and wait for it to complete */ 334650d1603SAlex Elder static int evt_ring_command(struct gsi *gsi, u32 evt_ring_id, 335650d1603SAlex Elder enum gsi_evt_cmd_opcode opcode) 336650d1603SAlex Elder { 337650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 338650d1603SAlex Elder struct completion *completion = &evt_ring->completion; 339650d1603SAlex Elder u32 val; 340650d1603SAlex Elder 341650d1603SAlex Elder val = u32_encode_bits(evt_ring_id, EV_CHID_FMASK); 342650d1603SAlex Elder val |= u32_encode_bits(opcode, EV_OPCODE_FMASK); 343650d1603SAlex Elder 344650d1603SAlex Elder if (gsi_command(gsi, GSI_EV_CH_CMD_OFFSET, val, completion)) 345650d1603SAlex Elder return 0; /* Success! */ 346650d1603SAlex Elder 347650d1603SAlex Elder dev_err(gsi->dev, "GSI command %u to event ring %u timed out " 348650d1603SAlex Elder "(state is %u)\n", opcode, evt_ring_id, evt_ring->state); 349650d1603SAlex Elder 350650d1603SAlex Elder return -ETIMEDOUT; 351650d1603SAlex Elder } 352650d1603SAlex Elder 353650d1603SAlex Elder /* Allocate an event ring in NOT_ALLOCATED state */ 354650d1603SAlex Elder static int gsi_evt_ring_alloc_command(struct gsi *gsi, u32 evt_ring_id) 355650d1603SAlex Elder { 356650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 357650d1603SAlex Elder int ret; 358650d1603SAlex Elder 359650d1603SAlex Elder /* Get initial event ring state */ 360650d1603SAlex Elder evt_ring->state = gsi_evt_ring_state(gsi, evt_ring_id); 361650d1603SAlex Elder 362650d1603SAlex Elder if (evt_ring->state != GSI_EVT_RING_STATE_NOT_ALLOCATED) 363650d1603SAlex Elder return -EINVAL; 364650d1603SAlex Elder 365650d1603SAlex Elder ret = evt_ring_command(gsi, evt_ring_id, GSI_EVT_ALLOCATE); 366650d1603SAlex Elder if (!ret && evt_ring->state != GSI_EVT_RING_STATE_ALLOCATED) { 367650d1603SAlex Elder dev_err(gsi->dev, "bad event ring state (%u) after alloc\n", 368650d1603SAlex Elder evt_ring->state); 369650d1603SAlex Elder ret = -EIO; 370650d1603SAlex Elder } 371650d1603SAlex Elder 372650d1603SAlex Elder return ret; 373650d1603SAlex Elder } 374650d1603SAlex Elder 375650d1603SAlex Elder /* Reset a GSI event ring in ALLOCATED or ERROR state. */ 376650d1603SAlex Elder static void gsi_evt_ring_reset_command(struct gsi *gsi, u32 evt_ring_id) 377650d1603SAlex Elder { 378650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 379650d1603SAlex Elder enum gsi_evt_ring_state state = evt_ring->state; 380650d1603SAlex Elder int ret; 381650d1603SAlex Elder 382650d1603SAlex Elder if (state != GSI_EVT_RING_STATE_ALLOCATED && 383650d1603SAlex Elder state != GSI_EVT_RING_STATE_ERROR) { 384650d1603SAlex Elder dev_err(gsi->dev, "bad event ring state (%u) before reset\n", 385650d1603SAlex Elder evt_ring->state); 386650d1603SAlex Elder return; 387650d1603SAlex Elder } 388650d1603SAlex Elder 389650d1603SAlex Elder ret = evt_ring_command(gsi, evt_ring_id, GSI_EVT_RESET); 390650d1603SAlex Elder if (!ret && evt_ring->state != GSI_EVT_RING_STATE_ALLOCATED) 391650d1603SAlex Elder dev_err(gsi->dev, "bad event ring state (%u) after reset\n", 392650d1603SAlex Elder evt_ring->state); 393650d1603SAlex Elder } 394650d1603SAlex Elder 395650d1603SAlex Elder /* Issue a hardware de-allocation request for an allocated event ring */ 396650d1603SAlex Elder static void gsi_evt_ring_de_alloc_command(struct gsi *gsi, u32 evt_ring_id) 397650d1603SAlex Elder { 398650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 399650d1603SAlex Elder int ret; 400650d1603SAlex Elder 401650d1603SAlex Elder if (evt_ring->state != GSI_EVT_RING_STATE_ALLOCATED) { 402650d1603SAlex Elder dev_err(gsi->dev, "bad event ring state (%u) before dealloc\n", 403650d1603SAlex Elder evt_ring->state); 404650d1603SAlex Elder return; 405650d1603SAlex Elder } 406650d1603SAlex Elder 407650d1603SAlex Elder ret = evt_ring_command(gsi, evt_ring_id, GSI_EVT_DE_ALLOC); 408650d1603SAlex Elder if (!ret && evt_ring->state != GSI_EVT_RING_STATE_NOT_ALLOCATED) 409650d1603SAlex Elder dev_err(gsi->dev, "bad event ring state (%u) after dealloc\n", 410650d1603SAlex Elder evt_ring->state); 411650d1603SAlex Elder } 412650d1603SAlex Elder 413a2003b30SAlex Elder /* Fetch the current state of a channel from hardware */ 414aba7924fSAlex Elder static enum gsi_channel_state gsi_channel_state(struct gsi_channel *channel) 415650d1603SAlex Elder { 416aba7924fSAlex Elder u32 channel_id = gsi_channel_id(channel); 417aba7924fSAlex Elder void *virt = channel->gsi->virt; 418650d1603SAlex Elder u32 val; 419650d1603SAlex Elder 420aba7924fSAlex Elder val = ioread32(virt + GSI_CH_C_CNTXT_0_OFFSET(channel_id)); 421650d1603SAlex Elder 422650d1603SAlex Elder return u32_get_bits(val, CHSTATE_FMASK); 423650d1603SAlex Elder } 424650d1603SAlex Elder 425650d1603SAlex Elder /* Issue a channel command and wait for it to complete */ 426650d1603SAlex Elder static int 427650d1603SAlex Elder gsi_channel_command(struct gsi_channel *channel, enum gsi_ch_cmd_opcode opcode) 428650d1603SAlex Elder { 429650d1603SAlex Elder struct completion *completion = &channel->completion; 430650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 431a2003b30SAlex Elder struct gsi *gsi = channel->gsi; 432650d1603SAlex Elder u32 val; 433650d1603SAlex Elder 434650d1603SAlex Elder val = u32_encode_bits(channel_id, CH_CHID_FMASK); 435650d1603SAlex Elder val |= u32_encode_bits(opcode, CH_OPCODE_FMASK); 436650d1603SAlex Elder 437a2003b30SAlex Elder if (gsi_command(gsi, GSI_CH_CMD_OFFSET, val, completion)) 438650d1603SAlex Elder return 0; /* Success! */ 439650d1603SAlex Elder 440a2003b30SAlex Elder dev_err(gsi->dev, 441a2003b30SAlex Elder "GSI command %u to channel %u timed out (state is %u)\n", 442a2003b30SAlex Elder opcode, channel_id, gsi_channel_state(channel)); 443650d1603SAlex Elder 444650d1603SAlex Elder return -ETIMEDOUT; 445650d1603SAlex Elder } 446650d1603SAlex Elder 447650d1603SAlex Elder /* Allocate GSI channel in NOT_ALLOCATED state */ 448650d1603SAlex Elder static int gsi_channel_alloc_command(struct gsi *gsi, u32 channel_id) 449650d1603SAlex Elder { 450650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 451a2003b30SAlex Elder enum gsi_channel_state state; 452650d1603SAlex Elder int ret; 453650d1603SAlex Elder 454650d1603SAlex Elder /* Get initial channel state */ 455a2003b30SAlex Elder state = gsi_channel_state(channel); 456a2003b30SAlex Elder if (state != GSI_CHANNEL_STATE_NOT_ALLOCATED) 457650d1603SAlex Elder return -EINVAL; 458650d1603SAlex Elder 459650d1603SAlex Elder ret = gsi_channel_command(channel, GSI_CH_ALLOCATE); 460a2003b30SAlex Elder 461a2003b30SAlex Elder /* Channel state will normally have been updated */ 462a2003b30SAlex Elder state = gsi_channel_state(channel); 463a2003b30SAlex Elder if (!ret && state != GSI_CHANNEL_STATE_ALLOCATED) { 464650d1603SAlex Elder dev_err(gsi->dev, "bad channel state (%u) after alloc\n", 465a2003b30SAlex Elder state); 466650d1603SAlex Elder ret = -EIO; 467650d1603SAlex Elder } 468650d1603SAlex Elder 469650d1603SAlex Elder return ret; 470650d1603SAlex Elder } 471650d1603SAlex Elder 472650d1603SAlex Elder /* Start an ALLOCATED channel */ 473650d1603SAlex Elder static int gsi_channel_start_command(struct gsi_channel *channel) 474650d1603SAlex Elder { 475a2003b30SAlex Elder enum gsi_channel_state state; 476650d1603SAlex Elder int ret; 477650d1603SAlex Elder 478a2003b30SAlex Elder state = gsi_channel_state(channel); 479650d1603SAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED && 480650d1603SAlex Elder state != GSI_CHANNEL_STATE_STOPPED) 481650d1603SAlex Elder return -EINVAL; 482650d1603SAlex Elder 483650d1603SAlex Elder ret = gsi_channel_command(channel, GSI_CH_START); 484a2003b30SAlex Elder 485a2003b30SAlex Elder /* Channel state will normally have been updated */ 486a2003b30SAlex Elder state = gsi_channel_state(channel); 487a2003b30SAlex Elder if (!ret && state != GSI_CHANNEL_STATE_STARTED) { 488650d1603SAlex Elder dev_err(channel->gsi->dev, 489a2003b30SAlex Elder "bad channel state (%u) after start\n", state); 490650d1603SAlex Elder ret = -EIO; 491650d1603SAlex Elder } 492650d1603SAlex Elder 493650d1603SAlex Elder return ret; 494650d1603SAlex Elder } 495650d1603SAlex Elder 496650d1603SAlex Elder /* Stop a GSI channel in STARTED state */ 497650d1603SAlex Elder static int gsi_channel_stop_command(struct gsi_channel *channel) 498650d1603SAlex Elder { 499a2003b30SAlex Elder enum gsi_channel_state state; 500650d1603SAlex Elder int ret; 501650d1603SAlex Elder 502a2003b30SAlex Elder state = gsi_channel_state(channel); 503*5468cbcdSAlex Elder 504*5468cbcdSAlex Elder /* Channel could have entered STOPPED state since last call 505*5468cbcdSAlex Elder * if it timed out. If so, we're done. 506*5468cbcdSAlex Elder */ 507*5468cbcdSAlex Elder if (state == GSI_CHANNEL_STATE_STOPPED) 508*5468cbcdSAlex Elder return 0; 509*5468cbcdSAlex Elder 510650d1603SAlex Elder if (state != GSI_CHANNEL_STATE_STARTED && 511650d1603SAlex Elder state != GSI_CHANNEL_STATE_STOP_IN_PROC) 512650d1603SAlex Elder return -EINVAL; 513650d1603SAlex Elder 514650d1603SAlex Elder ret = gsi_channel_command(channel, GSI_CH_STOP); 515a2003b30SAlex Elder 516a2003b30SAlex Elder /* Channel state will normally have been updated */ 517a2003b30SAlex Elder state = gsi_channel_state(channel); 518a2003b30SAlex Elder if (ret || state == GSI_CHANNEL_STATE_STOPPED) 519650d1603SAlex Elder return ret; 520650d1603SAlex Elder 521650d1603SAlex Elder /* We may have to try again if stop is in progress */ 522a2003b30SAlex Elder if (state == GSI_CHANNEL_STATE_STOP_IN_PROC) 523650d1603SAlex Elder return -EAGAIN; 524650d1603SAlex Elder 525a2003b30SAlex Elder dev_err(channel->gsi->dev, 526a2003b30SAlex Elder "bad channel state (%u) after stop\n", state); 527650d1603SAlex Elder 528650d1603SAlex Elder return -EIO; 529650d1603SAlex Elder } 530650d1603SAlex Elder 531650d1603SAlex Elder /* Reset a GSI channel in ALLOCATED or ERROR state. */ 532650d1603SAlex Elder static void gsi_channel_reset_command(struct gsi_channel *channel) 533650d1603SAlex Elder { 534a2003b30SAlex Elder enum gsi_channel_state state; 535650d1603SAlex Elder int ret; 536650d1603SAlex Elder 537650d1603SAlex Elder msleep(1); /* A short delay is required before a RESET command */ 538650d1603SAlex Elder 539a2003b30SAlex Elder state = gsi_channel_state(channel); 540a2003b30SAlex Elder if (state != GSI_CHANNEL_STATE_STOPPED && 541a2003b30SAlex Elder state != GSI_CHANNEL_STATE_ERROR) { 542650d1603SAlex Elder dev_err(channel->gsi->dev, 543a2003b30SAlex Elder "bad channel state (%u) before reset\n", state); 544650d1603SAlex Elder return; 545650d1603SAlex Elder } 546650d1603SAlex Elder 547650d1603SAlex Elder ret = gsi_channel_command(channel, GSI_CH_RESET); 548a2003b30SAlex Elder 549a2003b30SAlex Elder /* Channel state will normally have been updated */ 550a2003b30SAlex Elder state = gsi_channel_state(channel); 551a2003b30SAlex Elder if (!ret && state != GSI_CHANNEL_STATE_ALLOCATED) 552650d1603SAlex Elder dev_err(channel->gsi->dev, 553a2003b30SAlex Elder "bad channel state (%u) after reset\n", state); 554650d1603SAlex Elder } 555650d1603SAlex Elder 556650d1603SAlex Elder /* Deallocate an ALLOCATED GSI channel */ 557650d1603SAlex Elder static void gsi_channel_de_alloc_command(struct gsi *gsi, u32 channel_id) 558650d1603SAlex Elder { 559650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 560a2003b30SAlex Elder enum gsi_channel_state state; 561650d1603SAlex Elder int ret; 562650d1603SAlex Elder 563a2003b30SAlex Elder state = gsi_channel_state(channel); 564a2003b30SAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED) { 565a2003b30SAlex Elder dev_err(gsi->dev, 566a2003b30SAlex Elder "bad channel state (%u) before dealloc\n", state); 567650d1603SAlex Elder return; 568650d1603SAlex Elder } 569650d1603SAlex Elder 570650d1603SAlex Elder ret = gsi_channel_command(channel, GSI_CH_DE_ALLOC); 571a2003b30SAlex Elder 572a2003b30SAlex Elder /* Channel state will normally have been updated */ 573a2003b30SAlex Elder state = gsi_channel_state(channel); 574a2003b30SAlex Elder if (!ret && state != GSI_CHANNEL_STATE_NOT_ALLOCATED) 575a2003b30SAlex Elder dev_err(gsi->dev, 576a2003b30SAlex Elder "bad channel state (%u) after dealloc\n", state); 577650d1603SAlex Elder } 578650d1603SAlex Elder 579650d1603SAlex Elder /* Ring an event ring doorbell, reporting the last entry processed by the AP. 580650d1603SAlex Elder * The index argument (modulo the ring count) is the first unfilled entry, so 581650d1603SAlex Elder * we supply one less than that with the doorbell. Update the event ring 582650d1603SAlex Elder * index field with the value provided. 583650d1603SAlex Elder */ 584650d1603SAlex Elder static void gsi_evt_ring_doorbell(struct gsi *gsi, u32 evt_ring_id, u32 index) 585650d1603SAlex Elder { 586650d1603SAlex Elder struct gsi_ring *ring = &gsi->evt_ring[evt_ring_id].ring; 587650d1603SAlex Elder u32 val; 588650d1603SAlex Elder 589650d1603SAlex Elder ring->index = index; /* Next unused entry */ 590650d1603SAlex Elder 591650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 592650d1603SAlex Elder val = gsi_ring_addr(ring, (index - 1) % ring->count); 593650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_DOORBELL_0_OFFSET(evt_ring_id)); 594650d1603SAlex Elder } 595650d1603SAlex Elder 596650d1603SAlex Elder /* Program an event ring for use */ 597650d1603SAlex Elder static void gsi_evt_ring_program(struct gsi *gsi, u32 evt_ring_id) 598650d1603SAlex Elder { 599650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 600650d1603SAlex Elder size_t size = evt_ring->ring.count * GSI_RING_ELEMENT_SIZE; 601650d1603SAlex Elder u32 val; 602650d1603SAlex Elder 603650d1603SAlex Elder val = u32_encode_bits(GSI_EVT_CHTYPE_GPI_EV, EV_CHTYPE_FMASK); 604650d1603SAlex Elder val |= EV_INTYPE_FMASK; 605650d1603SAlex Elder val |= u32_encode_bits(GSI_RING_ELEMENT_SIZE, EV_ELEMENT_SIZE_FMASK); 606650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_0_OFFSET(evt_ring_id)); 607650d1603SAlex Elder 608650d1603SAlex Elder val = u32_encode_bits(size, EV_R_LENGTH_FMASK); 609650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_1_OFFSET(evt_ring_id)); 610650d1603SAlex Elder 611650d1603SAlex Elder /* The context 2 and 3 registers store the low-order and 612650d1603SAlex Elder * high-order 32 bits of the address of the event ring, 613650d1603SAlex Elder * respectively. 614650d1603SAlex Elder */ 615650d1603SAlex Elder val = evt_ring->ring.addr & GENMASK(31, 0); 616650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_2_OFFSET(evt_ring_id)); 617650d1603SAlex Elder 618650d1603SAlex Elder val = evt_ring->ring.addr >> 32; 619650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_3_OFFSET(evt_ring_id)); 620650d1603SAlex Elder 621650d1603SAlex Elder /* Enable interrupt moderation by setting the moderation delay */ 622650d1603SAlex Elder val = u32_encode_bits(GSI_EVT_RING_INT_MODT, MODT_FMASK); 623650d1603SAlex Elder val |= u32_encode_bits(1, MODC_FMASK); /* comes from channel */ 624650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_8_OFFSET(evt_ring_id)); 625650d1603SAlex Elder 626650d1603SAlex Elder /* No MSI write data, and MSI address high and low address is 0 */ 627650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_9_OFFSET(evt_ring_id)); 628650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_10_OFFSET(evt_ring_id)); 629650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_11_OFFSET(evt_ring_id)); 630650d1603SAlex Elder 631650d1603SAlex Elder /* We don't need to get event read pointer updates */ 632650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_12_OFFSET(evt_ring_id)); 633650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_13_OFFSET(evt_ring_id)); 634650d1603SAlex Elder 635650d1603SAlex Elder /* Finally, tell the hardware we've completed event 0 (arbitrary) */ 636650d1603SAlex Elder gsi_evt_ring_doorbell(gsi, evt_ring_id, 0); 637650d1603SAlex Elder } 638650d1603SAlex Elder 639650d1603SAlex Elder /* Return the last (most recent) transaction completed on a channel. */ 640650d1603SAlex Elder static struct gsi_trans *gsi_channel_trans_last(struct gsi_channel *channel) 641650d1603SAlex Elder { 642650d1603SAlex Elder struct gsi_trans_info *trans_info = &channel->trans_info; 643650d1603SAlex Elder struct gsi_trans *trans; 644650d1603SAlex Elder 645650d1603SAlex Elder spin_lock_bh(&trans_info->spinlock); 646650d1603SAlex Elder 647650d1603SAlex Elder if (!list_empty(&trans_info->complete)) 648650d1603SAlex Elder trans = list_last_entry(&trans_info->complete, 649650d1603SAlex Elder struct gsi_trans, links); 650650d1603SAlex Elder else if (!list_empty(&trans_info->polled)) 651650d1603SAlex Elder trans = list_last_entry(&trans_info->polled, 652650d1603SAlex Elder struct gsi_trans, links); 653650d1603SAlex Elder else 654650d1603SAlex Elder trans = NULL; 655650d1603SAlex Elder 656650d1603SAlex Elder /* Caller will wait for this, so take a reference */ 657650d1603SAlex Elder if (trans) 658650d1603SAlex Elder refcount_inc(&trans->refcount); 659650d1603SAlex Elder 660650d1603SAlex Elder spin_unlock_bh(&trans_info->spinlock); 661650d1603SAlex Elder 662650d1603SAlex Elder return trans; 663650d1603SAlex Elder } 664650d1603SAlex Elder 665650d1603SAlex Elder /* Wait for transaction activity on a channel to complete */ 666650d1603SAlex Elder static void gsi_channel_trans_quiesce(struct gsi_channel *channel) 667650d1603SAlex Elder { 668650d1603SAlex Elder struct gsi_trans *trans; 669650d1603SAlex Elder 670650d1603SAlex Elder /* Get the last transaction, and wait for it to complete */ 671650d1603SAlex Elder trans = gsi_channel_trans_last(channel); 672650d1603SAlex Elder if (trans) { 673650d1603SAlex Elder wait_for_completion(&trans->completion); 674650d1603SAlex Elder gsi_trans_free(trans); 675650d1603SAlex Elder } 676650d1603SAlex Elder } 677650d1603SAlex Elder 678650d1603SAlex Elder /* Stop channel activity. Transactions may not be allocated until thawed. */ 679650d1603SAlex Elder static void gsi_channel_freeze(struct gsi_channel *channel) 680650d1603SAlex Elder { 681650d1603SAlex Elder gsi_channel_trans_quiesce(channel); 682650d1603SAlex Elder 683650d1603SAlex Elder napi_disable(&channel->napi); 684650d1603SAlex Elder 685650d1603SAlex Elder gsi_irq_ieob_disable(channel->gsi, channel->evt_ring_id); 686650d1603SAlex Elder } 687650d1603SAlex Elder 688650d1603SAlex Elder /* Allow transactions to be used on the channel again. */ 689650d1603SAlex Elder static void gsi_channel_thaw(struct gsi_channel *channel) 690650d1603SAlex Elder { 691650d1603SAlex Elder gsi_irq_ieob_enable(channel->gsi, channel->evt_ring_id); 692650d1603SAlex Elder 693650d1603SAlex Elder napi_enable(&channel->napi); 694650d1603SAlex Elder } 695650d1603SAlex Elder 696650d1603SAlex Elder /* Program a channel for use */ 697650d1603SAlex Elder static void gsi_channel_program(struct gsi_channel *channel, bool doorbell) 698650d1603SAlex Elder { 699650d1603SAlex Elder size_t size = channel->tre_ring.count * GSI_RING_ELEMENT_SIZE; 700650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 701650d1603SAlex Elder union gsi_channel_scratch scr = { }; 702650d1603SAlex Elder struct gsi_channel_scratch_gpi *gpi; 703650d1603SAlex Elder struct gsi *gsi = channel->gsi; 704650d1603SAlex Elder u32 wrr_weight = 0; 705650d1603SAlex Elder u32 val; 706650d1603SAlex Elder 707650d1603SAlex Elder /* Arbitrarily pick TRE 0 as the first channel element to use */ 708650d1603SAlex Elder channel->tre_ring.index = 0; 709650d1603SAlex Elder 710650d1603SAlex Elder /* We program all channels to use GPI protocol */ 711650d1603SAlex Elder val = u32_encode_bits(GSI_CHANNEL_PROTOCOL_GPI, CHTYPE_PROTOCOL_FMASK); 712650d1603SAlex Elder if (channel->toward_ipa) 713650d1603SAlex Elder val |= CHTYPE_DIR_FMASK; 714650d1603SAlex Elder val |= u32_encode_bits(channel->evt_ring_id, ERINDEX_FMASK); 715650d1603SAlex Elder val |= u32_encode_bits(GSI_RING_ELEMENT_SIZE, ELEMENT_SIZE_FMASK); 716650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_0_OFFSET(channel_id)); 717650d1603SAlex Elder 718650d1603SAlex Elder val = u32_encode_bits(size, R_LENGTH_FMASK); 719650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_1_OFFSET(channel_id)); 720650d1603SAlex Elder 721650d1603SAlex Elder /* The context 2 and 3 registers store the low-order and 722650d1603SAlex Elder * high-order 32 bits of the address of the channel ring, 723650d1603SAlex Elder * respectively. 724650d1603SAlex Elder */ 725650d1603SAlex Elder val = channel->tre_ring.addr & GENMASK(31, 0); 726650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_2_OFFSET(channel_id)); 727650d1603SAlex Elder 728650d1603SAlex Elder val = channel->tre_ring.addr >> 32; 729650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_3_OFFSET(channel_id)); 730650d1603SAlex Elder 731650d1603SAlex Elder /* Command channel gets low weighted round-robin priority */ 732650d1603SAlex Elder if (channel->command) 733650d1603SAlex Elder wrr_weight = field_max(WRR_WEIGHT_FMASK); 734650d1603SAlex Elder val = u32_encode_bits(wrr_weight, WRR_WEIGHT_FMASK); 735650d1603SAlex Elder 736650d1603SAlex Elder /* Max prefetch is 1 segment (do not set MAX_PREFETCH_FMASK) */ 737650d1603SAlex Elder 738650d1603SAlex Elder /* Enable the doorbell engine if requested */ 739650d1603SAlex Elder if (doorbell) 740650d1603SAlex Elder val |= USE_DB_ENG_FMASK; 741650d1603SAlex Elder 742650d1603SAlex Elder if (!channel->use_prefetch) 743650d1603SAlex Elder val |= USE_ESCAPE_BUF_ONLY_FMASK; 744650d1603SAlex Elder 745650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_QOS_OFFSET(channel_id)); 746650d1603SAlex Elder 747650d1603SAlex Elder /* Now update the scratch registers for GPI protocol */ 748650d1603SAlex Elder gpi = &scr.gpi; 749650d1603SAlex Elder gpi->max_outstanding_tre = gsi_channel_trans_tre_max(gsi, channel_id) * 750650d1603SAlex Elder GSI_RING_ELEMENT_SIZE; 751650d1603SAlex Elder gpi->outstanding_threshold = 2 * GSI_RING_ELEMENT_SIZE; 752650d1603SAlex Elder 753650d1603SAlex Elder val = scr.data.word1; 754650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_0_OFFSET(channel_id)); 755650d1603SAlex Elder 756650d1603SAlex Elder val = scr.data.word2; 757650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_1_OFFSET(channel_id)); 758650d1603SAlex Elder 759650d1603SAlex Elder val = scr.data.word3; 760650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_2_OFFSET(channel_id)); 761650d1603SAlex Elder 762650d1603SAlex Elder /* We must preserve the upper 16 bits of the last scratch register. 763650d1603SAlex Elder * The next sequence assumes those bits remain unchanged between the 764650d1603SAlex Elder * read and the write. 765650d1603SAlex Elder */ 766650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CH_C_SCRATCH_3_OFFSET(channel_id)); 767650d1603SAlex Elder val = (scr.data.word4 & GENMASK(31, 16)) | (val & GENMASK(15, 0)); 768650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_3_OFFSET(channel_id)); 769650d1603SAlex Elder 770650d1603SAlex Elder /* All done! */ 771650d1603SAlex Elder } 772650d1603SAlex Elder 773650d1603SAlex Elder static void gsi_channel_deprogram(struct gsi_channel *channel) 774650d1603SAlex Elder { 775650d1603SAlex Elder /* Nothing to do */ 776650d1603SAlex Elder } 777650d1603SAlex Elder 778650d1603SAlex Elder /* Start an allocated GSI channel */ 779650d1603SAlex Elder int gsi_channel_start(struct gsi *gsi, u32 channel_id) 780650d1603SAlex Elder { 781650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 782650d1603SAlex Elder int ret; 783650d1603SAlex Elder 784650d1603SAlex Elder mutex_lock(&gsi->mutex); 785650d1603SAlex Elder 786650d1603SAlex Elder ret = gsi_channel_start_command(channel); 787650d1603SAlex Elder 788650d1603SAlex Elder mutex_unlock(&gsi->mutex); 789650d1603SAlex Elder 790650d1603SAlex Elder gsi_channel_thaw(channel); 791650d1603SAlex Elder 792650d1603SAlex Elder return ret; 793650d1603SAlex Elder } 794650d1603SAlex Elder 795650d1603SAlex Elder /* Stop a started channel */ 796650d1603SAlex Elder int gsi_channel_stop(struct gsi *gsi, u32 channel_id) 797650d1603SAlex Elder { 798650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 799650d1603SAlex Elder u32 retries; 800650d1603SAlex Elder int ret; 801650d1603SAlex Elder 802650d1603SAlex Elder gsi_channel_freeze(channel); 803650d1603SAlex Elder 804650d1603SAlex Elder /* RX channels might require a little time to enter STOPPED state */ 805650d1603SAlex Elder retries = channel->toward_ipa ? 0 : GSI_CHANNEL_STOP_RX_RETRIES; 806650d1603SAlex Elder 807650d1603SAlex Elder mutex_lock(&gsi->mutex); 808650d1603SAlex Elder 809650d1603SAlex Elder do { 810650d1603SAlex Elder ret = gsi_channel_stop_command(channel); 811650d1603SAlex Elder if (ret != -EAGAIN) 812650d1603SAlex Elder break; 813650d1603SAlex Elder msleep(1); 814650d1603SAlex Elder } while (retries--); 815650d1603SAlex Elder 816650d1603SAlex Elder mutex_unlock(&gsi->mutex); 817650d1603SAlex Elder 818650d1603SAlex Elder /* Thaw the channel if we need to retry (or on error) */ 819650d1603SAlex Elder if (ret) 820650d1603SAlex Elder gsi_channel_thaw(channel); 821650d1603SAlex Elder 822650d1603SAlex Elder return ret; 823650d1603SAlex Elder } 824650d1603SAlex Elder 825650d1603SAlex Elder /* Reset and reconfigure a channel (possibly leaving doorbell disabled) */ 826f86a1909SAlex Elder void gsi_channel_reset(struct gsi *gsi, u32 channel_id, bool legacy) 827650d1603SAlex Elder { 828650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 829650d1603SAlex Elder 830650d1603SAlex Elder mutex_lock(&gsi->mutex); 831650d1603SAlex Elder 832650d1603SAlex Elder gsi_channel_reset_command(channel); 833a3f2405bSAlex Elder /* Due to a hardware quirk we may need to reset RX channels twice. */ 834a3f2405bSAlex Elder if (legacy && !channel->toward_ipa) 835650d1603SAlex Elder gsi_channel_reset_command(channel); 836650d1603SAlex Elder 837f86a1909SAlex Elder gsi_channel_program(channel, legacy); 838650d1603SAlex Elder gsi_channel_trans_cancel_pending(channel); 839650d1603SAlex Elder 840650d1603SAlex Elder mutex_unlock(&gsi->mutex); 841650d1603SAlex Elder } 842650d1603SAlex Elder 843650d1603SAlex Elder /* Stop a STARTED channel for suspend (using stop if requested) */ 844650d1603SAlex Elder int gsi_channel_suspend(struct gsi *gsi, u32 channel_id, bool stop) 845650d1603SAlex Elder { 846650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 847650d1603SAlex Elder 848650d1603SAlex Elder if (stop) 849650d1603SAlex Elder return gsi_channel_stop(gsi, channel_id); 850650d1603SAlex Elder 851650d1603SAlex Elder gsi_channel_freeze(channel); 852650d1603SAlex Elder 853650d1603SAlex Elder return 0; 854650d1603SAlex Elder } 855650d1603SAlex Elder 856650d1603SAlex Elder /* Resume a suspended channel (starting will be requested if STOPPED) */ 857650d1603SAlex Elder int gsi_channel_resume(struct gsi *gsi, u32 channel_id, bool start) 858650d1603SAlex Elder { 859650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 860650d1603SAlex Elder 861650d1603SAlex Elder if (start) 862650d1603SAlex Elder return gsi_channel_start(gsi, channel_id); 863650d1603SAlex Elder 864650d1603SAlex Elder gsi_channel_thaw(channel); 865650d1603SAlex Elder 866650d1603SAlex Elder return 0; 867650d1603SAlex Elder } 868650d1603SAlex Elder 869650d1603SAlex Elder /** 870650d1603SAlex Elder * gsi_channel_tx_queued() - Report queued TX transfers for a channel 871650d1603SAlex Elder * @channel: Channel for which to report 872650d1603SAlex Elder * 873650d1603SAlex Elder * Report to the network stack the number of bytes and transactions that 874650d1603SAlex Elder * have been queued to hardware since last call. This and the next function 875650d1603SAlex Elder * supply information used by the network stack for throttling. 876650d1603SAlex Elder * 877650d1603SAlex Elder * For each channel we track the number of transactions used and bytes of 878650d1603SAlex Elder * data those transactions represent. We also track what those values are 879650d1603SAlex Elder * each time this function is called. Subtracting the two tells us 880650d1603SAlex Elder * the number of bytes and transactions that have been added between 881650d1603SAlex Elder * successive calls. 882650d1603SAlex Elder * 883650d1603SAlex Elder * Calling this each time we ring the channel doorbell allows us to 884650d1603SAlex Elder * provide accurate information to the network stack about how much 885650d1603SAlex Elder * work we've given the hardware at any point in time. 886650d1603SAlex Elder */ 887650d1603SAlex Elder void gsi_channel_tx_queued(struct gsi_channel *channel) 888650d1603SAlex Elder { 889650d1603SAlex Elder u32 trans_count; 890650d1603SAlex Elder u32 byte_count; 891650d1603SAlex Elder 892650d1603SAlex Elder byte_count = channel->byte_count - channel->queued_byte_count; 893650d1603SAlex Elder trans_count = channel->trans_count - channel->queued_trans_count; 894650d1603SAlex Elder channel->queued_byte_count = channel->byte_count; 895650d1603SAlex Elder channel->queued_trans_count = channel->trans_count; 896650d1603SAlex Elder 897650d1603SAlex Elder ipa_gsi_channel_tx_queued(channel->gsi, gsi_channel_id(channel), 898650d1603SAlex Elder trans_count, byte_count); 899650d1603SAlex Elder } 900650d1603SAlex Elder 901650d1603SAlex Elder /** 902650d1603SAlex Elder * gsi_channel_tx_update() - Report completed TX transfers 903650d1603SAlex Elder * @channel: Channel that has completed transmitting packets 904650d1603SAlex Elder * @trans: Last transation known to be complete 905650d1603SAlex Elder * 906650d1603SAlex Elder * Compute the number of transactions and bytes that have been transferred 907650d1603SAlex Elder * over a TX channel since the given transaction was committed. Report this 908650d1603SAlex Elder * information to the network stack. 909650d1603SAlex Elder * 910650d1603SAlex Elder * At the time a transaction is committed, we record its channel's 911650d1603SAlex Elder * committed transaction and byte counts *in the transaction*. 912650d1603SAlex Elder * Completions are signaled by the hardware with an interrupt, and 913650d1603SAlex Elder * we can determine the latest completed transaction at that time. 914650d1603SAlex Elder * 915650d1603SAlex Elder * The difference between the byte/transaction count recorded in 916650d1603SAlex Elder * the transaction and the count last time we recorded a completion 917650d1603SAlex Elder * tells us exactly how much data has been transferred between 918650d1603SAlex Elder * completions. 919650d1603SAlex Elder * 920650d1603SAlex Elder * Calling this each time we learn of a newly-completed transaction 921650d1603SAlex Elder * allows us to provide accurate information to the network stack 922650d1603SAlex Elder * about how much work has been completed by the hardware at a given 923650d1603SAlex Elder * point in time. 924650d1603SAlex Elder */ 925650d1603SAlex Elder static void 926650d1603SAlex Elder gsi_channel_tx_update(struct gsi_channel *channel, struct gsi_trans *trans) 927650d1603SAlex Elder { 928650d1603SAlex Elder u64 byte_count = trans->byte_count + trans->len; 929650d1603SAlex Elder u64 trans_count = trans->trans_count + 1; 930650d1603SAlex Elder 931650d1603SAlex Elder byte_count -= channel->compl_byte_count; 932650d1603SAlex Elder channel->compl_byte_count += byte_count; 933650d1603SAlex Elder trans_count -= channel->compl_trans_count; 934650d1603SAlex Elder channel->compl_trans_count += trans_count; 935650d1603SAlex Elder 936650d1603SAlex Elder ipa_gsi_channel_tx_completed(channel->gsi, gsi_channel_id(channel), 937650d1603SAlex Elder trans_count, byte_count); 938650d1603SAlex Elder } 939650d1603SAlex Elder 940650d1603SAlex Elder /* Channel control interrupt handler */ 941650d1603SAlex Elder static void gsi_isr_chan_ctrl(struct gsi *gsi) 942650d1603SAlex Elder { 943650d1603SAlex Elder u32 channel_mask; 944650d1603SAlex Elder 945650d1603SAlex Elder channel_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_CH_IRQ_OFFSET); 946650d1603SAlex Elder iowrite32(channel_mask, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_CLR_OFFSET); 947650d1603SAlex Elder 948650d1603SAlex Elder while (channel_mask) { 949650d1603SAlex Elder u32 channel_id = __ffs(channel_mask); 950650d1603SAlex Elder struct gsi_channel *channel; 951650d1603SAlex Elder 952650d1603SAlex Elder channel_mask ^= BIT(channel_id); 953650d1603SAlex Elder 954650d1603SAlex Elder channel = &gsi->channel[channel_id]; 955650d1603SAlex Elder 956650d1603SAlex Elder complete(&channel->completion); 957650d1603SAlex Elder } 958650d1603SAlex Elder } 959650d1603SAlex Elder 960650d1603SAlex Elder /* Event ring control interrupt handler */ 961650d1603SAlex Elder static void gsi_isr_evt_ctrl(struct gsi *gsi) 962650d1603SAlex Elder { 963650d1603SAlex Elder u32 event_mask; 964650d1603SAlex Elder 965650d1603SAlex Elder event_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_OFFSET); 966650d1603SAlex Elder iowrite32(event_mask, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_CLR_OFFSET); 967650d1603SAlex Elder 968650d1603SAlex Elder while (event_mask) { 969650d1603SAlex Elder u32 evt_ring_id = __ffs(event_mask); 970650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 971650d1603SAlex Elder 972650d1603SAlex Elder event_mask ^= BIT(evt_ring_id); 973650d1603SAlex Elder 974650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 975650d1603SAlex Elder evt_ring->state = gsi_evt_ring_state(gsi, evt_ring_id); 976650d1603SAlex Elder 977650d1603SAlex Elder complete(&evt_ring->completion); 978650d1603SAlex Elder } 979650d1603SAlex Elder } 980650d1603SAlex Elder 981650d1603SAlex Elder /* Global channel error interrupt handler */ 982650d1603SAlex Elder static void 983650d1603SAlex Elder gsi_isr_glob_chan_err(struct gsi *gsi, u32 err_ee, u32 channel_id, u32 code) 984650d1603SAlex Elder { 985650d1603SAlex Elder if (code == GSI_OUT_OF_RESOURCES_ERR) { 986650d1603SAlex Elder dev_err(gsi->dev, "channel %u out of resources\n", channel_id); 987650d1603SAlex Elder complete(&gsi->channel[channel_id].completion); 988650d1603SAlex Elder return; 989650d1603SAlex Elder } 990650d1603SAlex Elder 991650d1603SAlex Elder /* Report, but otherwise ignore all other error codes */ 992650d1603SAlex Elder dev_err(gsi->dev, "channel %u global error ee 0x%08x code 0x%08x\n", 993650d1603SAlex Elder channel_id, err_ee, code); 994650d1603SAlex Elder } 995650d1603SAlex Elder 996650d1603SAlex Elder /* Global event error interrupt handler */ 997650d1603SAlex Elder static void 998650d1603SAlex Elder gsi_isr_glob_evt_err(struct gsi *gsi, u32 err_ee, u32 evt_ring_id, u32 code) 999650d1603SAlex Elder { 1000650d1603SAlex Elder if (code == GSI_OUT_OF_RESOURCES_ERR) { 1001650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 1002650d1603SAlex Elder u32 channel_id = gsi_channel_id(evt_ring->channel); 1003650d1603SAlex Elder 1004650d1603SAlex Elder complete(&evt_ring->completion); 1005650d1603SAlex Elder dev_err(gsi->dev, "evt_ring for channel %u out of resources\n", 1006650d1603SAlex Elder channel_id); 1007650d1603SAlex Elder return; 1008650d1603SAlex Elder } 1009650d1603SAlex Elder 1010650d1603SAlex Elder /* Report, but otherwise ignore all other error codes */ 1011650d1603SAlex Elder dev_err(gsi->dev, "event ring %u global error ee %u code 0x%08x\n", 1012650d1603SAlex Elder evt_ring_id, err_ee, code); 1013650d1603SAlex Elder } 1014650d1603SAlex Elder 1015650d1603SAlex Elder /* Global error interrupt handler */ 1016650d1603SAlex Elder static void gsi_isr_glob_err(struct gsi *gsi) 1017650d1603SAlex Elder { 1018650d1603SAlex Elder enum gsi_err_type type; 1019650d1603SAlex Elder enum gsi_err_code code; 1020650d1603SAlex Elder u32 which; 1021650d1603SAlex Elder u32 val; 1022650d1603SAlex Elder u32 ee; 1023650d1603SAlex Elder 1024650d1603SAlex Elder /* Get the logged error, then reinitialize the log */ 1025650d1603SAlex Elder val = ioread32(gsi->virt + GSI_ERROR_LOG_OFFSET); 1026650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_ERROR_LOG_OFFSET); 1027650d1603SAlex Elder iowrite32(~0, gsi->virt + GSI_ERROR_LOG_CLR_OFFSET); 1028650d1603SAlex Elder 1029650d1603SAlex Elder ee = u32_get_bits(val, ERR_EE_FMASK); 1030650d1603SAlex Elder which = u32_get_bits(val, ERR_VIRT_IDX_FMASK); 1031650d1603SAlex Elder type = u32_get_bits(val, ERR_TYPE_FMASK); 1032650d1603SAlex Elder code = u32_get_bits(val, ERR_CODE_FMASK); 1033650d1603SAlex Elder 1034650d1603SAlex Elder if (type == GSI_ERR_TYPE_CHAN) 1035650d1603SAlex Elder gsi_isr_glob_chan_err(gsi, ee, which, code); 1036650d1603SAlex Elder else if (type == GSI_ERR_TYPE_EVT) 1037650d1603SAlex Elder gsi_isr_glob_evt_err(gsi, ee, which, code); 1038650d1603SAlex Elder else /* type GSI_ERR_TYPE_GLOB should be fatal */ 1039650d1603SAlex Elder dev_err(gsi->dev, "unexpected global error 0x%08x\n", type); 1040650d1603SAlex Elder } 1041650d1603SAlex Elder 1042650d1603SAlex Elder /* Generic EE interrupt handler */ 1043650d1603SAlex Elder static void gsi_isr_gp_int1(struct gsi *gsi) 1044650d1603SAlex Elder { 1045650d1603SAlex Elder u32 result; 1046650d1603SAlex Elder u32 val; 1047650d1603SAlex Elder 1048650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 1049650d1603SAlex Elder result = u32_get_bits(val, GENERIC_EE_RESULT_FMASK); 1050650d1603SAlex Elder if (result != GENERIC_EE_SUCCESS_FVAL) 1051650d1603SAlex Elder dev_err(gsi->dev, "global INT1 generic result %u\n", result); 1052650d1603SAlex Elder 1053650d1603SAlex Elder complete(&gsi->completion); 1054650d1603SAlex Elder } 10550b1ba18aSAlex Elder 1056650d1603SAlex Elder /* Inter-EE interrupt handler */ 1057650d1603SAlex Elder static void gsi_isr_glob_ee(struct gsi *gsi) 1058650d1603SAlex Elder { 1059650d1603SAlex Elder u32 val; 1060650d1603SAlex Elder 1061650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_GLOB_IRQ_STTS_OFFSET); 1062650d1603SAlex Elder 1063650d1603SAlex Elder if (val & ERROR_INT_FMASK) 1064650d1603SAlex Elder gsi_isr_glob_err(gsi); 1065650d1603SAlex Elder 1066650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GLOB_IRQ_CLR_OFFSET); 1067650d1603SAlex Elder 1068650d1603SAlex Elder val &= ~ERROR_INT_FMASK; 1069650d1603SAlex Elder 1070650d1603SAlex Elder if (val & EN_GP_INT1_FMASK) { 1071650d1603SAlex Elder val ^= EN_GP_INT1_FMASK; 1072650d1603SAlex Elder gsi_isr_gp_int1(gsi); 1073650d1603SAlex Elder } 1074650d1603SAlex Elder 1075650d1603SAlex Elder if (val) 1076650d1603SAlex Elder dev_err(gsi->dev, "unexpected global interrupt 0x%08x\n", val); 1077650d1603SAlex Elder } 1078650d1603SAlex Elder 1079650d1603SAlex Elder /* I/O completion interrupt event */ 1080650d1603SAlex Elder static void gsi_isr_ieob(struct gsi *gsi) 1081650d1603SAlex Elder { 1082650d1603SAlex Elder u32 event_mask; 1083650d1603SAlex Elder 1084650d1603SAlex Elder event_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_OFFSET); 1085195ef57fSAlex Elder iowrite32(event_mask, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_CLR_OFFSET); 1086650d1603SAlex Elder 1087650d1603SAlex Elder while (event_mask) { 1088650d1603SAlex Elder u32 evt_ring_id = __ffs(event_mask); 1089650d1603SAlex Elder 1090650d1603SAlex Elder event_mask ^= BIT(evt_ring_id); 1091650d1603SAlex Elder 1092650d1603SAlex Elder gsi_irq_ieob_disable(gsi, evt_ring_id); 1093650d1603SAlex Elder napi_schedule(&gsi->evt_ring[evt_ring_id].channel->napi); 1094650d1603SAlex Elder } 1095650d1603SAlex Elder } 1096650d1603SAlex Elder 1097650d1603SAlex Elder /* General event interrupts represent serious problems, so report them */ 1098650d1603SAlex Elder static void gsi_isr_general(struct gsi *gsi) 1099650d1603SAlex Elder { 1100650d1603SAlex Elder struct device *dev = gsi->dev; 1101650d1603SAlex Elder u32 val; 1102650d1603SAlex Elder 1103650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_GSI_IRQ_STTS_OFFSET); 1104650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GSI_IRQ_CLR_OFFSET); 1105650d1603SAlex Elder 1106650d1603SAlex Elder if (val) 1107650d1603SAlex Elder dev_err(dev, "unexpected general interrupt 0x%08x\n", val); 1108650d1603SAlex Elder } 1109650d1603SAlex Elder 1110650d1603SAlex Elder /** 1111650d1603SAlex Elder * gsi_isr() - Top level GSI interrupt service routine 1112650d1603SAlex Elder * @irq: Interrupt number (ignored) 1113650d1603SAlex Elder * @dev_id: GSI pointer supplied to request_irq() 1114650d1603SAlex Elder * 1115650d1603SAlex Elder * This is the main handler function registered for the GSI IRQ. Each type 1116650d1603SAlex Elder * of interrupt has a separate handler function that is called from here. 1117650d1603SAlex Elder */ 1118650d1603SAlex Elder static irqreturn_t gsi_isr(int irq, void *dev_id) 1119650d1603SAlex Elder { 1120650d1603SAlex Elder struct gsi *gsi = dev_id; 1121650d1603SAlex Elder u32 intr_mask; 1122650d1603SAlex Elder u32 cnt = 0; 1123650d1603SAlex Elder 1124650d1603SAlex Elder while ((intr_mask = ioread32(gsi->virt + GSI_CNTXT_TYPE_IRQ_OFFSET))) { 1125650d1603SAlex Elder /* intr_mask contains bitmask of pending GSI interrupts */ 1126650d1603SAlex Elder do { 1127650d1603SAlex Elder u32 gsi_intr = BIT(__ffs(intr_mask)); 1128650d1603SAlex Elder 1129650d1603SAlex Elder intr_mask ^= gsi_intr; 1130650d1603SAlex Elder 1131650d1603SAlex Elder switch (gsi_intr) { 1132650d1603SAlex Elder case CH_CTRL_FMASK: 1133650d1603SAlex Elder gsi_isr_chan_ctrl(gsi); 1134650d1603SAlex Elder break; 1135650d1603SAlex Elder case EV_CTRL_FMASK: 1136650d1603SAlex Elder gsi_isr_evt_ctrl(gsi); 1137650d1603SAlex Elder break; 1138650d1603SAlex Elder case GLOB_EE_FMASK: 1139650d1603SAlex Elder gsi_isr_glob_ee(gsi); 1140650d1603SAlex Elder break; 1141650d1603SAlex Elder case IEOB_FMASK: 1142650d1603SAlex Elder gsi_isr_ieob(gsi); 1143650d1603SAlex Elder break; 1144650d1603SAlex Elder case GENERAL_FMASK: 1145650d1603SAlex Elder gsi_isr_general(gsi); 1146650d1603SAlex Elder break; 1147650d1603SAlex Elder default: 1148650d1603SAlex Elder dev_err(gsi->dev, 1149650d1603SAlex Elder "%s: unrecognized type 0x%08x\n", 1150650d1603SAlex Elder __func__, gsi_intr); 1151650d1603SAlex Elder break; 1152650d1603SAlex Elder } 1153650d1603SAlex Elder } while (intr_mask); 1154650d1603SAlex Elder 1155650d1603SAlex Elder if (++cnt > GSI_ISR_MAX_ITER) { 1156650d1603SAlex Elder dev_err(gsi->dev, "interrupt flood\n"); 1157650d1603SAlex Elder break; 1158650d1603SAlex Elder } 1159650d1603SAlex Elder } 1160650d1603SAlex Elder 1161650d1603SAlex Elder return IRQ_HANDLED; 1162650d1603SAlex Elder } 1163650d1603SAlex Elder 1164650d1603SAlex Elder /* Return the transaction associated with a transfer completion event */ 1165650d1603SAlex Elder static struct gsi_trans *gsi_event_trans(struct gsi_channel *channel, 1166650d1603SAlex Elder struct gsi_event *event) 1167650d1603SAlex Elder { 1168650d1603SAlex Elder u32 tre_offset; 1169650d1603SAlex Elder u32 tre_index; 1170650d1603SAlex Elder 1171650d1603SAlex Elder /* Event xfer_ptr records the TRE it's associated with */ 1172650d1603SAlex Elder tre_offset = le64_to_cpu(event->xfer_ptr) & GENMASK(31, 0); 1173650d1603SAlex Elder tre_index = gsi_ring_index(&channel->tre_ring, tre_offset); 1174650d1603SAlex Elder 1175650d1603SAlex Elder return gsi_channel_trans_mapped(channel, tre_index); 1176650d1603SAlex Elder } 1177650d1603SAlex Elder 1178650d1603SAlex Elder /** 1179650d1603SAlex Elder * gsi_evt_ring_rx_update() - Record lengths of received data 1180650d1603SAlex Elder * @evt_ring: Event ring associated with channel that received packets 1181650d1603SAlex Elder * @index: Event index in ring reported by hardware 1182650d1603SAlex Elder * 1183650d1603SAlex Elder * Events for RX channels contain the actual number of bytes received into 1184650d1603SAlex Elder * the buffer. Every event has a transaction associated with it, and here 1185650d1603SAlex Elder * we update transactions to record their actual received lengths. 1186650d1603SAlex Elder * 1187650d1603SAlex Elder * This function is called whenever we learn that the GSI hardware has filled 1188650d1603SAlex Elder * new events since the last time we checked. The ring's index field tells 1189650d1603SAlex Elder * the first entry in need of processing. The index provided is the 1190650d1603SAlex Elder * first *unfilled* event in the ring (following the last filled one). 1191650d1603SAlex Elder * 1192650d1603SAlex Elder * Events are sequential within the event ring, and transactions are 1193650d1603SAlex Elder * sequential within the transaction pool. 1194650d1603SAlex Elder * 1195650d1603SAlex Elder * Note that @index always refers to an element *within* the event ring. 1196650d1603SAlex Elder */ 1197650d1603SAlex Elder static void gsi_evt_ring_rx_update(struct gsi_evt_ring *evt_ring, u32 index) 1198650d1603SAlex Elder { 1199650d1603SAlex Elder struct gsi_channel *channel = evt_ring->channel; 1200650d1603SAlex Elder struct gsi_ring *ring = &evt_ring->ring; 1201650d1603SAlex Elder struct gsi_trans_info *trans_info; 1202650d1603SAlex Elder struct gsi_event *event_done; 1203650d1603SAlex Elder struct gsi_event *event; 1204650d1603SAlex Elder struct gsi_trans *trans; 1205650d1603SAlex Elder u32 byte_count = 0; 1206650d1603SAlex Elder u32 old_index; 1207650d1603SAlex Elder u32 event_avail; 1208650d1603SAlex Elder 1209650d1603SAlex Elder trans_info = &channel->trans_info; 1210650d1603SAlex Elder 1211650d1603SAlex Elder /* We'll start with the oldest un-processed event. RX channels 1212650d1603SAlex Elder * replenish receive buffers in single-TRE transactions, so we 1213650d1603SAlex Elder * can just map that event to its transaction. Transactions 1214650d1603SAlex Elder * associated with completion events are consecutive. 1215650d1603SAlex Elder */ 1216650d1603SAlex Elder old_index = ring->index; 1217650d1603SAlex Elder event = gsi_ring_virt(ring, old_index); 1218650d1603SAlex Elder trans = gsi_event_trans(channel, event); 1219650d1603SAlex Elder 1220650d1603SAlex Elder /* Compute the number of events to process before we wrap, 1221650d1603SAlex Elder * and determine when we'll be done processing events. 1222650d1603SAlex Elder */ 1223650d1603SAlex Elder event_avail = ring->count - old_index % ring->count; 1224650d1603SAlex Elder event_done = gsi_ring_virt(ring, index); 1225650d1603SAlex Elder do { 1226650d1603SAlex Elder trans->len = __le16_to_cpu(event->len); 1227650d1603SAlex Elder byte_count += trans->len; 1228650d1603SAlex Elder 1229650d1603SAlex Elder /* Move on to the next event and transaction */ 1230650d1603SAlex Elder if (--event_avail) 1231650d1603SAlex Elder event++; 1232650d1603SAlex Elder else 1233650d1603SAlex Elder event = gsi_ring_virt(ring, 0); 1234650d1603SAlex Elder trans = gsi_trans_pool_next(&trans_info->pool, trans); 1235650d1603SAlex Elder } while (event != event_done); 1236650d1603SAlex Elder 1237650d1603SAlex Elder /* We record RX bytes when they are received */ 1238650d1603SAlex Elder channel->byte_count += byte_count; 1239650d1603SAlex Elder channel->trans_count++; 1240650d1603SAlex Elder } 1241650d1603SAlex Elder 1242650d1603SAlex Elder /* Initialize a ring, including allocating DMA memory for its entries */ 1243650d1603SAlex Elder static int gsi_ring_alloc(struct gsi *gsi, struct gsi_ring *ring, u32 count) 1244650d1603SAlex Elder { 1245650d1603SAlex Elder size_t size = count * GSI_RING_ELEMENT_SIZE; 1246650d1603SAlex Elder struct device *dev = gsi->dev; 1247650d1603SAlex Elder dma_addr_t addr; 1248650d1603SAlex Elder 1249650d1603SAlex Elder /* Hardware requires a 2^n ring size, with alignment equal to size */ 1250650d1603SAlex Elder ring->virt = dma_alloc_coherent(dev, size, &addr, GFP_KERNEL); 1251650d1603SAlex Elder if (ring->virt && addr % size) { 1252650d1603SAlex Elder dma_free_coherent(dev, size, ring->virt, ring->addr); 1253650d1603SAlex Elder dev_err(dev, "unable to alloc 0x%zx-aligned ring buffer\n", 1254650d1603SAlex Elder size); 1255650d1603SAlex Elder return -EINVAL; /* Not a good error value, but distinct */ 1256650d1603SAlex Elder } else if (!ring->virt) { 1257650d1603SAlex Elder return -ENOMEM; 1258650d1603SAlex Elder } 1259650d1603SAlex Elder ring->addr = addr; 1260650d1603SAlex Elder ring->count = count; 1261650d1603SAlex Elder 1262650d1603SAlex Elder return 0; 1263650d1603SAlex Elder } 1264650d1603SAlex Elder 1265650d1603SAlex Elder /* Free a previously-allocated ring */ 1266650d1603SAlex Elder static void gsi_ring_free(struct gsi *gsi, struct gsi_ring *ring) 1267650d1603SAlex Elder { 1268650d1603SAlex Elder size_t size = ring->count * GSI_RING_ELEMENT_SIZE; 1269650d1603SAlex Elder 1270650d1603SAlex Elder dma_free_coherent(gsi->dev, size, ring->virt, ring->addr); 1271650d1603SAlex Elder } 1272650d1603SAlex Elder 1273650d1603SAlex Elder /* Allocate an available event ring id */ 1274650d1603SAlex Elder static int gsi_evt_ring_id_alloc(struct gsi *gsi) 1275650d1603SAlex Elder { 1276650d1603SAlex Elder u32 evt_ring_id; 1277650d1603SAlex Elder 1278650d1603SAlex Elder if (gsi->event_bitmap == ~0U) { 1279650d1603SAlex Elder dev_err(gsi->dev, "event rings exhausted\n"); 1280650d1603SAlex Elder return -ENOSPC; 1281650d1603SAlex Elder } 1282650d1603SAlex Elder 1283650d1603SAlex Elder evt_ring_id = ffz(gsi->event_bitmap); 1284650d1603SAlex Elder gsi->event_bitmap |= BIT(evt_ring_id); 1285650d1603SAlex Elder 1286650d1603SAlex Elder return (int)evt_ring_id; 1287650d1603SAlex Elder } 1288650d1603SAlex Elder 1289650d1603SAlex Elder /* Free a previously-allocated event ring id */ 1290650d1603SAlex Elder static void gsi_evt_ring_id_free(struct gsi *gsi, u32 evt_ring_id) 1291650d1603SAlex Elder { 1292650d1603SAlex Elder gsi->event_bitmap &= ~BIT(evt_ring_id); 1293650d1603SAlex Elder } 1294650d1603SAlex Elder 1295650d1603SAlex Elder /* Ring a channel doorbell, reporting the first un-filled entry */ 1296650d1603SAlex Elder void gsi_channel_doorbell(struct gsi_channel *channel) 1297650d1603SAlex Elder { 1298650d1603SAlex Elder struct gsi_ring *tre_ring = &channel->tre_ring; 1299650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 1300650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1301650d1603SAlex Elder u32 val; 1302650d1603SAlex Elder 1303650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 1304650d1603SAlex Elder val = gsi_ring_addr(tre_ring, tre_ring->index % tre_ring->count); 1305650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_DOORBELL_0_OFFSET(channel_id)); 1306650d1603SAlex Elder } 1307650d1603SAlex Elder 1308650d1603SAlex Elder /* Consult hardware, move any newly completed transactions to completed list */ 1309650d1603SAlex Elder static void gsi_channel_update(struct gsi_channel *channel) 1310650d1603SAlex Elder { 1311650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1312650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1313650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1314650d1603SAlex Elder struct gsi_trans *trans; 1315650d1603SAlex Elder struct gsi_ring *ring; 1316650d1603SAlex Elder u32 offset; 1317650d1603SAlex Elder u32 index; 1318650d1603SAlex Elder 1319650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 1320650d1603SAlex Elder ring = &evt_ring->ring; 1321650d1603SAlex Elder 1322650d1603SAlex Elder /* See if there's anything new to process; if not, we're done. Note 1323650d1603SAlex Elder * that index always refers to an entry *within* the event ring. 1324650d1603SAlex Elder */ 1325650d1603SAlex Elder offset = GSI_EV_CH_E_CNTXT_4_OFFSET(evt_ring_id); 1326650d1603SAlex Elder index = gsi_ring_index(ring, ioread32(gsi->virt + offset)); 1327650d1603SAlex Elder if (index == ring->index % ring->count) 1328650d1603SAlex Elder return; 1329650d1603SAlex Elder 1330650d1603SAlex Elder /* Get the transaction for the latest completed event. Take a 1331650d1603SAlex Elder * reference to keep it from completing before we give the events 1332650d1603SAlex Elder * for this and previous transactions back to the hardware. 1333650d1603SAlex Elder */ 1334650d1603SAlex Elder trans = gsi_event_trans(channel, gsi_ring_virt(ring, index - 1)); 1335650d1603SAlex Elder refcount_inc(&trans->refcount); 1336650d1603SAlex Elder 1337650d1603SAlex Elder /* For RX channels, update each completed transaction with the number 1338650d1603SAlex Elder * of bytes that were actually received. For TX channels, report 1339650d1603SAlex Elder * the number of transactions and bytes this completion represents 1340650d1603SAlex Elder * up the network stack. 1341650d1603SAlex Elder */ 1342650d1603SAlex Elder if (channel->toward_ipa) 1343650d1603SAlex Elder gsi_channel_tx_update(channel, trans); 1344650d1603SAlex Elder else 1345650d1603SAlex Elder gsi_evt_ring_rx_update(evt_ring, index); 1346650d1603SAlex Elder 1347650d1603SAlex Elder gsi_trans_move_complete(trans); 1348650d1603SAlex Elder 1349650d1603SAlex Elder /* Tell the hardware we've handled these events */ 1350650d1603SAlex Elder gsi_evt_ring_doorbell(channel->gsi, channel->evt_ring_id, index); 1351650d1603SAlex Elder 1352650d1603SAlex Elder gsi_trans_free(trans); 1353650d1603SAlex Elder } 1354650d1603SAlex Elder 1355650d1603SAlex Elder /** 1356650d1603SAlex Elder * gsi_channel_poll_one() - Return a single completed transaction on a channel 1357650d1603SAlex Elder * @channel: Channel to be polled 1358650d1603SAlex Elder * 1359650d1603SAlex Elder * @Return: Transaction pointer, or null if none are available 1360650d1603SAlex Elder * 1361650d1603SAlex Elder * This function returns the first entry on a channel's completed transaction 1362650d1603SAlex Elder * list. If that list is empty, the hardware is consulted to determine 1363650d1603SAlex Elder * whether any new transactions have completed. If so, they're moved to the 1364650d1603SAlex Elder * completed list and the new first entry is returned. If there are no more 1365650d1603SAlex Elder * completed transactions, a null pointer is returned. 1366650d1603SAlex Elder */ 1367650d1603SAlex Elder static struct gsi_trans *gsi_channel_poll_one(struct gsi_channel *channel) 1368650d1603SAlex Elder { 1369650d1603SAlex Elder struct gsi_trans *trans; 1370650d1603SAlex Elder 1371650d1603SAlex Elder /* Get the first transaction from the completed list */ 1372650d1603SAlex Elder trans = gsi_channel_trans_complete(channel); 1373650d1603SAlex Elder if (!trans) { 1374650d1603SAlex Elder /* List is empty; see if there's more to do */ 1375650d1603SAlex Elder gsi_channel_update(channel); 1376650d1603SAlex Elder trans = gsi_channel_trans_complete(channel); 1377650d1603SAlex Elder } 1378650d1603SAlex Elder 1379650d1603SAlex Elder if (trans) 1380650d1603SAlex Elder gsi_trans_move_polled(trans); 1381650d1603SAlex Elder 1382650d1603SAlex Elder return trans; 1383650d1603SAlex Elder } 1384650d1603SAlex Elder 1385650d1603SAlex Elder /** 1386650d1603SAlex Elder * gsi_channel_poll() - NAPI poll function for a channel 1387650d1603SAlex Elder * @napi: NAPI structure for the channel 1388650d1603SAlex Elder * @budget: Budget supplied by NAPI core 1389650d1603SAlex Elder 1390650d1603SAlex Elder * @Return: Number of items polled (<= budget) 1391650d1603SAlex Elder * 1392650d1603SAlex Elder * Single transactions completed by hardware are polled until either 1393650d1603SAlex Elder * the budget is exhausted, or there are no more. Each transaction 1394650d1603SAlex Elder * polled is passed to gsi_trans_complete(), to perform remaining 1395650d1603SAlex Elder * completion processing and retire/free the transaction. 1396650d1603SAlex Elder */ 1397650d1603SAlex Elder static int gsi_channel_poll(struct napi_struct *napi, int budget) 1398650d1603SAlex Elder { 1399650d1603SAlex Elder struct gsi_channel *channel; 1400650d1603SAlex Elder int count = 0; 1401650d1603SAlex Elder 1402650d1603SAlex Elder channel = container_of(napi, struct gsi_channel, napi); 1403650d1603SAlex Elder while (count < budget) { 1404650d1603SAlex Elder struct gsi_trans *trans; 1405650d1603SAlex Elder 1406f45a7bccSAlex Elder count++; 1407650d1603SAlex Elder trans = gsi_channel_poll_one(channel); 1408650d1603SAlex Elder if (!trans) 1409650d1603SAlex Elder break; 1410650d1603SAlex Elder gsi_trans_complete(trans); 1411650d1603SAlex Elder } 1412650d1603SAlex Elder 1413650d1603SAlex Elder if (count < budget) { 1414650d1603SAlex Elder napi_complete(&channel->napi); 1415650d1603SAlex Elder gsi_irq_ieob_enable(channel->gsi, channel->evt_ring_id); 1416650d1603SAlex Elder } 1417650d1603SAlex Elder 1418650d1603SAlex Elder return count; 1419650d1603SAlex Elder } 1420650d1603SAlex Elder 1421650d1603SAlex Elder /* The event bitmap represents which event ids are available for allocation. 1422650d1603SAlex Elder * Set bits are not available, clear bits can be used. This function 1423650d1603SAlex Elder * initializes the map so all events supported by the hardware are available, 1424650d1603SAlex Elder * then precludes any reserved events from being allocated. 1425650d1603SAlex Elder */ 1426650d1603SAlex Elder static u32 gsi_event_bitmap_init(u32 evt_ring_max) 1427650d1603SAlex Elder { 1428650d1603SAlex Elder u32 event_bitmap = GENMASK(BITS_PER_LONG - 1, evt_ring_max); 1429650d1603SAlex Elder 1430650d1603SAlex Elder event_bitmap |= GENMASK(GSI_MHI_EVENT_ID_END, GSI_MHI_EVENT_ID_START); 1431650d1603SAlex Elder 1432650d1603SAlex Elder return event_bitmap; 1433650d1603SAlex Elder } 1434650d1603SAlex Elder 1435650d1603SAlex Elder /* Setup function for event rings */ 1436650d1603SAlex Elder static void gsi_evt_ring_setup(struct gsi *gsi) 1437650d1603SAlex Elder { 1438650d1603SAlex Elder /* Nothing to do */ 1439650d1603SAlex Elder } 1440650d1603SAlex Elder 1441650d1603SAlex Elder /* Inverse of gsi_evt_ring_setup() */ 1442650d1603SAlex Elder static void gsi_evt_ring_teardown(struct gsi *gsi) 1443650d1603SAlex Elder { 1444650d1603SAlex Elder /* Nothing to do */ 1445650d1603SAlex Elder } 1446650d1603SAlex Elder 1447650d1603SAlex Elder /* Setup function for a single channel */ 1448650d1603SAlex Elder static int gsi_channel_setup_one(struct gsi *gsi, u32 channel_id, 1449f86a1909SAlex Elder bool legacy) 1450650d1603SAlex Elder { 1451650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1452650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1453650d1603SAlex Elder int ret; 1454650d1603SAlex Elder 1455650d1603SAlex Elder if (!channel->gsi) 1456650d1603SAlex Elder return 0; /* Ignore uninitialized channels */ 1457650d1603SAlex Elder 1458650d1603SAlex Elder ret = gsi_evt_ring_alloc_command(gsi, evt_ring_id); 1459650d1603SAlex Elder if (ret) 1460650d1603SAlex Elder return ret; 1461650d1603SAlex Elder 1462650d1603SAlex Elder gsi_evt_ring_program(gsi, evt_ring_id); 1463650d1603SAlex Elder 1464650d1603SAlex Elder ret = gsi_channel_alloc_command(gsi, channel_id); 1465650d1603SAlex Elder if (ret) 1466650d1603SAlex Elder goto err_evt_ring_de_alloc; 1467650d1603SAlex Elder 1468f86a1909SAlex Elder gsi_channel_program(channel, legacy); 1469650d1603SAlex Elder 1470650d1603SAlex Elder if (channel->toward_ipa) 1471650d1603SAlex Elder netif_tx_napi_add(&gsi->dummy_dev, &channel->napi, 1472650d1603SAlex Elder gsi_channel_poll, NAPI_POLL_WEIGHT); 1473650d1603SAlex Elder else 1474650d1603SAlex Elder netif_napi_add(&gsi->dummy_dev, &channel->napi, 1475650d1603SAlex Elder gsi_channel_poll, NAPI_POLL_WEIGHT); 1476650d1603SAlex Elder 1477650d1603SAlex Elder return 0; 1478650d1603SAlex Elder 1479650d1603SAlex Elder err_evt_ring_de_alloc: 1480650d1603SAlex Elder /* We've done nothing with the event ring yet so don't reset */ 1481650d1603SAlex Elder gsi_evt_ring_de_alloc_command(gsi, evt_ring_id); 1482650d1603SAlex Elder 1483650d1603SAlex Elder return ret; 1484650d1603SAlex Elder } 1485650d1603SAlex Elder 1486650d1603SAlex Elder /* Inverse of gsi_channel_setup_one() */ 1487650d1603SAlex Elder static void gsi_channel_teardown_one(struct gsi *gsi, u32 channel_id) 1488650d1603SAlex Elder { 1489650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1490650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1491650d1603SAlex Elder 1492650d1603SAlex Elder if (!channel->gsi) 1493650d1603SAlex Elder return; /* Ignore uninitialized channels */ 1494650d1603SAlex Elder 1495650d1603SAlex Elder netif_napi_del(&channel->napi); 1496650d1603SAlex Elder 1497650d1603SAlex Elder gsi_channel_deprogram(channel); 1498650d1603SAlex Elder gsi_channel_de_alloc_command(gsi, channel_id); 1499650d1603SAlex Elder gsi_evt_ring_reset_command(gsi, evt_ring_id); 1500650d1603SAlex Elder gsi_evt_ring_de_alloc_command(gsi, evt_ring_id); 1501650d1603SAlex Elder } 1502650d1603SAlex Elder 1503650d1603SAlex Elder static int gsi_generic_command(struct gsi *gsi, u32 channel_id, 1504650d1603SAlex Elder enum gsi_generic_cmd_opcode opcode) 1505650d1603SAlex Elder { 1506650d1603SAlex Elder struct completion *completion = &gsi->completion; 1507650d1603SAlex Elder u32 val; 1508650d1603SAlex Elder 15090b1ba18aSAlex Elder /* First zero the result code field */ 15100b1ba18aSAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 15110b1ba18aSAlex Elder val &= ~GENERIC_EE_RESULT_FMASK; 15120b1ba18aSAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 15130b1ba18aSAlex Elder 15140b1ba18aSAlex Elder /* Now issue the command */ 1515650d1603SAlex Elder val = u32_encode_bits(opcode, GENERIC_OPCODE_FMASK); 1516650d1603SAlex Elder val |= u32_encode_bits(channel_id, GENERIC_CHID_FMASK); 1517650d1603SAlex Elder val |= u32_encode_bits(GSI_EE_MODEM, GENERIC_EE_FMASK); 1518650d1603SAlex Elder 1519650d1603SAlex Elder if (gsi_command(gsi, GSI_GENERIC_CMD_OFFSET, val, completion)) 1520650d1603SAlex Elder return 0; /* Success! */ 1521650d1603SAlex Elder 1522650d1603SAlex Elder dev_err(gsi->dev, "GSI generic command %u to channel %u timed out\n", 1523650d1603SAlex Elder opcode, channel_id); 1524650d1603SAlex Elder 1525650d1603SAlex Elder return -ETIMEDOUT; 1526650d1603SAlex Elder } 1527650d1603SAlex Elder 1528650d1603SAlex Elder static int gsi_modem_channel_alloc(struct gsi *gsi, u32 channel_id) 1529650d1603SAlex Elder { 1530650d1603SAlex Elder return gsi_generic_command(gsi, channel_id, 1531650d1603SAlex Elder GSI_GENERIC_ALLOCATE_CHANNEL); 1532650d1603SAlex Elder } 1533650d1603SAlex Elder 1534650d1603SAlex Elder static void gsi_modem_channel_halt(struct gsi *gsi, u32 channel_id) 1535650d1603SAlex Elder { 1536650d1603SAlex Elder int ret; 1537650d1603SAlex Elder 1538650d1603SAlex Elder ret = gsi_generic_command(gsi, channel_id, GSI_GENERIC_HALT_CHANNEL); 1539650d1603SAlex Elder if (ret) 1540650d1603SAlex Elder dev_err(gsi->dev, "error %d halting modem channel %u\n", 1541650d1603SAlex Elder ret, channel_id); 1542650d1603SAlex Elder } 1543650d1603SAlex Elder 1544650d1603SAlex Elder /* Setup function for channels */ 1545f86a1909SAlex Elder static int gsi_channel_setup(struct gsi *gsi, bool legacy) 1546650d1603SAlex Elder { 1547650d1603SAlex Elder u32 channel_id = 0; 1548650d1603SAlex Elder u32 mask; 1549650d1603SAlex Elder int ret; 1550650d1603SAlex Elder 1551650d1603SAlex Elder gsi_evt_ring_setup(gsi); 1552650d1603SAlex Elder gsi_irq_enable(gsi); 1553650d1603SAlex Elder 1554650d1603SAlex Elder mutex_lock(&gsi->mutex); 1555650d1603SAlex Elder 1556650d1603SAlex Elder do { 1557f86a1909SAlex Elder ret = gsi_channel_setup_one(gsi, channel_id, legacy); 1558650d1603SAlex Elder if (ret) 1559650d1603SAlex Elder goto err_unwind; 1560650d1603SAlex Elder } while (++channel_id < gsi->channel_count); 1561650d1603SAlex Elder 1562650d1603SAlex Elder /* Make sure no channels were defined that hardware does not support */ 1563650d1603SAlex Elder while (channel_id < GSI_CHANNEL_COUNT_MAX) { 1564650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id++]; 1565650d1603SAlex Elder 1566650d1603SAlex Elder if (!channel->gsi) 1567650d1603SAlex Elder continue; /* Ignore uninitialized channels */ 1568650d1603SAlex Elder 1569650d1603SAlex Elder dev_err(gsi->dev, "channel %u not supported by hardware\n", 1570650d1603SAlex Elder channel_id - 1); 1571650d1603SAlex Elder channel_id = gsi->channel_count; 1572650d1603SAlex Elder goto err_unwind; 1573650d1603SAlex Elder } 1574650d1603SAlex Elder 1575650d1603SAlex Elder /* Allocate modem channels if necessary */ 1576650d1603SAlex Elder mask = gsi->modem_channel_bitmap; 1577650d1603SAlex Elder while (mask) { 1578650d1603SAlex Elder u32 modem_channel_id = __ffs(mask); 1579650d1603SAlex Elder 1580650d1603SAlex Elder ret = gsi_modem_channel_alloc(gsi, modem_channel_id); 1581650d1603SAlex Elder if (ret) 1582650d1603SAlex Elder goto err_unwind_modem; 1583650d1603SAlex Elder 1584650d1603SAlex Elder /* Clear bit from mask only after success (for unwind) */ 1585650d1603SAlex Elder mask ^= BIT(modem_channel_id); 1586650d1603SAlex Elder } 1587650d1603SAlex Elder 1588650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1589650d1603SAlex Elder 1590650d1603SAlex Elder return 0; 1591650d1603SAlex Elder 1592650d1603SAlex Elder err_unwind_modem: 1593650d1603SAlex Elder /* Compute which modem channels need to be deallocated */ 1594650d1603SAlex Elder mask ^= gsi->modem_channel_bitmap; 1595650d1603SAlex Elder while (mask) { 1596650d1603SAlex Elder u32 channel_id = __fls(mask); 1597650d1603SAlex Elder 1598650d1603SAlex Elder mask ^= BIT(channel_id); 1599650d1603SAlex Elder 1600650d1603SAlex Elder gsi_modem_channel_halt(gsi, channel_id); 1601650d1603SAlex Elder } 1602650d1603SAlex Elder 1603650d1603SAlex Elder err_unwind: 1604650d1603SAlex Elder while (channel_id--) 1605650d1603SAlex Elder gsi_channel_teardown_one(gsi, channel_id); 1606650d1603SAlex Elder 1607650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1608650d1603SAlex Elder 1609650d1603SAlex Elder gsi_irq_disable(gsi); 1610650d1603SAlex Elder gsi_evt_ring_teardown(gsi); 1611650d1603SAlex Elder 1612650d1603SAlex Elder return ret; 1613650d1603SAlex Elder } 1614650d1603SAlex Elder 1615650d1603SAlex Elder /* Inverse of gsi_channel_setup() */ 1616650d1603SAlex Elder static void gsi_channel_teardown(struct gsi *gsi) 1617650d1603SAlex Elder { 1618650d1603SAlex Elder u32 mask = gsi->modem_channel_bitmap; 1619650d1603SAlex Elder u32 channel_id; 1620650d1603SAlex Elder 1621650d1603SAlex Elder mutex_lock(&gsi->mutex); 1622650d1603SAlex Elder 1623650d1603SAlex Elder while (mask) { 1624650d1603SAlex Elder u32 channel_id = __fls(mask); 1625650d1603SAlex Elder 1626650d1603SAlex Elder mask ^= BIT(channel_id); 1627650d1603SAlex Elder 1628650d1603SAlex Elder gsi_modem_channel_halt(gsi, channel_id); 1629650d1603SAlex Elder } 1630650d1603SAlex Elder 1631650d1603SAlex Elder channel_id = gsi->channel_count - 1; 1632650d1603SAlex Elder do 1633650d1603SAlex Elder gsi_channel_teardown_one(gsi, channel_id); 1634650d1603SAlex Elder while (channel_id--); 1635650d1603SAlex Elder 1636650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1637650d1603SAlex Elder 1638650d1603SAlex Elder gsi_irq_disable(gsi); 1639650d1603SAlex Elder gsi_evt_ring_teardown(gsi); 1640650d1603SAlex Elder } 1641650d1603SAlex Elder 1642650d1603SAlex Elder /* Setup function for GSI. GSI firmware must be loaded and initialized */ 1643f86a1909SAlex Elder int gsi_setup(struct gsi *gsi, bool legacy) 1644650d1603SAlex Elder { 1645650d1603SAlex Elder u32 val; 1646650d1603SAlex Elder 1647650d1603SAlex Elder /* Here is where we first touch the GSI hardware */ 1648650d1603SAlex Elder val = ioread32(gsi->virt + GSI_GSI_STATUS_OFFSET); 1649650d1603SAlex Elder if (!(val & ENABLED_FMASK)) { 1650650d1603SAlex Elder dev_err(gsi->dev, "GSI has not been enabled\n"); 1651650d1603SAlex Elder return -EIO; 1652650d1603SAlex Elder } 1653650d1603SAlex Elder 1654650d1603SAlex Elder val = ioread32(gsi->virt + GSI_GSI_HW_PARAM_2_OFFSET); 1655650d1603SAlex Elder 1656650d1603SAlex Elder gsi->channel_count = u32_get_bits(val, NUM_CH_PER_EE_FMASK); 1657650d1603SAlex Elder if (!gsi->channel_count) { 1658650d1603SAlex Elder dev_err(gsi->dev, "GSI reports zero channels supported\n"); 1659650d1603SAlex Elder return -EINVAL; 1660650d1603SAlex Elder } 1661650d1603SAlex Elder if (gsi->channel_count > GSI_CHANNEL_COUNT_MAX) { 1662650d1603SAlex Elder dev_warn(gsi->dev, 1663650d1603SAlex Elder "limiting to %u channels (hardware supports %u)\n", 1664650d1603SAlex Elder GSI_CHANNEL_COUNT_MAX, gsi->channel_count); 1665650d1603SAlex Elder gsi->channel_count = GSI_CHANNEL_COUNT_MAX; 1666650d1603SAlex Elder } 1667650d1603SAlex Elder 1668650d1603SAlex Elder gsi->evt_ring_count = u32_get_bits(val, NUM_EV_PER_EE_FMASK); 1669650d1603SAlex Elder if (!gsi->evt_ring_count) { 1670650d1603SAlex Elder dev_err(gsi->dev, "GSI reports zero event rings supported\n"); 1671650d1603SAlex Elder return -EINVAL; 1672650d1603SAlex Elder } 1673650d1603SAlex Elder if (gsi->evt_ring_count > GSI_EVT_RING_COUNT_MAX) { 1674650d1603SAlex Elder dev_warn(gsi->dev, 1675650d1603SAlex Elder "limiting to %u event rings (hardware supports %u)\n", 1676650d1603SAlex Elder GSI_EVT_RING_COUNT_MAX, gsi->evt_ring_count); 1677650d1603SAlex Elder gsi->evt_ring_count = GSI_EVT_RING_COUNT_MAX; 1678650d1603SAlex Elder } 1679650d1603SAlex Elder 1680650d1603SAlex Elder /* Initialize the error log */ 1681650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_ERROR_LOG_OFFSET); 1682650d1603SAlex Elder 1683650d1603SAlex Elder /* Writing 1 indicates IRQ interrupts; 0 would be MSI */ 1684650d1603SAlex Elder iowrite32(1, gsi->virt + GSI_CNTXT_INTSET_OFFSET); 1685650d1603SAlex Elder 1686f86a1909SAlex Elder return gsi_channel_setup(gsi, legacy); 1687650d1603SAlex Elder } 1688650d1603SAlex Elder 1689650d1603SAlex Elder /* Inverse of gsi_setup() */ 1690650d1603SAlex Elder void gsi_teardown(struct gsi *gsi) 1691650d1603SAlex Elder { 1692650d1603SAlex Elder gsi_channel_teardown(gsi); 1693650d1603SAlex Elder } 1694650d1603SAlex Elder 1695650d1603SAlex Elder /* Initialize a channel's event ring */ 1696650d1603SAlex Elder static int gsi_channel_evt_ring_init(struct gsi_channel *channel) 1697650d1603SAlex Elder { 1698650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1699650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1700650d1603SAlex Elder int ret; 1701650d1603SAlex Elder 1702650d1603SAlex Elder ret = gsi_evt_ring_id_alloc(gsi); 1703650d1603SAlex Elder if (ret < 0) 1704650d1603SAlex Elder return ret; 1705650d1603SAlex Elder channel->evt_ring_id = ret; 1706650d1603SAlex Elder 1707650d1603SAlex Elder evt_ring = &gsi->evt_ring[channel->evt_ring_id]; 1708650d1603SAlex Elder evt_ring->channel = channel; 1709650d1603SAlex Elder 1710650d1603SAlex Elder ret = gsi_ring_alloc(gsi, &evt_ring->ring, channel->event_count); 1711650d1603SAlex Elder if (!ret) 1712650d1603SAlex Elder return 0; /* Success! */ 1713650d1603SAlex Elder 1714650d1603SAlex Elder dev_err(gsi->dev, "error %d allocating channel %u event ring\n", 1715650d1603SAlex Elder ret, gsi_channel_id(channel)); 1716650d1603SAlex Elder 1717650d1603SAlex Elder gsi_evt_ring_id_free(gsi, channel->evt_ring_id); 1718650d1603SAlex Elder 1719650d1603SAlex Elder return ret; 1720650d1603SAlex Elder } 1721650d1603SAlex Elder 1722650d1603SAlex Elder /* Inverse of gsi_channel_evt_ring_init() */ 1723650d1603SAlex Elder static void gsi_channel_evt_ring_exit(struct gsi_channel *channel) 1724650d1603SAlex Elder { 1725650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1726650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1727650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1728650d1603SAlex Elder 1729650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 1730650d1603SAlex Elder gsi_ring_free(gsi, &evt_ring->ring); 1731650d1603SAlex Elder gsi_evt_ring_id_free(gsi, evt_ring_id); 1732650d1603SAlex Elder } 1733650d1603SAlex Elder 1734650d1603SAlex Elder /* Init function for event rings */ 1735650d1603SAlex Elder static void gsi_evt_ring_init(struct gsi *gsi) 1736650d1603SAlex Elder { 1737650d1603SAlex Elder u32 evt_ring_id = 0; 1738650d1603SAlex Elder 1739650d1603SAlex Elder gsi->event_bitmap = gsi_event_bitmap_init(GSI_EVT_RING_COUNT_MAX); 1740650d1603SAlex Elder gsi->event_enable_bitmap = 0; 1741650d1603SAlex Elder do 1742650d1603SAlex Elder init_completion(&gsi->evt_ring[evt_ring_id].completion); 1743650d1603SAlex Elder while (++evt_ring_id < GSI_EVT_RING_COUNT_MAX); 1744650d1603SAlex Elder } 1745650d1603SAlex Elder 1746650d1603SAlex Elder /* Inverse of gsi_evt_ring_init() */ 1747650d1603SAlex Elder static void gsi_evt_ring_exit(struct gsi *gsi) 1748650d1603SAlex Elder { 1749650d1603SAlex Elder /* Nothing to do */ 1750650d1603SAlex Elder } 1751650d1603SAlex Elder 1752650d1603SAlex Elder static bool gsi_channel_data_valid(struct gsi *gsi, 1753650d1603SAlex Elder const struct ipa_gsi_endpoint_data *data) 1754650d1603SAlex Elder { 1755650d1603SAlex Elder #ifdef IPA_VALIDATION 1756650d1603SAlex Elder u32 channel_id = data->channel_id; 1757650d1603SAlex Elder struct device *dev = gsi->dev; 1758650d1603SAlex Elder 1759650d1603SAlex Elder /* Make sure channel ids are in the range driver supports */ 1760650d1603SAlex Elder if (channel_id >= GSI_CHANNEL_COUNT_MAX) { 1761650d1603SAlex Elder dev_err(dev, "bad channel id %u (must be less than %u)\n", 1762650d1603SAlex Elder channel_id, GSI_CHANNEL_COUNT_MAX); 1763650d1603SAlex Elder return false; 1764650d1603SAlex Elder } 1765650d1603SAlex Elder 1766650d1603SAlex Elder if (data->ee_id != GSI_EE_AP && data->ee_id != GSI_EE_MODEM) { 1767650d1603SAlex Elder dev_err(dev, "bad EE id %u (AP or modem)\n", data->ee_id); 1768650d1603SAlex Elder return false; 1769650d1603SAlex Elder } 1770650d1603SAlex Elder 1771650d1603SAlex Elder if (!data->channel.tlv_count || 1772650d1603SAlex Elder data->channel.tlv_count > GSI_TLV_MAX) { 1773650d1603SAlex Elder dev_err(dev, "channel %u bad tlv_count %u (must be 1..%u)\n", 1774650d1603SAlex Elder channel_id, data->channel.tlv_count, GSI_TLV_MAX); 1775650d1603SAlex Elder return false; 1776650d1603SAlex Elder } 1777650d1603SAlex Elder 1778650d1603SAlex Elder /* We have to allow at least one maximally-sized transaction to 1779650d1603SAlex Elder * be outstanding (which would use tlv_count TREs). Given how 1780650d1603SAlex Elder * gsi_channel_tre_max() is computed, tre_count has to be almost 1781650d1603SAlex Elder * twice the TLV FIFO size to satisfy this requirement. 1782650d1603SAlex Elder */ 1783650d1603SAlex Elder if (data->channel.tre_count < 2 * data->channel.tlv_count - 1) { 1784650d1603SAlex Elder dev_err(dev, "channel %u TLV count %u exceeds TRE count %u\n", 1785650d1603SAlex Elder channel_id, data->channel.tlv_count, 1786650d1603SAlex Elder data->channel.tre_count); 1787650d1603SAlex Elder return false; 1788650d1603SAlex Elder } 1789650d1603SAlex Elder 1790650d1603SAlex Elder if (!is_power_of_2(data->channel.tre_count)) { 1791650d1603SAlex Elder dev_err(dev, "channel %u bad tre_count %u (not power of 2)\n", 1792650d1603SAlex Elder channel_id, data->channel.tre_count); 1793650d1603SAlex Elder return false; 1794650d1603SAlex Elder } 1795650d1603SAlex Elder 1796650d1603SAlex Elder if (!is_power_of_2(data->channel.event_count)) { 1797650d1603SAlex Elder dev_err(dev, "channel %u bad event_count %u (not power of 2)\n", 1798650d1603SAlex Elder channel_id, data->channel.event_count); 1799650d1603SAlex Elder return false; 1800650d1603SAlex Elder } 1801650d1603SAlex Elder #endif /* IPA_VALIDATION */ 1802650d1603SAlex Elder 1803650d1603SAlex Elder return true; 1804650d1603SAlex Elder } 1805650d1603SAlex Elder 1806650d1603SAlex Elder /* Init function for a single channel */ 1807650d1603SAlex Elder static int gsi_channel_init_one(struct gsi *gsi, 1808650d1603SAlex Elder const struct ipa_gsi_endpoint_data *data, 1809650d1603SAlex Elder bool command, bool prefetch) 1810650d1603SAlex Elder { 1811650d1603SAlex Elder struct gsi_channel *channel; 1812650d1603SAlex Elder u32 tre_count; 1813650d1603SAlex Elder int ret; 1814650d1603SAlex Elder 1815650d1603SAlex Elder if (!gsi_channel_data_valid(gsi, data)) 1816650d1603SAlex Elder return -EINVAL; 1817650d1603SAlex Elder 1818650d1603SAlex Elder /* Worst case we need an event for every outstanding TRE */ 1819650d1603SAlex Elder if (data->channel.tre_count > data->channel.event_count) { 1820650d1603SAlex Elder tre_count = data->channel.event_count; 18210721999fSAlex Elder dev_warn(gsi->dev, "channel %u limited to %u TREs\n", 18220721999fSAlex Elder data->channel_id, tre_count); 1823650d1603SAlex Elder } else { 1824650d1603SAlex Elder tre_count = data->channel.tre_count; 1825650d1603SAlex Elder } 1826650d1603SAlex Elder 1827650d1603SAlex Elder channel = &gsi->channel[data->channel_id]; 1828650d1603SAlex Elder memset(channel, 0, sizeof(*channel)); 1829650d1603SAlex Elder 1830650d1603SAlex Elder channel->gsi = gsi; 1831650d1603SAlex Elder channel->toward_ipa = data->toward_ipa; 1832650d1603SAlex Elder channel->command = command; 1833650d1603SAlex Elder channel->use_prefetch = command && prefetch; 1834650d1603SAlex Elder channel->tlv_count = data->channel.tlv_count; 1835650d1603SAlex Elder channel->tre_count = tre_count; 1836650d1603SAlex Elder channel->event_count = data->channel.event_count; 1837650d1603SAlex Elder init_completion(&channel->completion); 1838650d1603SAlex Elder 1839650d1603SAlex Elder ret = gsi_channel_evt_ring_init(channel); 1840650d1603SAlex Elder if (ret) 1841650d1603SAlex Elder goto err_clear_gsi; 1842650d1603SAlex Elder 1843650d1603SAlex Elder ret = gsi_ring_alloc(gsi, &channel->tre_ring, data->channel.tre_count); 1844650d1603SAlex Elder if (ret) { 1845650d1603SAlex Elder dev_err(gsi->dev, "error %d allocating channel %u ring\n", 1846650d1603SAlex Elder ret, data->channel_id); 1847650d1603SAlex Elder goto err_channel_evt_ring_exit; 1848650d1603SAlex Elder } 1849650d1603SAlex Elder 1850650d1603SAlex Elder ret = gsi_channel_trans_init(gsi, data->channel_id); 1851650d1603SAlex Elder if (ret) 1852650d1603SAlex Elder goto err_ring_free; 1853650d1603SAlex Elder 1854650d1603SAlex Elder if (command) { 1855650d1603SAlex Elder u32 tre_max = gsi_channel_tre_max(gsi, data->channel_id); 1856650d1603SAlex Elder 1857650d1603SAlex Elder ret = ipa_cmd_pool_init(channel, tre_max); 1858650d1603SAlex Elder } 1859650d1603SAlex Elder if (!ret) 1860650d1603SAlex Elder return 0; /* Success! */ 1861650d1603SAlex Elder 1862650d1603SAlex Elder gsi_channel_trans_exit(channel); 1863650d1603SAlex Elder err_ring_free: 1864650d1603SAlex Elder gsi_ring_free(gsi, &channel->tre_ring); 1865650d1603SAlex Elder err_channel_evt_ring_exit: 1866650d1603SAlex Elder gsi_channel_evt_ring_exit(channel); 1867650d1603SAlex Elder err_clear_gsi: 1868650d1603SAlex Elder channel->gsi = NULL; /* Mark it not (fully) initialized */ 1869650d1603SAlex Elder 1870650d1603SAlex Elder return ret; 1871650d1603SAlex Elder } 1872650d1603SAlex Elder 1873650d1603SAlex Elder /* Inverse of gsi_channel_init_one() */ 1874650d1603SAlex Elder static void gsi_channel_exit_one(struct gsi_channel *channel) 1875650d1603SAlex Elder { 1876650d1603SAlex Elder if (!channel->gsi) 1877650d1603SAlex Elder return; /* Ignore uninitialized channels */ 1878650d1603SAlex Elder 1879650d1603SAlex Elder if (channel->command) 1880650d1603SAlex Elder ipa_cmd_pool_exit(channel); 1881650d1603SAlex Elder gsi_channel_trans_exit(channel); 1882650d1603SAlex Elder gsi_ring_free(channel->gsi, &channel->tre_ring); 1883650d1603SAlex Elder gsi_channel_evt_ring_exit(channel); 1884650d1603SAlex Elder } 1885650d1603SAlex Elder 1886650d1603SAlex Elder /* Init function for channels */ 1887650d1603SAlex Elder static int gsi_channel_init(struct gsi *gsi, bool prefetch, u32 count, 1888650d1603SAlex Elder const struct ipa_gsi_endpoint_data *data, 1889650d1603SAlex Elder bool modem_alloc) 1890650d1603SAlex Elder { 1891650d1603SAlex Elder int ret = 0; 1892650d1603SAlex Elder u32 i; 1893650d1603SAlex Elder 1894650d1603SAlex Elder gsi_evt_ring_init(gsi); 1895650d1603SAlex Elder 1896650d1603SAlex Elder /* The endpoint data array is indexed by endpoint name */ 1897650d1603SAlex Elder for (i = 0; i < count; i++) { 1898650d1603SAlex Elder bool command = i == IPA_ENDPOINT_AP_COMMAND_TX; 1899650d1603SAlex Elder 1900650d1603SAlex Elder if (ipa_gsi_endpoint_data_empty(&data[i])) 1901650d1603SAlex Elder continue; /* Skip over empty slots */ 1902650d1603SAlex Elder 1903650d1603SAlex Elder /* Mark modem channels to be allocated (hardware workaround) */ 1904650d1603SAlex Elder if (data[i].ee_id == GSI_EE_MODEM) { 1905650d1603SAlex Elder if (modem_alloc) 1906650d1603SAlex Elder gsi->modem_channel_bitmap |= 1907650d1603SAlex Elder BIT(data[i].channel_id); 1908650d1603SAlex Elder continue; 1909650d1603SAlex Elder } 1910650d1603SAlex Elder 1911650d1603SAlex Elder ret = gsi_channel_init_one(gsi, &data[i], command, prefetch); 1912650d1603SAlex Elder if (ret) 1913650d1603SAlex Elder goto err_unwind; 1914650d1603SAlex Elder } 1915650d1603SAlex Elder 1916650d1603SAlex Elder return ret; 1917650d1603SAlex Elder 1918650d1603SAlex Elder err_unwind: 1919650d1603SAlex Elder while (i--) { 1920650d1603SAlex Elder if (ipa_gsi_endpoint_data_empty(&data[i])) 1921650d1603SAlex Elder continue; 1922650d1603SAlex Elder if (modem_alloc && data[i].ee_id == GSI_EE_MODEM) { 1923650d1603SAlex Elder gsi->modem_channel_bitmap &= ~BIT(data[i].channel_id); 1924650d1603SAlex Elder continue; 1925650d1603SAlex Elder } 1926650d1603SAlex Elder gsi_channel_exit_one(&gsi->channel[data->channel_id]); 1927650d1603SAlex Elder } 1928650d1603SAlex Elder gsi_evt_ring_exit(gsi); 1929650d1603SAlex Elder 1930650d1603SAlex Elder return ret; 1931650d1603SAlex Elder } 1932650d1603SAlex Elder 1933650d1603SAlex Elder /* Inverse of gsi_channel_init() */ 1934650d1603SAlex Elder static void gsi_channel_exit(struct gsi *gsi) 1935650d1603SAlex Elder { 1936650d1603SAlex Elder u32 channel_id = GSI_CHANNEL_COUNT_MAX - 1; 1937650d1603SAlex Elder 1938650d1603SAlex Elder do 1939650d1603SAlex Elder gsi_channel_exit_one(&gsi->channel[channel_id]); 1940650d1603SAlex Elder while (channel_id--); 1941650d1603SAlex Elder gsi->modem_channel_bitmap = 0; 1942650d1603SAlex Elder 1943650d1603SAlex Elder gsi_evt_ring_exit(gsi); 1944650d1603SAlex Elder } 1945650d1603SAlex Elder 1946650d1603SAlex Elder /* Init function for GSI. GSI hardware does not need to be "ready" */ 1947650d1603SAlex Elder int gsi_init(struct gsi *gsi, struct platform_device *pdev, bool prefetch, 1948650d1603SAlex Elder u32 count, const struct ipa_gsi_endpoint_data *data, 1949650d1603SAlex Elder bool modem_alloc) 1950650d1603SAlex Elder { 1951650d1603SAlex Elder struct resource *res; 1952650d1603SAlex Elder resource_size_t size; 1953650d1603SAlex Elder unsigned int irq; 1954650d1603SAlex Elder int ret; 1955650d1603SAlex Elder 1956650d1603SAlex Elder gsi_validate_build(); 1957650d1603SAlex Elder 1958650d1603SAlex Elder gsi->dev = &pdev->dev; 1959650d1603SAlex Elder 1960650d1603SAlex Elder /* The GSI layer performs NAPI on all endpoints. NAPI requires a 1961650d1603SAlex Elder * network device structure, but the GSI layer does not have one, 1962650d1603SAlex Elder * so we must create a dummy network device for this purpose. 1963650d1603SAlex Elder */ 1964650d1603SAlex Elder init_dummy_netdev(&gsi->dummy_dev); 1965650d1603SAlex Elder 1966650d1603SAlex Elder /* Get the GSI IRQ and request for it to wake the system */ 1967650d1603SAlex Elder ret = platform_get_irq_byname(pdev, "gsi"); 1968650d1603SAlex Elder if (ret <= 0) { 1969650d1603SAlex Elder dev_err(gsi->dev, 1970650d1603SAlex Elder "DT error %d getting \"gsi\" IRQ property\n", ret); 1971650d1603SAlex Elder return ret ? : -EINVAL; 1972650d1603SAlex Elder } 1973650d1603SAlex Elder irq = ret; 1974650d1603SAlex Elder 1975650d1603SAlex Elder ret = request_irq(irq, gsi_isr, 0, "gsi", gsi); 1976650d1603SAlex Elder if (ret) { 1977650d1603SAlex Elder dev_err(gsi->dev, "error %d requesting \"gsi\" IRQ\n", ret); 1978650d1603SAlex Elder return ret; 1979650d1603SAlex Elder } 1980650d1603SAlex Elder gsi->irq = irq; 1981650d1603SAlex Elder 1982650d1603SAlex Elder ret = enable_irq_wake(gsi->irq); 1983650d1603SAlex Elder if (ret) 1984650d1603SAlex Elder dev_warn(gsi->dev, "error %d enabling gsi wake irq\n", ret); 1985650d1603SAlex Elder gsi->irq_wake_enabled = !ret; 1986650d1603SAlex Elder 1987650d1603SAlex Elder /* Get GSI memory range and map it */ 1988650d1603SAlex Elder res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "gsi"); 1989650d1603SAlex Elder if (!res) { 1990650d1603SAlex Elder dev_err(gsi->dev, 1991650d1603SAlex Elder "DT error getting \"gsi\" memory property\n"); 1992650d1603SAlex Elder ret = -ENODEV; 1993650d1603SAlex Elder goto err_disable_irq_wake; 1994650d1603SAlex Elder } 1995650d1603SAlex Elder 1996650d1603SAlex Elder size = resource_size(res); 1997650d1603SAlex Elder if (res->start > U32_MAX || size > U32_MAX - res->start) { 1998650d1603SAlex Elder dev_err(gsi->dev, "DT memory resource \"gsi\" out of range\n"); 1999650d1603SAlex Elder ret = -EINVAL; 2000650d1603SAlex Elder goto err_disable_irq_wake; 2001650d1603SAlex Elder } 2002650d1603SAlex Elder 2003650d1603SAlex Elder gsi->virt = ioremap(res->start, size); 2004650d1603SAlex Elder if (!gsi->virt) { 2005650d1603SAlex Elder dev_err(gsi->dev, "unable to remap \"gsi\" memory\n"); 2006650d1603SAlex Elder ret = -ENOMEM; 2007650d1603SAlex Elder goto err_disable_irq_wake; 2008650d1603SAlex Elder } 2009650d1603SAlex Elder 2010650d1603SAlex Elder ret = gsi_channel_init(gsi, prefetch, count, data, modem_alloc); 2011650d1603SAlex Elder if (ret) 2012650d1603SAlex Elder goto err_iounmap; 2013650d1603SAlex Elder 2014650d1603SAlex Elder mutex_init(&gsi->mutex); 2015650d1603SAlex Elder init_completion(&gsi->completion); 2016650d1603SAlex Elder 2017650d1603SAlex Elder return 0; 2018650d1603SAlex Elder 2019650d1603SAlex Elder err_iounmap: 2020650d1603SAlex Elder iounmap(gsi->virt); 2021650d1603SAlex Elder err_disable_irq_wake: 2022650d1603SAlex Elder if (gsi->irq_wake_enabled) 2023650d1603SAlex Elder (void)disable_irq_wake(gsi->irq); 2024650d1603SAlex Elder free_irq(gsi->irq, gsi); 2025650d1603SAlex Elder 2026650d1603SAlex Elder return ret; 2027650d1603SAlex Elder } 2028650d1603SAlex Elder 2029650d1603SAlex Elder /* Inverse of gsi_init() */ 2030650d1603SAlex Elder void gsi_exit(struct gsi *gsi) 2031650d1603SAlex Elder { 2032650d1603SAlex Elder mutex_destroy(&gsi->mutex); 2033650d1603SAlex Elder gsi_channel_exit(gsi); 2034650d1603SAlex Elder if (gsi->irq_wake_enabled) 2035650d1603SAlex Elder (void)disable_irq_wake(gsi->irq); 2036650d1603SAlex Elder free_irq(gsi->irq, gsi); 2037650d1603SAlex Elder iounmap(gsi->virt); 2038650d1603SAlex Elder } 2039650d1603SAlex Elder 2040650d1603SAlex Elder /* The maximum number of outstanding TREs on a channel. This limits 2041650d1603SAlex Elder * a channel's maximum number of transactions outstanding (worst case 2042650d1603SAlex Elder * is one TRE per transaction). 2043650d1603SAlex Elder * 2044650d1603SAlex Elder * The absolute limit is the number of TREs in the channel's TRE ring, 2045650d1603SAlex Elder * and in theory we should be able use all of them. But in practice, 2046650d1603SAlex Elder * doing that led to the hardware reporting exhaustion of event ring 2047650d1603SAlex Elder * slots for writing completion information. So the hardware limit 2048650d1603SAlex Elder * would be (tre_count - 1). 2049650d1603SAlex Elder * 2050650d1603SAlex Elder * We reduce it a bit further though. Transaction resource pools are 2051650d1603SAlex Elder * sized to be a little larger than this maximum, to allow resource 2052650d1603SAlex Elder * allocations to always be contiguous. The number of entries in a 2053650d1603SAlex Elder * TRE ring buffer is a power of 2, and the extra resources in a pool 2054650d1603SAlex Elder * tends to nearly double the memory allocated for it. Reducing the 2055650d1603SAlex Elder * maximum number of outstanding TREs allows the number of entries in 2056650d1603SAlex Elder * a pool to avoid crossing that power-of-2 boundary, and this can 2057650d1603SAlex Elder * substantially reduce pool memory requirements. The number we 2058650d1603SAlex Elder * reduce it by matches the number added in gsi_trans_pool_init(). 2059650d1603SAlex Elder */ 2060650d1603SAlex Elder u32 gsi_channel_tre_max(struct gsi *gsi, u32 channel_id) 2061650d1603SAlex Elder { 2062650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 2063650d1603SAlex Elder 2064650d1603SAlex Elder /* Hardware limit is channel->tre_count - 1 */ 2065650d1603SAlex Elder return channel->tre_count - (channel->tlv_count - 1); 2066650d1603SAlex Elder } 2067650d1603SAlex Elder 2068650d1603SAlex Elder /* Returns the maximum number of TREs in a single transaction for a channel */ 2069650d1603SAlex Elder u32 gsi_channel_trans_tre_max(struct gsi *gsi, u32 channel_id) 2070650d1603SAlex Elder { 2071650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 2072650d1603SAlex Elder 2073650d1603SAlex Elder return channel->tlv_count; 2074650d1603SAlex Elder } 2075