1650d1603SAlex Elder // SPDX-License-Identifier: GPL-2.0 2650d1603SAlex Elder 3650d1603SAlex Elder /* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved. 4571b1e7eSAlex Elder * Copyright (C) 2018-2021 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" 241d0c09deSAlex Elder #include "ipa_version.h" 25650d1603SAlex Elder 26650d1603SAlex Elder /** 27650d1603SAlex Elder * DOC: The IPA Generic Software Interface 28650d1603SAlex Elder * 29650d1603SAlex Elder * The generic software interface (GSI) is an integral component of the IPA, 30650d1603SAlex Elder * providing a well-defined communication layer between the AP subsystem 31650d1603SAlex Elder * and the IPA core. The modem uses the GSI layer as well. 32650d1603SAlex Elder * 33650d1603SAlex Elder * -------- --------- 34650d1603SAlex Elder * | | | | 35650d1603SAlex Elder * | AP +<---. .----+ Modem | 36650d1603SAlex Elder * | +--. | | .->+ | 37650d1603SAlex Elder * | | | | | | | | 38650d1603SAlex Elder * -------- | | | | --------- 39650d1603SAlex Elder * v | v | 40650d1603SAlex Elder * --+-+---+-+-- 41650d1603SAlex Elder * | GSI | 42650d1603SAlex Elder * |-----------| 43650d1603SAlex Elder * | | 44650d1603SAlex Elder * | IPA | 45650d1603SAlex Elder * | | 46650d1603SAlex Elder * ------------- 47650d1603SAlex Elder * 48650d1603SAlex Elder * In the above diagram, the AP and Modem represent "execution environments" 49650d1603SAlex Elder * (EEs), which are independent operating environments that use the IPA for 50650d1603SAlex Elder * data transfer. 51650d1603SAlex Elder * 52650d1603SAlex Elder * Each EE uses a set of unidirectional GSI "channels," which allow transfer 53650d1603SAlex Elder * of data to or from the IPA. A channel is implemented as a ring buffer, 54650d1603SAlex Elder * with a DRAM-resident array of "transfer elements" (TREs) available to 55650d1603SAlex Elder * describe transfers to or from other EEs through the IPA. A transfer 56650d1603SAlex Elder * element can also contain an immediate command, requesting the IPA perform 57650d1603SAlex Elder * actions other than data transfer. 58650d1603SAlex Elder * 59650d1603SAlex Elder * Each TRE refers to a block of data--also located DRAM. After writing one 60650d1603SAlex Elder * or more TREs to a channel, the writer (either the IPA or an EE) writes a 61650d1603SAlex Elder * doorbell register to inform the receiving side how many elements have 62650d1603SAlex Elder * been written. 63650d1603SAlex Elder * 64650d1603SAlex Elder * Each channel has a GSI "event ring" associated with it. An event ring 65650d1603SAlex Elder * is implemented very much like a channel ring, but is always directed from 66650d1603SAlex Elder * the IPA to an EE. The IPA notifies an EE (such as the AP) about channel 67650d1603SAlex Elder * events by adding an entry to the event ring associated with the channel. 68650d1603SAlex Elder * The GSI then writes its doorbell for the event ring, causing the target 69650d1603SAlex Elder * EE to be interrupted. Each entry in an event ring contains a pointer 70650d1603SAlex Elder * to the channel TRE whose completion the event represents. 71650d1603SAlex Elder * 72650d1603SAlex Elder * Each TRE in a channel ring has a set of flags. One flag indicates whether 73650d1603SAlex Elder * the completion of the transfer operation generates an entry (and possibly 74650d1603SAlex Elder * an interrupt) in the channel's event ring. Other flags allow transfer 75650d1603SAlex Elder * elements to be chained together, forming a single logical transaction. 76650d1603SAlex Elder * TRE flags are used to control whether and when interrupts are generated 77650d1603SAlex Elder * to signal completion of channel transfers. 78650d1603SAlex Elder * 79650d1603SAlex Elder * Elements in channel and event rings are completed (or consumed) strictly 80650d1603SAlex Elder * in order. Completion of one entry implies the completion of all preceding 81650d1603SAlex Elder * entries. A single completion interrupt can therefore communicate the 82650d1603SAlex Elder * completion of many transfers. 83650d1603SAlex Elder * 84650d1603SAlex Elder * Note that all GSI registers are little-endian, which is the assumed 85650d1603SAlex Elder * endianness of I/O space accesses. The accessor functions perform byte 86650d1603SAlex Elder * swapping if needed (i.e., for a big endian CPU). 87650d1603SAlex Elder */ 88650d1603SAlex Elder 89650d1603SAlex Elder /* Delay period for interrupt moderation (in 32KHz IPA internal timer ticks) */ 90650d1603SAlex Elder #define GSI_EVT_RING_INT_MODT (32 * 1) /* 1ms under 32KHz clock */ 91650d1603SAlex Elder 9259b5f454SAlex Elder #define GSI_CMD_TIMEOUT 50 /* milliseconds */ 93650d1603SAlex Elder 94057ef63fSAlex Elder #define GSI_CHANNEL_STOP_RETRIES 10 9511361456SAlex Elder #define GSI_CHANNEL_MODEM_HALT_RETRIES 10 96650d1603SAlex Elder 97650d1603SAlex Elder #define GSI_MHI_EVENT_ID_START 10 /* 1st reserved event id */ 98650d1603SAlex Elder #define GSI_MHI_EVENT_ID_END 16 /* Last reserved event id */ 99650d1603SAlex Elder 100650d1603SAlex Elder #define GSI_ISR_MAX_ITER 50 /* Detect interrupt storms */ 101650d1603SAlex Elder 102650d1603SAlex Elder /* An entry in an event ring */ 103650d1603SAlex Elder struct gsi_event { 104650d1603SAlex Elder __le64 xfer_ptr; 105650d1603SAlex Elder __le16 len; 106650d1603SAlex Elder u8 reserved1; 107650d1603SAlex Elder u8 code; 108650d1603SAlex Elder __le16 reserved2; 109650d1603SAlex Elder u8 type; 110650d1603SAlex Elder u8 chid; 111650d1603SAlex Elder }; 112650d1603SAlex Elder 113650d1603SAlex Elder /** gsi_channel_scratch_gpi - GPI protocol scratch register 114650d1603SAlex Elder * @max_outstanding_tre: 115650d1603SAlex Elder * Defines the maximum number of TREs allowed in a single transaction 116650d1603SAlex Elder * on a channel (in bytes). This determines the amount of prefetch 117650d1603SAlex Elder * performed by the hardware. We configure this to equal the size of 118650d1603SAlex Elder * the TLV FIFO for the channel. 119650d1603SAlex Elder * @outstanding_threshold: 120650d1603SAlex Elder * Defines the threshold (in bytes) determining when the sequencer 121650d1603SAlex Elder * should update the channel doorbell. We configure this to equal 122650d1603SAlex Elder * the size of two TREs. 123650d1603SAlex Elder */ 124650d1603SAlex Elder struct gsi_channel_scratch_gpi { 125650d1603SAlex Elder u64 reserved1; 126650d1603SAlex Elder u16 reserved2; 127650d1603SAlex Elder u16 max_outstanding_tre; 128650d1603SAlex Elder u16 reserved3; 129650d1603SAlex Elder u16 outstanding_threshold; 130650d1603SAlex Elder }; 131650d1603SAlex Elder 132650d1603SAlex Elder /** gsi_channel_scratch - channel scratch configuration area 133650d1603SAlex Elder * 134650d1603SAlex Elder * The exact interpretation of this register is protocol-specific. 135650d1603SAlex Elder * We only use GPI channels; see struct gsi_channel_scratch_gpi, above. 136650d1603SAlex Elder */ 137650d1603SAlex Elder union gsi_channel_scratch { 138650d1603SAlex Elder struct gsi_channel_scratch_gpi gpi; 139650d1603SAlex Elder struct { 140650d1603SAlex Elder u32 word1; 141650d1603SAlex Elder u32 word2; 142650d1603SAlex Elder u32 word3; 143650d1603SAlex Elder u32 word4; 144650d1603SAlex Elder } data; 145650d1603SAlex Elder }; 146650d1603SAlex Elder 147650d1603SAlex Elder /* Check things that can be validated at build time. */ 148650d1603SAlex Elder static void gsi_validate_build(void) 149650d1603SAlex Elder { 150650d1603SAlex Elder /* This is used as a divisor */ 151650d1603SAlex Elder BUILD_BUG_ON(!GSI_RING_ELEMENT_SIZE); 152650d1603SAlex Elder 153650d1603SAlex Elder /* Code assumes the size of channel and event ring element are 154650d1603SAlex Elder * the same (and fixed). Make sure the size of an event ring 155650d1603SAlex Elder * element is what's expected. 156650d1603SAlex Elder */ 157650d1603SAlex Elder BUILD_BUG_ON(sizeof(struct gsi_event) != GSI_RING_ELEMENT_SIZE); 158650d1603SAlex Elder 159650d1603SAlex Elder /* Hardware requires a 2^n ring size. We ensure the number of 160650d1603SAlex Elder * elements in an event ring is a power of 2 elsewhere; this 161650d1603SAlex Elder * ensure the elements themselves meet the requirement. 162650d1603SAlex Elder */ 163650d1603SAlex Elder BUILD_BUG_ON(!is_power_of_2(GSI_RING_ELEMENT_SIZE)); 164650d1603SAlex Elder 165650d1603SAlex Elder /* The channel element size must fit in this field */ 166650d1603SAlex Elder BUILD_BUG_ON(GSI_RING_ELEMENT_SIZE > field_max(ELEMENT_SIZE_FMASK)); 167650d1603SAlex Elder 168650d1603SAlex Elder /* The event ring element size must fit in this field */ 169650d1603SAlex Elder BUILD_BUG_ON(GSI_RING_ELEMENT_SIZE > field_max(EV_ELEMENT_SIZE_FMASK)); 170650d1603SAlex Elder } 171650d1603SAlex Elder 172650d1603SAlex Elder /* Return the channel id associated with a given channel */ 173650d1603SAlex Elder static u32 gsi_channel_id(struct gsi_channel *channel) 174650d1603SAlex Elder { 175650d1603SAlex Elder return channel - &channel->gsi->channel[0]; 176650d1603SAlex Elder } 177650d1603SAlex Elder 1786170b6daSAlex Elder /* An initialized channel has a non-null GSI pointer */ 1796170b6daSAlex Elder static bool gsi_channel_initialized(struct gsi_channel *channel) 1806170b6daSAlex Elder { 1816170b6daSAlex Elder return !!channel->gsi; 1826170b6daSAlex Elder } 1836170b6daSAlex Elder 1843ca97ffdSAlex Elder /* Update the GSI IRQ type register with the cached value */ 1858194be79SAlex Elder static void gsi_irq_type_update(struct gsi *gsi, u32 val) 1863ca97ffdSAlex Elder { 1878194be79SAlex Elder gsi->type_enabled_bitmap = val; 1888194be79SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_TYPE_IRQ_MSK_OFFSET); 1893ca97ffdSAlex Elder } 1903ca97ffdSAlex Elder 191b054d4f9SAlex Elder static void gsi_irq_type_enable(struct gsi *gsi, enum gsi_irq_type_id type_id) 192b054d4f9SAlex Elder { 1938194be79SAlex Elder gsi_irq_type_update(gsi, gsi->type_enabled_bitmap | BIT(type_id)); 194b054d4f9SAlex Elder } 195b054d4f9SAlex Elder 196b054d4f9SAlex Elder static void gsi_irq_type_disable(struct gsi *gsi, enum gsi_irq_type_id type_id) 197b054d4f9SAlex Elder { 1988194be79SAlex Elder gsi_irq_type_update(gsi, gsi->type_enabled_bitmap & ~BIT(type_id)); 199b054d4f9SAlex Elder } 200b054d4f9SAlex Elder 20157ab8ca4SAlex Elder /* Turn off all GSI interrupts initially; there is no gsi_irq_teardown() */ 20297eb94c8SAlex Elder static void gsi_irq_setup(struct gsi *gsi) 20397eb94c8SAlex Elder { 2048194be79SAlex Elder /* Disable all interrupt types */ 2058194be79SAlex Elder gsi_irq_type_update(gsi, 0); 206b054d4f9SAlex Elder 2078194be79SAlex Elder /* Clear all type-specific interrupt masks */ 208b054d4f9SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_MSK_OFFSET); 209b4175f87SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_MSK_OFFSET); 210d6c9e3f5SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 21106c86328SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 212cdeee49fSAlex Elder 213c31d7349SAlex Elder /* The inter-EE interrupts are not supported for IPA v3.0-v3.1 */ 214c31d7349SAlex Elder if (gsi->version > IPA_VERSION_3_1) { 215c31d7349SAlex Elder u32 offset; 216c31d7349SAlex Elder 217c31d7349SAlex Elder /* These registers are in the non-adjusted address range */ 218c31d7349SAlex Elder offset = GSI_INTER_EE_SRC_CH_IRQ_MSK_OFFSET; 219c31d7349SAlex Elder iowrite32(0, gsi->virt_raw + offset); 220c31d7349SAlex Elder offset = GSI_INTER_EE_SRC_EV_CH_IRQ_MSK_OFFSET; 221c31d7349SAlex Elder iowrite32(0, gsi->virt_raw + offset); 222c31d7349SAlex Elder } 223cdeee49fSAlex Elder 224352f26a8SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GSI_IRQ_EN_OFFSET); 22597eb94c8SAlex Elder } 22697eb94c8SAlex Elder 227bae70a80SAlex Elder /* Get # supported channel and event rings; there is no gsi_ring_teardown() */ 228bae70a80SAlex Elder static int gsi_ring_setup(struct gsi *gsi) 229bae70a80SAlex Elder { 230bae70a80SAlex Elder struct device *dev = gsi->dev; 231bae70a80SAlex Elder u32 count; 232bae70a80SAlex Elder u32 val; 233bae70a80SAlex Elder 234bae70a80SAlex Elder if (gsi->version < IPA_VERSION_3_5_1) { 235bae70a80SAlex Elder /* No HW_PARAM_2 register prior to IPA v3.5.1, assume the max */ 236bae70a80SAlex Elder gsi->channel_count = GSI_CHANNEL_COUNT_MAX; 237bae70a80SAlex Elder gsi->evt_ring_count = GSI_EVT_RING_COUNT_MAX; 238bae70a80SAlex Elder 239bae70a80SAlex Elder return 0; 240bae70a80SAlex Elder } 241bae70a80SAlex Elder 242bae70a80SAlex Elder val = ioread32(gsi->virt + GSI_GSI_HW_PARAM_2_OFFSET); 243bae70a80SAlex Elder 244bae70a80SAlex Elder count = u32_get_bits(val, NUM_CH_PER_EE_FMASK); 245bae70a80SAlex Elder if (!count) { 246bae70a80SAlex Elder dev_err(dev, "GSI reports zero channels supported\n"); 247bae70a80SAlex Elder return -EINVAL; 248bae70a80SAlex Elder } 249bae70a80SAlex Elder if (count > GSI_CHANNEL_COUNT_MAX) { 250bae70a80SAlex Elder dev_warn(dev, "limiting to %u channels; hardware supports %u\n", 251bae70a80SAlex Elder GSI_CHANNEL_COUNT_MAX, count); 252bae70a80SAlex Elder count = GSI_CHANNEL_COUNT_MAX; 253bae70a80SAlex Elder } 254bae70a80SAlex Elder gsi->channel_count = count; 255bae70a80SAlex Elder 256bae70a80SAlex Elder count = u32_get_bits(val, NUM_EV_PER_EE_FMASK); 257bae70a80SAlex Elder if (!count) { 258bae70a80SAlex Elder dev_err(dev, "GSI reports zero event rings supported\n"); 259bae70a80SAlex Elder return -EINVAL; 260bae70a80SAlex Elder } 261bae70a80SAlex Elder if (count > GSI_EVT_RING_COUNT_MAX) { 262bae70a80SAlex Elder dev_warn(dev, 263bae70a80SAlex Elder "limiting to %u event rings; hardware supports %u\n", 264bae70a80SAlex Elder GSI_EVT_RING_COUNT_MAX, count); 265bae70a80SAlex Elder count = GSI_EVT_RING_COUNT_MAX; 266bae70a80SAlex Elder } 267bae70a80SAlex Elder gsi->evt_ring_count = count; 268bae70a80SAlex Elder 269bae70a80SAlex Elder return 0; 270bae70a80SAlex Elder } 271bae70a80SAlex Elder 272a60d0632SAlex Elder /* Event ring commands are performed one at a time. Their completion 273a60d0632SAlex Elder * is signaled by the event ring control GSI interrupt type, which is 274a60d0632SAlex Elder * only enabled when we issue an event ring command. Only the event 275a60d0632SAlex Elder * ring being operated on has this interrupt enabled. 276a60d0632SAlex Elder */ 277a60d0632SAlex Elder static void gsi_irq_ev_ctrl_enable(struct gsi *gsi, u32 evt_ring_id) 278a60d0632SAlex Elder { 279a60d0632SAlex Elder u32 val = BIT(evt_ring_id); 280a60d0632SAlex Elder 281a60d0632SAlex Elder /* There's a small chance that a previous command completed 282a60d0632SAlex Elder * after the interrupt was disabled, so make sure we have no 283a60d0632SAlex Elder * pending interrupts before we enable them. 284a60d0632SAlex Elder */ 285a60d0632SAlex Elder iowrite32(~0, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_CLR_OFFSET); 286a60d0632SAlex Elder 287a60d0632SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_MSK_OFFSET); 288a60d0632SAlex Elder gsi_irq_type_enable(gsi, GSI_EV_CTRL); 289a60d0632SAlex Elder } 290a60d0632SAlex Elder 291a60d0632SAlex Elder /* Disable event ring control interrupts */ 292a60d0632SAlex Elder static void gsi_irq_ev_ctrl_disable(struct gsi *gsi) 293a60d0632SAlex Elder { 294a60d0632SAlex Elder gsi_irq_type_disable(gsi, GSI_EV_CTRL); 295a60d0632SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_MSK_OFFSET); 296a60d0632SAlex Elder } 297a60d0632SAlex Elder 298a60d0632SAlex Elder /* Channel commands are performed one at a time. Their completion is 299a60d0632SAlex Elder * signaled by the channel control GSI interrupt type, which is only 300a60d0632SAlex Elder * enabled when we issue a channel command. Only the channel being 301a60d0632SAlex Elder * operated on has this interrupt enabled. 302a60d0632SAlex Elder */ 303a60d0632SAlex Elder static void gsi_irq_ch_ctrl_enable(struct gsi *gsi, u32 channel_id) 304a60d0632SAlex Elder { 305a60d0632SAlex Elder u32 val = BIT(channel_id); 306a60d0632SAlex Elder 307a60d0632SAlex Elder /* There's a small chance that a previous command completed 308a60d0632SAlex Elder * after the interrupt was disabled, so make sure we have no 309a60d0632SAlex Elder * pending interrupts before we enable them. 310a60d0632SAlex Elder */ 311a60d0632SAlex Elder iowrite32(~0, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_CLR_OFFSET); 312a60d0632SAlex Elder 313a60d0632SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_MSK_OFFSET); 314a60d0632SAlex Elder gsi_irq_type_enable(gsi, GSI_CH_CTRL); 315a60d0632SAlex Elder } 316a60d0632SAlex Elder 317a60d0632SAlex Elder /* Disable channel control interrupts */ 318a60d0632SAlex Elder static void gsi_irq_ch_ctrl_disable(struct gsi *gsi) 319a60d0632SAlex Elder { 320a60d0632SAlex Elder gsi_irq_type_disable(gsi, GSI_CH_CTRL); 321a60d0632SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_MSK_OFFSET); 322a60d0632SAlex Elder } 323a60d0632SAlex Elder 3245725593eSAlex Elder static void gsi_irq_ieob_enable_one(struct gsi *gsi, u32 evt_ring_id) 325650d1603SAlex Elder { 32606c86328SAlex Elder bool enable_ieob = !gsi->ieob_enabled_bitmap; 327650d1603SAlex Elder u32 val; 328650d1603SAlex Elder 329a054539dSAlex Elder gsi->ieob_enabled_bitmap |= BIT(evt_ring_id); 330a054539dSAlex Elder val = gsi->ieob_enabled_bitmap; 331650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 33206c86328SAlex Elder 33306c86328SAlex Elder /* Enable the interrupt type if this is the first channel enabled */ 33406c86328SAlex Elder if (enable_ieob) 33506c86328SAlex Elder gsi_irq_type_enable(gsi, GSI_IEOB); 336650d1603SAlex Elder } 337650d1603SAlex Elder 3385725593eSAlex Elder static void gsi_irq_ieob_disable(struct gsi *gsi, u32 event_mask) 339650d1603SAlex Elder { 340650d1603SAlex Elder u32 val; 341650d1603SAlex Elder 3425725593eSAlex Elder gsi->ieob_enabled_bitmap &= ~event_mask; 34306c86328SAlex Elder 34406c86328SAlex Elder /* Disable the interrupt type if this was the last enabled channel */ 34506c86328SAlex Elder if (!gsi->ieob_enabled_bitmap) 34606c86328SAlex Elder gsi_irq_type_disable(gsi, GSI_IEOB); 34706c86328SAlex Elder 348a054539dSAlex Elder val = gsi->ieob_enabled_bitmap; 349650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_MSK_OFFSET); 350650d1603SAlex Elder } 351650d1603SAlex Elder 3525725593eSAlex Elder static void gsi_irq_ieob_disable_one(struct gsi *gsi, u32 evt_ring_id) 3535725593eSAlex Elder { 3545725593eSAlex Elder gsi_irq_ieob_disable(gsi, BIT(evt_ring_id)); 3555725593eSAlex Elder } 3565725593eSAlex Elder 357650d1603SAlex Elder /* Enable all GSI_interrupt types */ 358650d1603SAlex Elder static void gsi_irq_enable(struct gsi *gsi) 359650d1603SAlex Elder { 360650d1603SAlex Elder u32 val; 361650d1603SAlex Elder 362d6c9e3f5SAlex Elder /* Global interrupts include hardware error reports. Enable 363d6c9e3f5SAlex Elder * that so we can at least report the error should it occur. 364d6c9e3f5SAlex Elder */ 3656c6358ccSAlex Elder iowrite32(BIT(ERROR_INT), gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 3668194be79SAlex Elder gsi_irq_type_update(gsi, gsi->type_enabled_bitmap | BIT(GSI_GLOB_EE)); 367d6c9e3f5SAlex Elder 368352f26a8SAlex Elder /* General GSI interrupts are reported to all EEs; if they occur 369352f26a8SAlex Elder * they are unrecoverable (without reset). A breakpoint interrupt 370352f26a8SAlex Elder * also exists, but we don't support that. We want to be notified 371352f26a8SAlex Elder * of errors so we can report them, even if they can't be handled. 372352f26a8SAlex Elder */ 3736c6358ccSAlex Elder val = BIT(BUS_ERROR); 3746c6358ccSAlex Elder val |= BIT(CMD_FIFO_OVRFLOW); 3756c6358ccSAlex Elder val |= BIT(MCS_STACK_OVRFLOW); 376650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GSI_IRQ_EN_OFFSET); 3778194be79SAlex Elder gsi_irq_type_update(gsi, gsi->type_enabled_bitmap | BIT(GSI_GENERAL)); 378650d1603SAlex Elder } 379650d1603SAlex Elder 3803ca97ffdSAlex Elder /* Disable all GSI interrupt types */ 381650d1603SAlex Elder static void gsi_irq_disable(struct gsi *gsi) 382650d1603SAlex Elder { 3838194be79SAlex Elder gsi_irq_type_update(gsi, 0); 38497eb94c8SAlex Elder 3858194be79SAlex Elder /* Clear the type-specific interrupt masks set by gsi_irq_enable() */ 386650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GSI_IRQ_EN_OFFSET); 387d6c9e3f5SAlex Elder iowrite32(0, gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 388650d1603SAlex Elder } 389650d1603SAlex Elder 390650d1603SAlex Elder /* Return the virtual address associated with a ring index */ 391650d1603SAlex Elder void *gsi_ring_virt(struct gsi_ring *ring, u32 index) 392650d1603SAlex Elder { 393650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 394650d1603SAlex Elder return ring->virt + (index % ring->count) * GSI_RING_ELEMENT_SIZE; 395650d1603SAlex Elder } 396650d1603SAlex Elder 397650d1603SAlex Elder /* Return the 32-bit DMA address associated with a ring index */ 398650d1603SAlex Elder static u32 gsi_ring_addr(struct gsi_ring *ring, u32 index) 399650d1603SAlex Elder { 4003c54b7beSAlex Elder return lower_32_bits(ring->addr) + index * GSI_RING_ELEMENT_SIZE; 401650d1603SAlex Elder } 402650d1603SAlex Elder 403650d1603SAlex Elder /* Return the ring index of a 32-bit ring offset */ 404650d1603SAlex Elder static u32 gsi_ring_index(struct gsi_ring *ring, u32 offset) 405650d1603SAlex Elder { 406650d1603SAlex Elder return (offset - gsi_ring_addr(ring, 0)) / GSI_RING_ELEMENT_SIZE; 407650d1603SAlex Elder } 408650d1603SAlex Elder 409650d1603SAlex Elder /* Issue a GSI command by writing a value to a register, then wait for 410650d1603SAlex Elder * completion to be signaled. Returns true if the command completes 411650d1603SAlex Elder * or false if it times out. 412650d1603SAlex Elder */ 413650d1603SAlex Elder static bool 414650d1603SAlex Elder gsi_command(struct gsi *gsi, u32 reg, u32 val, struct completion *completion) 415650d1603SAlex Elder { 41659b5f454SAlex Elder unsigned long timeout = msecs_to_jiffies(GSI_CMD_TIMEOUT); 41759b5f454SAlex Elder 418650d1603SAlex Elder reinit_completion(completion); 419650d1603SAlex Elder 420650d1603SAlex Elder iowrite32(val, gsi->virt + reg); 421650d1603SAlex Elder 42259b5f454SAlex Elder return !!wait_for_completion_timeout(completion, timeout); 423650d1603SAlex Elder } 424650d1603SAlex Elder 425650d1603SAlex Elder /* Return the hardware's notion of the current state of an event ring */ 426650d1603SAlex Elder static enum gsi_evt_ring_state 427650d1603SAlex Elder gsi_evt_ring_state(struct gsi *gsi, u32 evt_ring_id) 428650d1603SAlex Elder { 429650d1603SAlex Elder u32 val; 430650d1603SAlex Elder 431650d1603SAlex Elder val = ioread32(gsi->virt + GSI_EV_CH_E_CNTXT_0_OFFSET(evt_ring_id)); 432650d1603SAlex Elder 433650d1603SAlex Elder return u32_get_bits(val, EV_CHSTATE_FMASK); 434650d1603SAlex Elder } 435650d1603SAlex Elder 436650d1603SAlex Elder /* Issue an event ring command and wait for it to complete */ 437d9cbe818SAlex Elder static void gsi_evt_ring_command(struct gsi *gsi, u32 evt_ring_id, 438650d1603SAlex Elder enum gsi_evt_cmd_opcode opcode) 439650d1603SAlex Elder { 440650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 441650d1603SAlex Elder struct completion *completion = &evt_ring->completion; 4428463488aSAlex Elder struct device *dev = gsi->dev; 443d9cbe818SAlex Elder bool timeout; 444650d1603SAlex Elder u32 val; 445650d1603SAlex Elder 446a60d0632SAlex Elder /* Enable the completion interrupt for the command */ 447a60d0632SAlex Elder gsi_irq_ev_ctrl_enable(gsi, evt_ring_id); 448b4175f87SAlex Elder 449650d1603SAlex Elder val = u32_encode_bits(evt_ring_id, EV_CHID_FMASK); 450650d1603SAlex Elder val |= u32_encode_bits(opcode, EV_OPCODE_FMASK); 451650d1603SAlex Elder 452d9cbe818SAlex Elder timeout = !gsi_command(gsi, GSI_EV_CH_CMD_OFFSET, val, completion); 453b4175f87SAlex Elder 454a60d0632SAlex Elder gsi_irq_ev_ctrl_disable(gsi); 455b4175f87SAlex Elder 456d9cbe818SAlex Elder if (!timeout) 4571ddf776bSAlex Elder return; 458650d1603SAlex Elder 4598463488aSAlex Elder dev_err(dev, "GSI command %u for event ring %u timed out, state %u\n", 4603f77c926SAlex Elder opcode, evt_ring_id, gsi_evt_ring_state(gsi, evt_ring_id)); 461650d1603SAlex Elder } 462650d1603SAlex Elder 463650d1603SAlex Elder /* Allocate an event ring in NOT_ALLOCATED state */ 464650d1603SAlex Elder static int gsi_evt_ring_alloc_command(struct gsi *gsi, u32 evt_ring_id) 465650d1603SAlex Elder { 4663f77c926SAlex Elder enum gsi_evt_ring_state state; 467650d1603SAlex Elder 468650d1603SAlex Elder /* Get initial event ring state */ 4693f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 4703f77c926SAlex Elder if (state != GSI_EVT_RING_STATE_NOT_ALLOCATED) { 471f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u bad state %u before alloc\n", 4723f77c926SAlex Elder evt_ring_id, state); 473650d1603SAlex Elder return -EINVAL; 474a442b3c7SAlex Elder } 475650d1603SAlex Elder 476d9cbe818SAlex Elder gsi_evt_ring_command(gsi, evt_ring_id, GSI_EVT_ALLOCATE); 477428b448eSAlex Elder 478428b448eSAlex Elder /* If successful the event ring state will have changed */ 4793f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 4803f77c926SAlex Elder if (state == GSI_EVT_RING_STATE_ALLOCATED) 481428b448eSAlex Elder return 0; 482428b448eSAlex Elder 483f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u bad state %u after alloc\n", 4843f77c926SAlex Elder evt_ring_id, state); 485650d1603SAlex Elder 486428b448eSAlex Elder return -EIO; 487650d1603SAlex Elder } 488650d1603SAlex Elder 489650d1603SAlex Elder /* Reset a GSI event ring in ALLOCATED or ERROR state. */ 490650d1603SAlex Elder static void gsi_evt_ring_reset_command(struct gsi *gsi, u32 evt_ring_id) 491650d1603SAlex Elder { 4923f77c926SAlex Elder enum gsi_evt_ring_state state; 493650d1603SAlex Elder 4943f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 495650d1603SAlex Elder if (state != GSI_EVT_RING_STATE_ALLOCATED && 496650d1603SAlex Elder state != GSI_EVT_RING_STATE_ERROR) { 497f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u bad state %u before reset\n", 4983f77c926SAlex Elder evt_ring_id, state); 499650d1603SAlex Elder return; 500650d1603SAlex Elder } 501650d1603SAlex Elder 502d9cbe818SAlex Elder gsi_evt_ring_command(gsi, evt_ring_id, GSI_EVT_RESET); 503428b448eSAlex Elder 504428b448eSAlex Elder /* If successful the event ring state will have changed */ 5053f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 5063f77c926SAlex Elder if (state == GSI_EVT_RING_STATE_ALLOCATED) 507428b448eSAlex Elder return; 508428b448eSAlex Elder 509f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u bad state %u after reset\n", 5103f77c926SAlex Elder evt_ring_id, state); 511650d1603SAlex Elder } 512650d1603SAlex Elder 513650d1603SAlex Elder /* Issue a hardware de-allocation request for an allocated event ring */ 514650d1603SAlex Elder static void gsi_evt_ring_de_alloc_command(struct gsi *gsi, u32 evt_ring_id) 515650d1603SAlex Elder { 5163f77c926SAlex Elder enum gsi_evt_ring_state state; 517650d1603SAlex Elder 5183f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 5193f77c926SAlex Elder if (state != GSI_EVT_RING_STATE_ALLOCATED) { 520f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u state %u before dealloc\n", 5213f77c926SAlex Elder evt_ring_id, state); 522650d1603SAlex Elder return; 523650d1603SAlex Elder } 524650d1603SAlex Elder 525d9cbe818SAlex Elder gsi_evt_ring_command(gsi, evt_ring_id, GSI_EVT_DE_ALLOC); 526428b448eSAlex Elder 527428b448eSAlex Elder /* If successful the event ring state will have changed */ 5283f77c926SAlex Elder state = gsi_evt_ring_state(gsi, evt_ring_id); 5293f77c926SAlex Elder if (state == GSI_EVT_RING_STATE_NOT_ALLOCATED) 530428b448eSAlex Elder return; 531428b448eSAlex Elder 532f8d3bdd5SAlex Elder dev_err(gsi->dev, "event ring %u bad state %u after dealloc\n", 5333f77c926SAlex Elder evt_ring_id, state); 534650d1603SAlex Elder } 535650d1603SAlex Elder 536a2003b30SAlex Elder /* Fetch the current state of a channel from hardware */ 537aba7924fSAlex Elder static enum gsi_channel_state gsi_channel_state(struct gsi_channel *channel) 538650d1603SAlex Elder { 539aba7924fSAlex Elder u32 channel_id = gsi_channel_id(channel); 540e6cdd6d8SAlex Elder void __iomem *virt = channel->gsi->virt; 541650d1603SAlex Elder u32 val; 542650d1603SAlex Elder 543aba7924fSAlex Elder val = ioread32(virt + GSI_CH_C_CNTXT_0_OFFSET(channel_id)); 544650d1603SAlex Elder 545650d1603SAlex Elder return u32_get_bits(val, CHSTATE_FMASK); 546650d1603SAlex Elder } 547650d1603SAlex Elder 548650d1603SAlex Elder /* Issue a channel command and wait for it to complete */ 5491169318bSAlex Elder static void 550650d1603SAlex Elder gsi_channel_command(struct gsi_channel *channel, enum gsi_ch_cmd_opcode opcode) 551650d1603SAlex Elder { 552650d1603SAlex Elder struct completion *completion = &channel->completion; 553650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 554a2003b30SAlex Elder struct gsi *gsi = channel->gsi; 5558463488aSAlex Elder struct device *dev = gsi->dev; 556d9cbe818SAlex Elder bool timeout; 557650d1603SAlex Elder u32 val; 558650d1603SAlex Elder 559a60d0632SAlex Elder /* Enable the completion interrupt for the command */ 560a60d0632SAlex Elder gsi_irq_ch_ctrl_enable(gsi, channel_id); 561b054d4f9SAlex Elder 562650d1603SAlex Elder val = u32_encode_bits(channel_id, CH_CHID_FMASK); 563650d1603SAlex Elder val |= u32_encode_bits(opcode, CH_OPCODE_FMASK); 564d9cbe818SAlex Elder timeout = !gsi_command(gsi, GSI_CH_CMD_OFFSET, val, completion); 565650d1603SAlex Elder 566a60d0632SAlex Elder gsi_irq_ch_ctrl_disable(gsi); 567b054d4f9SAlex Elder 568d9cbe818SAlex Elder if (!timeout) 5691169318bSAlex Elder return; 570650d1603SAlex Elder 5718463488aSAlex Elder dev_err(dev, "GSI command %u for channel %u timed out, state %u\n", 572a2003b30SAlex Elder opcode, channel_id, gsi_channel_state(channel)); 573650d1603SAlex Elder } 574650d1603SAlex Elder 575650d1603SAlex Elder /* Allocate GSI channel in NOT_ALLOCATED state */ 576650d1603SAlex Elder static int gsi_channel_alloc_command(struct gsi *gsi, u32 channel_id) 577650d1603SAlex Elder { 578650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 579a442b3c7SAlex Elder struct device *dev = gsi->dev; 580a2003b30SAlex Elder enum gsi_channel_state state; 581650d1603SAlex Elder 582650d1603SAlex Elder /* Get initial channel state */ 583a2003b30SAlex Elder state = gsi_channel_state(channel); 584a442b3c7SAlex Elder if (state != GSI_CHANNEL_STATE_NOT_ALLOCATED) { 585f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u before alloc\n", 586f8d3bdd5SAlex Elder channel_id, state); 587650d1603SAlex Elder return -EINVAL; 588a442b3c7SAlex Elder } 589650d1603SAlex Elder 5901169318bSAlex Elder gsi_channel_command(channel, GSI_CH_ALLOCATE); 591a2003b30SAlex Elder 5926ffddf3bSAlex Elder /* If successful the channel state will have changed */ 593a2003b30SAlex Elder state = gsi_channel_state(channel); 5946ffddf3bSAlex Elder if (state == GSI_CHANNEL_STATE_ALLOCATED) 5956ffddf3bSAlex Elder return 0; 5966ffddf3bSAlex Elder 597f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u after alloc\n", 598f8d3bdd5SAlex Elder channel_id, state); 599650d1603SAlex Elder 6006ffddf3bSAlex Elder return -EIO; 601650d1603SAlex Elder } 602650d1603SAlex Elder 603650d1603SAlex Elder /* Start an ALLOCATED channel */ 604650d1603SAlex Elder static int gsi_channel_start_command(struct gsi_channel *channel) 605650d1603SAlex Elder { 606a442b3c7SAlex Elder struct device *dev = channel->gsi->dev; 607a2003b30SAlex Elder enum gsi_channel_state state; 608650d1603SAlex Elder 609a2003b30SAlex Elder state = gsi_channel_state(channel); 610650d1603SAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED && 611a442b3c7SAlex Elder state != GSI_CHANNEL_STATE_STOPPED) { 612f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u before start\n", 613f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 614650d1603SAlex Elder return -EINVAL; 615a442b3c7SAlex Elder } 616650d1603SAlex Elder 6171169318bSAlex Elder gsi_channel_command(channel, GSI_CH_START); 618a2003b30SAlex Elder 6196ffddf3bSAlex Elder /* If successful the channel state will have changed */ 620a2003b30SAlex Elder state = gsi_channel_state(channel); 6216ffddf3bSAlex Elder if (state == GSI_CHANNEL_STATE_STARTED) 6226ffddf3bSAlex Elder return 0; 6236ffddf3bSAlex Elder 624f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u after start\n", 625f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 626650d1603SAlex Elder 6276ffddf3bSAlex Elder return -EIO; 628650d1603SAlex Elder } 629650d1603SAlex Elder 630650d1603SAlex Elder /* Stop a GSI channel in STARTED state */ 631650d1603SAlex Elder static int gsi_channel_stop_command(struct gsi_channel *channel) 632650d1603SAlex Elder { 633a442b3c7SAlex Elder struct device *dev = channel->gsi->dev; 634a2003b30SAlex Elder enum gsi_channel_state state; 635650d1603SAlex Elder 636a2003b30SAlex Elder state = gsi_channel_state(channel); 6375468cbcdSAlex Elder 6385468cbcdSAlex Elder /* Channel could have entered STOPPED state since last call 6395468cbcdSAlex Elder * if it timed out. If so, we're done. 6405468cbcdSAlex Elder */ 6415468cbcdSAlex Elder if (state == GSI_CHANNEL_STATE_STOPPED) 6425468cbcdSAlex Elder return 0; 6435468cbcdSAlex Elder 644650d1603SAlex Elder if (state != GSI_CHANNEL_STATE_STARTED && 645a442b3c7SAlex Elder state != GSI_CHANNEL_STATE_STOP_IN_PROC) { 646f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u before stop\n", 647f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 648650d1603SAlex Elder return -EINVAL; 649a442b3c7SAlex Elder } 650650d1603SAlex Elder 6511169318bSAlex Elder gsi_channel_command(channel, GSI_CH_STOP); 652a2003b30SAlex Elder 6536ffddf3bSAlex Elder /* If successful the channel state will have changed */ 654a2003b30SAlex Elder state = gsi_channel_state(channel); 6556ffddf3bSAlex Elder if (state == GSI_CHANNEL_STATE_STOPPED) 6566ffddf3bSAlex Elder return 0; 657650d1603SAlex Elder 658650d1603SAlex Elder /* We may have to try again if stop is in progress */ 659a2003b30SAlex Elder if (state == GSI_CHANNEL_STATE_STOP_IN_PROC) 660650d1603SAlex Elder return -EAGAIN; 661650d1603SAlex Elder 662f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u after stop\n", 663f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 664650d1603SAlex Elder 665650d1603SAlex Elder return -EIO; 666650d1603SAlex Elder } 667650d1603SAlex Elder 668650d1603SAlex Elder /* Reset a GSI channel in ALLOCATED or ERROR state. */ 669650d1603SAlex Elder static void gsi_channel_reset_command(struct gsi_channel *channel) 670650d1603SAlex Elder { 671a442b3c7SAlex Elder struct device *dev = channel->gsi->dev; 672a2003b30SAlex Elder enum gsi_channel_state state; 673650d1603SAlex Elder 67474401946SAlex Elder /* A short delay is required before a RESET command */ 67574401946SAlex Elder usleep_range(USEC_PER_MSEC, 2 * USEC_PER_MSEC); 676650d1603SAlex Elder 677a2003b30SAlex Elder state = gsi_channel_state(channel); 678a2003b30SAlex Elder if (state != GSI_CHANNEL_STATE_STOPPED && 679a2003b30SAlex Elder state != GSI_CHANNEL_STATE_ERROR) { 6805d28913dSAlex Elder /* No need to reset a channel already in ALLOCATED state */ 6815d28913dSAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED) 682f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u before reset\n", 683f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 684650d1603SAlex Elder return; 685650d1603SAlex Elder } 686650d1603SAlex Elder 6871169318bSAlex Elder gsi_channel_command(channel, GSI_CH_RESET); 688a2003b30SAlex Elder 6896ffddf3bSAlex Elder /* If successful the channel state will have changed */ 690a2003b30SAlex Elder state = gsi_channel_state(channel); 6916ffddf3bSAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED) 692f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u after reset\n", 693f8d3bdd5SAlex Elder gsi_channel_id(channel), state); 694650d1603SAlex Elder } 695650d1603SAlex Elder 696650d1603SAlex Elder /* Deallocate an ALLOCATED GSI channel */ 697650d1603SAlex Elder static void gsi_channel_de_alloc_command(struct gsi *gsi, u32 channel_id) 698650d1603SAlex Elder { 699650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 700a442b3c7SAlex Elder struct device *dev = gsi->dev; 701a2003b30SAlex Elder enum gsi_channel_state state; 702650d1603SAlex Elder 703a2003b30SAlex Elder state = gsi_channel_state(channel); 704a2003b30SAlex Elder if (state != GSI_CHANNEL_STATE_ALLOCATED) { 705f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u before dealloc\n", 706f8d3bdd5SAlex Elder channel_id, state); 707650d1603SAlex Elder return; 708650d1603SAlex Elder } 709650d1603SAlex Elder 7101169318bSAlex Elder gsi_channel_command(channel, GSI_CH_DE_ALLOC); 711a2003b30SAlex Elder 7126ffddf3bSAlex Elder /* If successful the channel state will have changed */ 713a2003b30SAlex Elder state = gsi_channel_state(channel); 7146ffddf3bSAlex Elder 7156ffddf3bSAlex Elder if (state != GSI_CHANNEL_STATE_NOT_ALLOCATED) 716f8d3bdd5SAlex Elder dev_err(dev, "channel %u bad state %u after dealloc\n", 717f8d3bdd5SAlex Elder channel_id, state); 718650d1603SAlex Elder } 719650d1603SAlex Elder 720650d1603SAlex Elder /* Ring an event ring doorbell, reporting the last entry processed by the AP. 721650d1603SAlex Elder * The index argument (modulo the ring count) is the first unfilled entry, so 722650d1603SAlex Elder * we supply one less than that with the doorbell. Update the event ring 723650d1603SAlex Elder * index field with the value provided. 724650d1603SAlex Elder */ 725650d1603SAlex Elder static void gsi_evt_ring_doorbell(struct gsi *gsi, u32 evt_ring_id, u32 index) 726650d1603SAlex Elder { 727650d1603SAlex Elder struct gsi_ring *ring = &gsi->evt_ring[evt_ring_id].ring; 728650d1603SAlex Elder u32 val; 729650d1603SAlex Elder 730650d1603SAlex Elder ring->index = index; /* Next unused entry */ 731650d1603SAlex Elder 732650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 733650d1603SAlex Elder val = gsi_ring_addr(ring, (index - 1) % ring->count); 734650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_DOORBELL_0_OFFSET(evt_ring_id)); 735650d1603SAlex Elder } 736650d1603SAlex Elder 737650d1603SAlex Elder /* Program an event ring for use */ 738650d1603SAlex Elder static void gsi_evt_ring_program(struct gsi *gsi, u32 evt_ring_id) 739650d1603SAlex Elder { 740650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 741650d1603SAlex Elder size_t size = evt_ring->ring.count * GSI_RING_ELEMENT_SIZE; 742650d1603SAlex Elder u32 val; 743650d1603SAlex Elder 74446dda53eSAlex Elder /* We program all event rings as GPI type/protocol */ 74546dda53eSAlex Elder val = u32_encode_bits(GSI_CHANNEL_TYPE_GPI, EV_CHTYPE_FMASK); 746650d1603SAlex Elder val |= EV_INTYPE_FMASK; 747650d1603SAlex Elder val |= u32_encode_bits(GSI_RING_ELEMENT_SIZE, EV_ELEMENT_SIZE_FMASK); 748650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_0_OFFSET(evt_ring_id)); 749650d1603SAlex Elder 75042839f95SAlex Elder val = ev_r_length_encoded(gsi->version, size); 751650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_1_OFFSET(evt_ring_id)); 752650d1603SAlex Elder 753650d1603SAlex Elder /* The context 2 and 3 registers store the low-order and 754650d1603SAlex Elder * high-order 32 bits of the address of the event ring, 755650d1603SAlex Elder * respectively. 756650d1603SAlex Elder */ 7573c54b7beSAlex Elder val = lower_32_bits(evt_ring->ring.addr); 758650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_2_OFFSET(evt_ring_id)); 7593c54b7beSAlex Elder val = upper_32_bits(evt_ring->ring.addr); 760650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_3_OFFSET(evt_ring_id)); 761650d1603SAlex Elder 762650d1603SAlex Elder /* Enable interrupt moderation by setting the moderation delay */ 763650d1603SAlex Elder val = u32_encode_bits(GSI_EVT_RING_INT_MODT, MODT_FMASK); 764650d1603SAlex Elder val |= u32_encode_bits(1, MODC_FMASK); /* comes from channel */ 765650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_EV_CH_E_CNTXT_8_OFFSET(evt_ring_id)); 766650d1603SAlex Elder 767650d1603SAlex Elder /* No MSI write data, and MSI address high and low address is 0 */ 768650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_9_OFFSET(evt_ring_id)); 769650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_10_OFFSET(evt_ring_id)); 770650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_11_OFFSET(evt_ring_id)); 771650d1603SAlex Elder 772650d1603SAlex Elder /* We don't need to get event read pointer updates */ 773650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_12_OFFSET(evt_ring_id)); 774650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_EV_CH_E_CNTXT_13_OFFSET(evt_ring_id)); 775650d1603SAlex Elder 776650d1603SAlex Elder /* Finally, tell the hardware we've completed event 0 (arbitrary) */ 777650d1603SAlex Elder gsi_evt_ring_doorbell(gsi, evt_ring_id, 0); 778650d1603SAlex Elder } 779650d1603SAlex Elder 780e6316920SAlex Elder /* Find the transaction whose completion indicates a channel is quiesced */ 781650d1603SAlex Elder static struct gsi_trans *gsi_channel_trans_last(struct gsi_channel *channel) 782650d1603SAlex Elder { 783650d1603SAlex Elder struct gsi_trans_info *trans_info = &channel->trans_info; 784e6316920SAlex Elder const struct list_head *list; 785650d1603SAlex Elder struct gsi_trans *trans; 786650d1603SAlex Elder 787650d1603SAlex Elder spin_lock_bh(&trans_info->spinlock); 788650d1603SAlex Elder 789e6316920SAlex Elder /* There is a small chance a TX transaction got allocated just 790e6316920SAlex Elder * before we disabled transmits, so check for that. 791e6316920SAlex Elder */ 792e6316920SAlex Elder if (channel->toward_ipa) { 793e6316920SAlex Elder list = &trans_info->alloc; 794e6316920SAlex Elder if (!list_empty(list)) 795e6316920SAlex Elder goto done; 796e6316920SAlex Elder list = &trans_info->pending; 797e6316920SAlex Elder if (!list_empty(list)) 798e6316920SAlex Elder goto done; 799e6316920SAlex Elder } 800e6316920SAlex Elder 801e6316920SAlex Elder /* Otherwise (TX or RX) we want to wait for anything that 802e6316920SAlex Elder * has completed, or has been polled but not released yet. 803e6316920SAlex Elder */ 804e6316920SAlex Elder list = &trans_info->complete; 805e6316920SAlex Elder if (!list_empty(list)) 806e6316920SAlex Elder goto done; 807e6316920SAlex Elder list = &trans_info->polled; 808e6316920SAlex Elder if (list_empty(list)) 809e6316920SAlex Elder list = NULL; 810e6316920SAlex Elder done: 811e6316920SAlex Elder trans = list ? list_last_entry(list, struct gsi_trans, links) : NULL; 812650d1603SAlex Elder 813650d1603SAlex Elder /* Caller will wait for this, so take a reference */ 814650d1603SAlex Elder if (trans) 815650d1603SAlex Elder refcount_inc(&trans->refcount); 816650d1603SAlex Elder 817650d1603SAlex Elder spin_unlock_bh(&trans_info->spinlock); 818650d1603SAlex Elder 819650d1603SAlex Elder return trans; 820650d1603SAlex Elder } 821650d1603SAlex Elder 822650d1603SAlex Elder /* Wait for transaction activity on a channel to complete */ 823650d1603SAlex Elder static void gsi_channel_trans_quiesce(struct gsi_channel *channel) 824650d1603SAlex Elder { 825650d1603SAlex Elder struct gsi_trans *trans; 826650d1603SAlex Elder 827650d1603SAlex Elder /* Get the last transaction, and wait for it to complete */ 828650d1603SAlex Elder trans = gsi_channel_trans_last(channel); 829650d1603SAlex Elder if (trans) { 830650d1603SAlex Elder wait_for_completion(&trans->completion); 831650d1603SAlex Elder gsi_trans_free(trans); 832650d1603SAlex Elder } 833650d1603SAlex Elder } 834650d1603SAlex Elder 83557ab8ca4SAlex Elder /* Program a channel for use; there is no gsi_channel_deprogram() */ 836650d1603SAlex Elder static void gsi_channel_program(struct gsi_channel *channel, bool doorbell) 837650d1603SAlex Elder { 838650d1603SAlex Elder size_t size = channel->tre_ring.count * GSI_RING_ELEMENT_SIZE; 839650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 840650d1603SAlex Elder union gsi_channel_scratch scr = { }; 841650d1603SAlex Elder struct gsi_channel_scratch_gpi *gpi; 842650d1603SAlex Elder struct gsi *gsi = channel->gsi; 843650d1603SAlex Elder u32 wrr_weight = 0; 844650d1603SAlex Elder u32 val; 845650d1603SAlex Elder 846650d1603SAlex Elder /* Arbitrarily pick TRE 0 as the first channel element to use */ 847650d1603SAlex Elder channel->tre_ring.index = 0; 848650d1603SAlex Elder 84946dda53eSAlex Elder /* We program all channels as GPI type/protocol */ 8502ad6f03bSAlex Elder val = chtype_protocol_encoded(gsi->version, GSI_CHANNEL_TYPE_GPI); 851650d1603SAlex Elder if (channel->toward_ipa) 852650d1603SAlex Elder val |= CHTYPE_DIR_FMASK; 853650d1603SAlex Elder val |= u32_encode_bits(channel->evt_ring_id, ERINDEX_FMASK); 854650d1603SAlex Elder val |= u32_encode_bits(GSI_RING_ELEMENT_SIZE, ELEMENT_SIZE_FMASK); 855650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_0_OFFSET(channel_id)); 856650d1603SAlex Elder 85742839f95SAlex Elder val = r_length_encoded(gsi->version, size); 858650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_1_OFFSET(channel_id)); 859650d1603SAlex Elder 860650d1603SAlex Elder /* The context 2 and 3 registers store the low-order and 861650d1603SAlex Elder * high-order 32 bits of the address of the channel ring, 862650d1603SAlex Elder * respectively. 863650d1603SAlex Elder */ 8643c54b7beSAlex Elder val = lower_32_bits(channel->tre_ring.addr); 865650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_2_OFFSET(channel_id)); 8663c54b7beSAlex Elder val = upper_32_bits(channel->tre_ring.addr); 867650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_CNTXT_3_OFFSET(channel_id)); 868650d1603SAlex Elder 869650d1603SAlex Elder /* Command channel gets low weighted round-robin priority */ 870650d1603SAlex Elder if (channel->command) 871650d1603SAlex Elder wrr_weight = field_max(WRR_WEIGHT_FMASK); 872650d1603SAlex Elder val = u32_encode_bits(wrr_weight, WRR_WEIGHT_FMASK); 873650d1603SAlex Elder 874650d1603SAlex Elder /* Max prefetch is 1 segment (do not set MAX_PREFETCH_FMASK) */ 875650d1603SAlex Elder 876d7f3087bSAlex Elder /* No need to use the doorbell engine starting at IPA v4.0 */ 877d7f3087bSAlex Elder if (gsi->version < IPA_VERSION_4_0 && doorbell) 878650d1603SAlex Elder val |= USE_DB_ENG_FMASK; 879650d1603SAlex Elder 8809f848198SAlex Elder /* v4.0 introduces an escape buffer for prefetch. We use it 8819f848198SAlex Elder * on all but the AP command channel. 8829f848198SAlex Elder */ 883d7f3087bSAlex Elder if (gsi->version >= IPA_VERSION_4_0 && !channel->command) { 884b0b6f0ddSAlex Elder /* If not otherwise set, prefetch buffers are used */ 885b0b6f0ddSAlex Elder if (gsi->version < IPA_VERSION_4_5) 886650d1603SAlex Elder val |= USE_ESCAPE_BUF_ONLY_FMASK; 887b0b6f0ddSAlex Elder else 888b0b6f0ddSAlex Elder val |= u32_encode_bits(GSI_ESCAPE_BUF_ONLY, 889b0b6f0ddSAlex Elder PREFETCH_MODE_FMASK); 890b0b6f0ddSAlex Elder } 89142839f95SAlex Elder /* All channels set DB_IN_BYTES */ 89242839f95SAlex Elder if (gsi->version >= IPA_VERSION_4_9) 89342839f95SAlex Elder val |= DB_IN_BYTES; 894650d1603SAlex Elder 895650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_QOS_OFFSET(channel_id)); 896650d1603SAlex Elder 897650d1603SAlex Elder /* Now update the scratch registers for GPI protocol */ 898650d1603SAlex Elder gpi = &scr.gpi; 899650d1603SAlex Elder gpi->max_outstanding_tre = gsi_channel_trans_tre_max(gsi, channel_id) * 900650d1603SAlex Elder GSI_RING_ELEMENT_SIZE; 901650d1603SAlex Elder gpi->outstanding_threshold = 2 * GSI_RING_ELEMENT_SIZE; 902650d1603SAlex Elder 903650d1603SAlex Elder val = scr.data.word1; 904650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_0_OFFSET(channel_id)); 905650d1603SAlex Elder 906650d1603SAlex Elder val = scr.data.word2; 907650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_1_OFFSET(channel_id)); 908650d1603SAlex Elder 909650d1603SAlex Elder val = scr.data.word3; 910650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_2_OFFSET(channel_id)); 911650d1603SAlex Elder 912650d1603SAlex Elder /* We must preserve the upper 16 bits of the last scratch register. 913650d1603SAlex Elder * The next sequence assumes those bits remain unchanged between the 914650d1603SAlex Elder * read and the write. 915650d1603SAlex Elder */ 916650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CH_C_SCRATCH_3_OFFSET(channel_id)); 917650d1603SAlex Elder val = (scr.data.word4 & GENMASK(31, 16)) | (val & GENMASK(15, 0)); 918650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_SCRATCH_3_OFFSET(channel_id)); 919650d1603SAlex Elder 920650d1603SAlex Elder /* All done! */ 921650d1603SAlex Elder } 922650d1603SAlex Elder 923893b838eSAlex Elder static int __gsi_channel_start(struct gsi_channel *channel, bool start) 924650d1603SAlex Elder { 925893b838eSAlex Elder struct gsi *gsi = channel->gsi; 926650d1603SAlex Elder int ret; 927650d1603SAlex Elder 928a65c0288SAlex Elder if (!start) 929a65c0288SAlex Elder return 0; 9304fef691cSAlex Elder 931650d1603SAlex Elder mutex_lock(&gsi->mutex); 932650d1603SAlex Elder 933a65c0288SAlex Elder ret = gsi_channel_start_command(channel); 934650d1603SAlex Elder 935650d1603SAlex Elder mutex_unlock(&gsi->mutex); 936650d1603SAlex Elder 937650d1603SAlex Elder return ret; 938650d1603SAlex Elder } 939650d1603SAlex Elder 940893b838eSAlex Elder /* Start an allocated GSI channel */ 941893b838eSAlex Elder int gsi_channel_start(struct gsi *gsi, u32 channel_id) 942893b838eSAlex Elder { 943893b838eSAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 944a65c0288SAlex Elder int ret; 945893b838eSAlex Elder 946a65c0288SAlex Elder /* Enable NAPI and the completion interrupt */ 947a65c0288SAlex Elder napi_enable(&channel->napi); 948a65c0288SAlex Elder gsi_irq_ieob_enable_one(gsi, channel->evt_ring_id); 949a65c0288SAlex Elder 950a65c0288SAlex Elder ret = __gsi_channel_start(channel, true); 951a65c0288SAlex Elder if (ret) { 952a65c0288SAlex Elder gsi_irq_ieob_disable_one(gsi, channel->evt_ring_id); 953a65c0288SAlex Elder napi_disable(&channel->napi); 954a65c0288SAlex Elder } 955a65c0288SAlex Elder 956a65c0288SAlex Elder return ret; 957893b838eSAlex Elder } 958893b838eSAlex Elder 959697e834eSAlex Elder static int gsi_channel_stop_retry(struct gsi_channel *channel) 960650d1603SAlex Elder { 961057ef63fSAlex Elder u32 retries = GSI_CHANNEL_STOP_RETRIES; 962650d1603SAlex Elder int ret; 963650d1603SAlex Elder 964650d1603SAlex Elder do { 965650d1603SAlex Elder ret = gsi_channel_stop_command(channel); 966650d1603SAlex Elder if (ret != -EAGAIN) 967650d1603SAlex Elder break; 9683d60e15fSAlex Elder usleep_range(3 * USEC_PER_MSEC, 5 * USEC_PER_MSEC); 969650d1603SAlex Elder } while (retries--); 970650d1603SAlex Elder 971697e834eSAlex Elder return ret; 972697e834eSAlex Elder } 973697e834eSAlex Elder 974893b838eSAlex Elder static int __gsi_channel_stop(struct gsi_channel *channel, bool stop) 975697e834eSAlex Elder { 97663ec9be1SAlex Elder struct gsi *gsi = channel->gsi; 977697e834eSAlex Elder int ret; 978697e834eSAlex Elder 979a65c0288SAlex Elder /* Wait for any underway transactions to complete before stopping. */ 980bd1ea1e4SAlex Elder gsi_channel_trans_quiesce(channel); 981697e834eSAlex Elder 98263ec9be1SAlex Elder if (!stop) 98363ec9be1SAlex Elder return 0; 98463ec9be1SAlex Elder 98563ec9be1SAlex Elder mutex_lock(&gsi->mutex); 98663ec9be1SAlex Elder 98763ec9be1SAlex Elder ret = gsi_channel_stop_retry(channel); 98863ec9be1SAlex Elder 98963ec9be1SAlex Elder mutex_unlock(&gsi->mutex); 99063ec9be1SAlex Elder 99163ec9be1SAlex Elder return ret; 992650d1603SAlex Elder } 993650d1603SAlex Elder 994893b838eSAlex Elder /* Stop a started channel */ 995893b838eSAlex Elder int gsi_channel_stop(struct gsi *gsi, u32 channel_id) 996893b838eSAlex Elder { 997893b838eSAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 998a65c0288SAlex Elder int ret; 999893b838eSAlex Elder 1000a65c0288SAlex Elder ret = __gsi_channel_stop(channel, true); 1001a65c0288SAlex Elder if (ret) 1002a65c0288SAlex Elder return ret; 1003a65c0288SAlex Elder 100463ec9be1SAlex Elder /* Disable the completion interrupt and NAPI if successful */ 1005a65c0288SAlex Elder gsi_irq_ieob_disable_one(gsi, channel->evt_ring_id); 1006a65c0288SAlex Elder napi_disable(&channel->napi); 1007a65c0288SAlex Elder 1008a65c0288SAlex Elder return 0; 1009893b838eSAlex Elder } 1010893b838eSAlex Elder 1011ce54993dSAlex Elder /* Reset and reconfigure a channel, (possibly) enabling the doorbell engine */ 1012ce54993dSAlex Elder void gsi_channel_reset(struct gsi *gsi, u32 channel_id, bool doorbell) 1013650d1603SAlex Elder { 1014650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1015650d1603SAlex Elder 1016650d1603SAlex Elder mutex_lock(&gsi->mutex); 1017650d1603SAlex Elder 1018650d1603SAlex Elder gsi_channel_reset_command(channel); 1019a3f2405bSAlex Elder /* Due to a hardware quirk we may need to reset RX channels twice. */ 1020d7f3087bSAlex Elder if (gsi->version < IPA_VERSION_4_0 && !channel->toward_ipa) 1021650d1603SAlex Elder gsi_channel_reset_command(channel); 1022650d1603SAlex Elder 1023ce54993dSAlex Elder gsi_channel_program(channel, doorbell); 1024650d1603SAlex Elder gsi_channel_trans_cancel_pending(channel); 1025650d1603SAlex Elder 1026650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1027650d1603SAlex Elder } 1028650d1603SAlex Elder 1029*decfef0fSAlex Elder /* Stop a started channel for suspend */ 1030*decfef0fSAlex Elder int gsi_channel_suspend(struct gsi *gsi, u32 channel_id) 1031650d1603SAlex Elder { 1032650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1033b1750723SAlex Elder int ret; 1034650d1603SAlex Elder 1035*decfef0fSAlex Elder /* Prior to IPA v4.0 suspend/resume is not implemented by GSI */ 1036*decfef0fSAlex Elder ret = __gsi_channel_stop(channel, gsi->version >= IPA_VERSION_4_0); 1037b1750723SAlex Elder if (ret) 1038b1750723SAlex Elder return ret; 1039b1750723SAlex Elder 1040b1750723SAlex Elder /* Ensure NAPI polling has finished. */ 1041b1750723SAlex Elder napi_synchronize(&channel->napi); 1042b1750723SAlex Elder 1043b1750723SAlex Elder return 0; 1044650d1603SAlex Elder } 1045650d1603SAlex Elder 1046*decfef0fSAlex Elder /* Resume a suspended channel (starting if stopped) */ 1047*decfef0fSAlex Elder int gsi_channel_resume(struct gsi *gsi, u32 channel_id) 1048650d1603SAlex Elder { 1049650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1050650d1603SAlex Elder 1051*decfef0fSAlex Elder /* Prior to IPA v4.0 suspend/resume is not implemented by GSI */ 1052*decfef0fSAlex Elder return __gsi_channel_start(channel, gsi->version >= IPA_VERSION_4_0); 1053650d1603SAlex Elder } 1054650d1603SAlex Elder 1055650d1603SAlex Elder /** 1056650d1603SAlex Elder * gsi_channel_tx_queued() - Report queued TX transfers for a channel 1057650d1603SAlex Elder * @channel: Channel for which to report 1058650d1603SAlex Elder * 1059650d1603SAlex Elder * Report to the network stack the number of bytes and transactions that 1060650d1603SAlex Elder * have been queued to hardware since last call. This and the next function 1061650d1603SAlex Elder * supply information used by the network stack for throttling. 1062650d1603SAlex Elder * 1063650d1603SAlex Elder * For each channel we track the number of transactions used and bytes of 1064650d1603SAlex Elder * data those transactions represent. We also track what those values are 1065650d1603SAlex Elder * each time this function is called. Subtracting the two tells us 1066650d1603SAlex Elder * the number of bytes and transactions that have been added between 1067650d1603SAlex Elder * successive calls. 1068650d1603SAlex Elder * 1069650d1603SAlex Elder * Calling this each time we ring the channel doorbell allows us to 1070650d1603SAlex Elder * provide accurate information to the network stack about how much 1071650d1603SAlex Elder * work we've given the hardware at any point in time. 1072650d1603SAlex Elder */ 1073650d1603SAlex Elder void gsi_channel_tx_queued(struct gsi_channel *channel) 1074650d1603SAlex Elder { 1075650d1603SAlex Elder u32 trans_count; 1076650d1603SAlex Elder u32 byte_count; 1077650d1603SAlex Elder 1078650d1603SAlex Elder byte_count = channel->byte_count - channel->queued_byte_count; 1079650d1603SAlex Elder trans_count = channel->trans_count - channel->queued_trans_count; 1080650d1603SAlex Elder channel->queued_byte_count = channel->byte_count; 1081650d1603SAlex Elder channel->queued_trans_count = channel->trans_count; 1082650d1603SAlex Elder 1083650d1603SAlex Elder ipa_gsi_channel_tx_queued(channel->gsi, gsi_channel_id(channel), 1084650d1603SAlex Elder trans_count, byte_count); 1085650d1603SAlex Elder } 1086650d1603SAlex Elder 1087650d1603SAlex Elder /** 1088650d1603SAlex Elder * gsi_channel_tx_update() - Report completed TX transfers 1089650d1603SAlex Elder * @channel: Channel that has completed transmitting packets 1090650d1603SAlex Elder * @trans: Last transation known to be complete 1091650d1603SAlex Elder * 1092650d1603SAlex Elder * Compute the number of transactions and bytes that have been transferred 1093650d1603SAlex Elder * over a TX channel since the given transaction was committed. Report this 1094650d1603SAlex Elder * information to the network stack. 1095650d1603SAlex Elder * 1096650d1603SAlex Elder * At the time a transaction is committed, we record its channel's 1097650d1603SAlex Elder * committed transaction and byte counts *in the transaction*. 1098650d1603SAlex Elder * Completions are signaled by the hardware with an interrupt, and 1099650d1603SAlex Elder * we can determine the latest completed transaction at that time. 1100650d1603SAlex Elder * 1101650d1603SAlex Elder * The difference between the byte/transaction count recorded in 1102650d1603SAlex Elder * the transaction and the count last time we recorded a completion 1103650d1603SAlex Elder * tells us exactly how much data has been transferred between 1104650d1603SAlex Elder * completions. 1105650d1603SAlex Elder * 1106650d1603SAlex Elder * Calling this each time we learn of a newly-completed transaction 1107650d1603SAlex Elder * allows us to provide accurate information to the network stack 1108650d1603SAlex Elder * about how much work has been completed by the hardware at a given 1109650d1603SAlex Elder * point in time. 1110650d1603SAlex Elder */ 1111650d1603SAlex Elder static void 1112650d1603SAlex Elder gsi_channel_tx_update(struct gsi_channel *channel, struct gsi_trans *trans) 1113650d1603SAlex Elder { 1114650d1603SAlex Elder u64 byte_count = trans->byte_count + trans->len; 1115650d1603SAlex Elder u64 trans_count = trans->trans_count + 1; 1116650d1603SAlex Elder 1117650d1603SAlex Elder byte_count -= channel->compl_byte_count; 1118650d1603SAlex Elder channel->compl_byte_count += byte_count; 1119650d1603SAlex Elder trans_count -= channel->compl_trans_count; 1120650d1603SAlex Elder channel->compl_trans_count += trans_count; 1121650d1603SAlex Elder 1122650d1603SAlex Elder ipa_gsi_channel_tx_completed(channel->gsi, gsi_channel_id(channel), 1123650d1603SAlex Elder trans_count, byte_count); 1124650d1603SAlex Elder } 1125650d1603SAlex Elder 1126650d1603SAlex Elder /* Channel control interrupt handler */ 1127650d1603SAlex Elder static void gsi_isr_chan_ctrl(struct gsi *gsi) 1128650d1603SAlex Elder { 1129650d1603SAlex Elder u32 channel_mask; 1130650d1603SAlex Elder 1131650d1603SAlex Elder channel_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_CH_IRQ_OFFSET); 1132650d1603SAlex Elder iowrite32(channel_mask, gsi->virt + GSI_CNTXT_SRC_CH_IRQ_CLR_OFFSET); 1133650d1603SAlex Elder 1134650d1603SAlex Elder while (channel_mask) { 1135650d1603SAlex Elder u32 channel_id = __ffs(channel_mask); 1136650d1603SAlex Elder struct gsi_channel *channel; 1137650d1603SAlex Elder 1138650d1603SAlex Elder channel_mask ^= BIT(channel_id); 1139650d1603SAlex Elder 1140650d1603SAlex Elder channel = &gsi->channel[channel_id]; 1141650d1603SAlex Elder 1142650d1603SAlex Elder complete(&channel->completion); 1143650d1603SAlex Elder } 1144650d1603SAlex Elder } 1145650d1603SAlex Elder 1146650d1603SAlex Elder /* Event ring control interrupt handler */ 1147650d1603SAlex Elder static void gsi_isr_evt_ctrl(struct gsi *gsi) 1148650d1603SAlex Elder { 1149650d1603SAlex Elder u32 event_mask; 1150650d1603SAlex Elder 1151650d1603SAlex Elder event_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_OFFSET); 1152650d1603SAlex Elder iowrite32(event_mask, gsi->virt + GSI_CNTXT_SRC_EV_CH_IRQ_CLR_OFFSET); 1153650d1603SAlex Elder 1154650d1603SAlex Elder while (event_mask) { 1155650d1603SAlex Elder u32 evt_ring_id = __ffs(event_mask); 1156650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1157650d1603SAlex Elder 1158650d1603SAlex Elder event_mask ^= BIT(evt_ring_id); 1159650d1603SAlex Elder 1160650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 1161650d1603SAlex Elder 1162650d1603SAlex Elder complete(&evt_ring->completion); 1163650d1603SAlex Elder } 1164650d1603SAlex Elder } 1165650d1603SAlex Elder 1166650d1603SAlex Elder /* Global channel error interrupt handler */ 1167650d1603SAlex Elder static void 1168650d1603SAlex Elder gsi_isr_glob_chan_err(struct gsi *gsi, u32 err_ee, u32 channel_id, u32 code) 1169650d1603SAlex Elder { 11707b0ac8f6SAlex Elder if (code == GSI_OUT_OF_RESOURCES) { 1171650d1603SAlex Elder dev_err(gsi->dev, "channel %u out of resources\n", channel_id); 1172650d1603SAlex Elder complete(&gsi->channel[channel_id].completion); 1173650d1603SAlex Elder return; 1174650d1603SAlex Elder } 1175650d1603SAlex Elder 1176650d1603SAlex Elder /* Report, but otherwise ignore all other error codes */ 1177650d1603SAlex Elder dev_err(gsi->dev, "channel %u global error ee 0x%08x code 0x%08x\n", 1178650d1603SAlex Elder channel_id, err_ee, code); 1179650d1603SAlex Elder } 1180650d1603SAlex Elder 1181650d1603SAlex Elder /* Global event error interrupt handler */ 1182650d1603SAlex Elder static void 1183650d1603SAlex Elder gsi_isr_glob_evt_err(struct gsi *gsi, u32 err_ee, u32 evt_ring_id, u32 code) 1184650d1603SAlex Elder { 11857b0ac8f6SAlex Elder if (code == GSI_OUT_OF_RESOURCES) { 1186650d1603SAlex Elder struct gsi_evt_ring *evt_ring = &gsi->evt_ring[evt_ring_id]; 1187650d1603SAlex Elder u32 channel_id = gsi_channel_id(evt_ring->channel); 1188650d1603SAlex Elder 1189650d1603SAlex Elder complete(&evt_ring->completion); 1190650d1603SAlex Elder dev_err(gsi->dev, "evt_ring for channel %u out of resources\n", 1191650d1603SAlex Elder channel_id); 1192650d1603SAlex Elder return; 1193650d1603SAlex Elder } 1194650d1603SAlex Elder 1195650d1603SAlex Elder /* Report, but otherwise ignore all other error codes */ 1196650d1603SAlex Elder dev_err(gsi->dev, "event ring %u global error ee %u code 0x%08x\n", 1197650d1603SAlex Elder evt_ring_id, err_ee, code); 1198650d1603SAlex Elder } 1199650d1603SAlex Elder 1200650d1603SAlex Elder /* Global error interrupt handler */ 1201650d1603SAlex Elder static void gsi_isr_glob_err(struct gsi *gsi) 1202650d1603SAlex Elder { 1203650d1603SAlex Elder enum gsi_err_type type; 1204650d1603SAlex Elder enum gsi_err_code code; 1205650d1603SAlex Elder u32 which; 1206650d1603SAlex Elder u32 val; 1207650d1603SAlex Elder u32 ee; 1208650d1603SAlex Elder 1209650d1603SAlex Elder /* Get the logged error, then reinitialize the log */ 1210650d1603SAlex Elder val = ioread32(gsi->virt + GSI_ERROR_LOG_OFFSET); 1211650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_ERROR_LOG_OFFSET); 1212650d1603SAlex Elder iowrite32(~0, gsi->virt + GSI_ERROR_LOG_CLR_OFFSET); 1213650d1603SAlex Elder 1214650d1603SAlex Elder ee = u32_get_bits(val, ERR_EE_FMASK); 1215650d1603SAlex Elder type = u32_get_bits(val, ERR_TYPE_FMASK); 1216d6c9e3f5SAlex Elder which = u32_get_bits(val, ERR_VIRT_IDX_FMASK); 1217650d1603SAlex Elder code = u32_get_bits(val, ERR_CODE_FMASK); 1218650d1603SAlex Elder 1219650d1603SAlex Elder if (type == GSI_ERR_TYPE_CHAN) 1220650d1603SAlex Elder gsi_isr_glob_chan_err(gsi, ee, which, code); 1221650d1603SAlex Elder else if (type == GSI_ERR_TYPE_EVT) 1222650d1603SAlex Elder gsi_isr_glob_evt_err(gsi, ee, which, code); 1223650d1603SAlex Elder else /* type GSI_ERR_TYPE_GLOB should be fatal */ 1224650d1603SAlex Elder dev_err(gsi->dev, "unexpected global error 0x%08x\n", type); 1225650d1603SAlex Elder } 1226650d1603SAlex Elder 1227650d1603SAlex Elder /* Generic EE interrupt handler */ 1228650d1603SAlex Elder static void gsi_isr_gp_int1(struct gsi *gsi) 1229650d1603SAlex Elder { 1230650d1603SAlex Elder u32 result; 1231650d1603SAlex Elder u32 val; 1232650d1603SAlex Elder 1233f849afccSAlex Elder /* This interrupt is used to handle completions of the two GENERIC 1234f849afccSAlex Elder * GSI commands. We use these to allocate and halt channels on 1235f849afccSAlex Elder * the modem's behalf due to a hardware quirk on IPA v4.2. Once 1236f849afccSAlex Elder * allocated, the modem "owns" these channels, and as a result we 1237f849afccSAlex Elder * have no way of knowing the channel's state at any given time. 1238f849afccSAlex Elder * 1239f849afccSAlex Elder * It is recommended that we halt the modem channels we allocated 1240f849afccSAlex Elder * when shutting down, but it's possible the channel isn't running 1241f849afccSAlex Elder * at the time we issue the HALT command. We'll get an error in 1242f849afccSAlex Elder * that case, but it's harmless (the channel is already halted). 1243f849afccSAlex Elder * 1244f849afccSAlex Elder * For this reason, we silently ignore a CHANNEL_NOT_RUNNING error 1245f849afccSAlex Elder * if we receive it. 1246f849afccSAlex Elder */ 1247650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 1248650d1603SAlex Elder result = u32_get_bits(val, GENERIC_EE_RESULT_FMASK); 1249f849afccSAlex Elder 1250f849afccSAlex Elder switch (result) { 1251f849afccSAlex Elder case GENERIC_EE_SUCCESS: 1252f849afccSAlex Elder case GENERIC_EE_CHANNEL_NOT_RUNNING: 125311361456SAlex Elder gsi->result = 0; 125411361456SAlex Elder break; 125511361456SAlex Elder 125611361456SAlex Elder case GENERIC_EE_RETRY: 125711361456SAlex Elder gsi->result = -EAGAIN; 1258f849afccSAlex Elder break; 1259f849afccSAlex Elder 1260f849afccSAlex Elder default: 1261650d1603SAlex Elder dev_err(gsi->dev, "global INT1 generic result %u\n", result); 126211361456SAlex Elder gsi->result = -EIO; 1263f849afccSAlex Elder break; 1264f849afccSAlex Elder } 1265650d1603SAlex Elder 1266650d1603SAlex Elder complete(&gsi->completion); 1267650d1603SAlex Elder } 12680b1ba18aSAlex Elder 1269650d1603SAlex Elder /* Inter-EE interrupt handler */ 1270650d1603SAlex Elder static void gsi_isr_glob_ee(struct gsi *gsi) 1271650d1603SAlex Elder { 1272650d1603SAlex Elder u32 val; 1273650d1603SAlex Elder 1274650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_GLOB_IRQ_STTS_OFFSET); 1275650d1603SAlex Elder 12766c6358ccSAlex Elder if (val & BIT(ERROR_INT)) 1277650d1603SAlex Elder gsi_isr_glob_err(gsi); 1278650d1603SAlex Elder 1279650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GLOB_IRQ_CLR_OFFSET); 1280650d1603SAlex Elder 12816c6358ccSAlex Elder val &= ~BIT(ERROR_INT); 1282650d1603SAlex Elder 12836c6358ccSAlex Elder if (val & BIT(GP_INT1)) { 12846c6358ccSAlex Elder val ^= BIT(GP_INT1); 1285650d1603SAlex Elder gsi_isr_gp_int1(gsi); 1286650d1603SAlex Elder } 1287650d1603SAlex Elder 1288650d1603SAlex Elder if (val) 1289650d1603SAlex Elder dev_err(gsi->dev, "unexpected global interrupt 0x%08x\n", val); 1290650d1603SAlex Elder } 1291650d1603SAlex Elder 1292650d1603SAlex Elder /* I/O completion interrupt event */ 1293650d1603SAlex Elder static void gsi_isr_ieob(struct gsi *gsi) 1294650d1603SAlex Elder { 1295650d1603SAlex Elder u32 event_mask; 1296650d1603SAlex Elder 1297650d1603SAlex Elder event_mask = ioread32(gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_OFFSET); 12987bd9785fSAlex Elder gsi_irq_ieob_disable(gsi, event_mask); 1299195ef57fSAlex Elder iowrite32(event_mask, gsi->virt + GSI_CNTXT_SRC_IEOB_IRQ_CLR_OFFSET); 1300650d1603SAlex Elder 1301650d1603SAlex Elder while (event_mask) { 1302650d1603SAlex Elder u32 evt_ring_id = __ffs(event_mask); 1303650d1603SAlex Elder 1304650d1603SAlex Elder event_mask ^= BIT(evt_ring_id); 1305650d1603SAlex Elder 1306650d1603SAlex Elder napi_schedule(&gsi->evt_ring[evt_ring_id].channel->napi); 1307650d1603SAlex Elder } 1308650d1603SAlex Elder } 1309650d1603SAlex Elder 1310650d1603SAlex Elder /* General event interrupts represent serious problems, so report them */ 1311650d1603SAlex Elder static void gsi_isr_general(struct gsi *gsi) 1312650d1603SAlex Elder { 1313650d1603SAlex Elder struct device *dev = gsi->dev; 1314650d1603SAlex Elder u32 val; 1315650d1603SAlex Elder 1316650d1603SAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_GSI_IRQ_STTS_OFFSET); 1317650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GSI_IRQ_CLR_OFFSET); 1318650d1603SAlex Elder 1319650d1603SAlex Elder dev_err(dev, "unexpected general interrupt 0x%08x\n", val); 1320650d1603SAlex Elder } 1321650d1603SAlex Elder 1322650d1603SAlex Elder /** 1323650d1603SAlex Elder * gsi_isr() - Top level GSI interrupt service routine 1324650d1603SAlex Elder * @irq: Interrupt number (ignored) 1325650d1603SAlex Elder * @dev_id: GSI pointer supplied to request_irq() 1326650d1603SAlex Elder * 1327650d1603SAlex Elder * This is the main handler function registered for the GSI IRQ. Each type 1328650d1603SAlex Elder * of interrupt has a separate handler function that is called from here. 1329650d1603SAlex Elder */ 1330650d1603SAlex Elder static irqreturn_t gsi_isr(int irq, void *dev_id) 1331650d1603SAlex Elder { 1332650d1603SAlex Elder struct gsi *gsi = dev_id; 1333650d1603SAlex Elder u32 intr_mask; 1334650d1603SAlex Elder u32 cnt = 0; 1335650d1603SAlex Elder 1336f9b28804SAlex Elder /* enum gsi_irq_type_id defines GSI interrupt types */ 1337650d1603SAlex Elder while ((intr_mask = ioread32(gsi->virt + GSI_CNTXT_TYPE_IRQ_OFFSET))) { 1338650d1603SAlex Elder /* intr_mask contains bitmask of pending GSI interrupts */ 1339650d1603SAlex Elder do { 1340650d1603SAlex Elder u32 gsi_intr = BIT(__ffs(intr_mask)); 1341650d1603SAlex Elder 1342650d1603SAlex Elder intr_mask ^= gsi_intr; 1343650d1603SAlex Elder 1344650d1603SAlex Elder switch (gsi_intr) { 1345f9b28804SAlex Elder case BIT(GSI_CH_CTRL): 1346650d1603SAlex Elder gsi_isr_chan_ctrl(gsi); 1347650d1603SAlex Elder break; 1348f9b28804SAlex Elder case BIT(GSI_EV_CTRL): 1349650d1603SAlex Elder gsi_isr_evt_ctrl(gsi); 1350650d1603SAlex Elder break; 1351f9b28804SAlex Elder case BIT(GSI_GLOB_EE): 1352650d1603SAlex Elder gsi_isr_glob_ee(gsi); 1353650d1603SAlex Elder break; 1354f9b28804SAlex Elder case BIT(GSI_IEOB): 1355650d1603SAlex Elder gsi_isr_ieob(gsi); 1356650d1603SAlex Elder break; 1357f9b28804SAlex Elder case BIT(GSI_GENERAL): 1358650d1603SAlex Elder gsi_isr_general(gsi); 1359650d1603SAlex Elder break; 1360650d1603SAlex Elder default: 1361650d1603SAlex Elder dev_err(gsi->dev, 13628463488aSAlex Elder "unrecognized interrupt type 0x%08x\n", 13638463488aSAlex Elder gsi_intr); 1364650d1603SAlex Elder break; 1365650d1603SAlex Elder } 1366650d1603SAlex Elder } while (intr_mask); 1367650d1603SAlex Elder 1368650d1603SAlex Elder if (++cnt > GSI_ISR_MAX_ITER) { 1369650d1603SAlex Elder dev_err(gsi->dev, "interrupt flood\n"); 1370650d1603SAlex Elder break; 1371650d1603SAlex Elder } 1372650d1603SAlex Elder } 1373650d1603SAlex Elder 1374650d1603SAlex Elder return IRQ_HANDLED; 1375650d1603SAlex Elder } 1376650d1603SAlex Elder 13770b8d6761SAlex Elder static int gsi_irq_init(struct gsi *gsi, struct platform_device *pdev) 13780b8d6761SAlex Elder { 13790b8d6761SAlex Elder struct device *dev = &pdev->dev; 13800b8d6761SAlex Elder unsigned int irq; 13810b8d6761SAlex Elder int ret; 13820b8d6761SAlex Elder 13830b8d6761SAlex Elder ret = platform_get_irq_byname(pdev, "gsi"); 138491306d1dSZihao Tang if (ret <= 0) 13850b8d6761SAlex Elder return ret ? : -EINVAL; 138691306d1dSZihao Tang 13870b8d6761SAlex Elder irq = ret; 13880b8d6761SAlex Elder 13890b8d6761SAlex Elder ret = request_irq(irq, gsi_isr, 0, "gsi", gsi); 13900b8d6761SAlex Elder if (ret) { 13910b8d6761SAlex Elder dev_err(dev, "error %d requesting \"gsi\" IRQ\n", ret); 13920b8d6761SAlex Elder return ret; 13930b8d6761SAlex Elder } 13940b8d6761SAlex Elder gsi->irq = irq; 13950b8d6761SAlex Elder 13960b8d6761SAlex Elder return 0; 13970b8d6761SAlex Elder } 13980b8d6761SAlex Elder 13990b8d6761SAlex Elder static void gsi_irq_exit(struct gsi *gsi) 14000b8d6761SAlex Elder { 14010b8d6761SAlex Elder free_irq(gsi->irq, gsi); 14020b8d6761SAlex Elder } 14030b8d6761SAlex Elder 1404650d1603SAlex Elder /* Return the transaction associated with a transfer completion event */ 1405650d1603SAlex Elder static struct gsi_trans *gsi_event_trans(struct gsi_channel *channel, 1406650d1603SAlex Elder struct gsi_event *event) 1407650d1603SAlex Elder { 1408650d1603SAlex Elder u32 tre_offset; 1409650d1603SAlex Elder u32 tre_index; 1410650d1603SAlex Elder 1411650d1603SAlex Elder /* Event xfer_ptr records the TRE it's associated with */ 14123c54b7beSAlex Elder tre_offset = lower_32_bits(le64_to_cpu(event->xfer_ptr)); 1413650d1603SAlex Elder tre_index = gsi_ring_index(&channel->tre_ring, tre_offset); 1414650d1603SAlex Elder 1415650d1603SAlex Elder return gsi_channel_trans_mapped(channel, tre_index); 1416650d1603SAlex Elder } 1417650d1603SAlex Elder 1418650d1603SAlex Elder /** 1419650d1603SAlex Elder * gsi_evt_ring_rx_update() - Record lengths of received data 1420650d1603SAlex Elder * @evt_ring: Event ring associated with channel that received packets 1421650d1603SAlex Elder * @index: Event index in ring reported by hardware 1422650d1603SAlex Elder * 1423650d1603SAlex Elder * Events for RX channels contain the actual number of bytes received into 1424650d1603SAlex Elder * the buffer. Every event has a transaction associated with it, and here 1425650d1603SAlex Elder * we update transactions to record their actual received lengths. 1426650d1603SAlex Elder * 1427650d1603SAlex Elder * This function is called whenever we learn that the GSI hardware has filled 1428650d1603SAlex Elder * new events since the last time we checked. The ring's index field tells 1429650d1603SAlex Elder * the first entry in need of processing. The index provided is the 1430650d1603SAlex Elder * first *unfilled* event in the ring (following the last filled one). 1431650d1603SAlex Elder * 1432650d1603SAlex Elder * Events are sequential within the event ring, and transactions are 1433650d1603SAlex Elder * sequential within the transaction pool. 1434650d1603SAlex Elder * 1435650d1603SAlex Elder * Note that @index always refers to an element *within* the event ring. 1436650d1603SAlex Elder */ 1437650d1603SAlex Elder static void gsi_evt_ring_rx_update(struct gsi_evt_ring *evt_ring, u32 index) 1438650d1603SAlex Elder { 1439650d1603SAlex Elder struct gsi_channel *channel = evt_ring->channel; 1440650d1603SAlex Elder struct gsi_ring *ring = &evt_ring->ring; 1441650d1603SAlex Elder struct gsi_trans_info *trans_info; 1442650d1603SAlex Elder struct gsi_event *event_done; 1443650d1603SAlex Elder struct gsi_event *event; 1444650d1603SAlex Elder struct gsi_trans *trans; 1445650d1603SAlex Elder u32 byte_count = 0; 1446650d1603SAlex Elder u32 old_index; 1447650d1603SAlex Elder u32 event_avail; 1448650d1603SAlex Elder 1449650d1603SAlex Elder trans_info = &channel->trans_info; 1450650d1603SAlex Elder 1451650d1603SAlex Elder /* We'll start with the oldest un-processed event. RX channels 1452650d1603SAlex Elder * replenish receive buffers in single-TRE transactions, so we 1453650d1603SAlex Elder * can just map that event to its transaction. Transactions 1454650d1603SAlex Elder * associated with completion events are consecutive. 1455650d1603SAlex Elder */ 1456650d1603SAlex Elder old_index = ring->index; 1457650d1603SAlex Elder event = gsi_ring_virt(ring, old_index); 1458650d1603SAlex Elder trans = gsi_event_trans(channel, event); 1459650d1603SAlex Elder 1460650d1603SAlex Elder /* Compute the number of events to process before we wrap, 1461650d1603SAlex Elder * and determine when we'll be done processing events. 1462650d1603SAlex Elder */ 1463650d1603SAlex Elder event_avail = ring->count - old_index % ring->count; 1464650d1603SAlex Elder event_done = gsi_ring_virt(ring, index); 1465650d1603SAlex Elder do { 1466650d1603SAlex Elder trans->len = __le16_to_cpu(event->len); 1467650d1603SAlex Elder byte_count += trans->len; 1468650d1603SAlex Elder 1469650d1603SAlex Elder /* Move on to the next event and transaction */ 1470650d1603SAlex Elder if (--event_avail) 1471650d1603SAlex Elder event++; 1472650d1603SAlex Elder else 1473650d1603SAlex Elder event = gsi_ring_virt(ring, 0); 1474650d1603SAlex Elder trans = gsi_trans_pool_next(&trans_info->pool, trans); 1475650d1603SAlex Elder } while (event != event_done); 1476650d1603SAlex Elder 1477650d1603SAlex Elder /* We record RX bytes when they are received */ 1478650d1603SAlex Elder channel->byte_count += byte_count; 1479650d1603SAlex Elder channel->trans_count++; 1480650d1603SAlex Elder } 1481650d1603SAlex Elder 1482650d1603SAlex Elder /* Initialize a ring, including allocating DMA memory for its entries */ 1483650d1603SAlex Elder static int gsi_ring_alloc(struct gsi *gsi, struct gsi_ring *ring, u32 count) 1484650d1603SAlex Elder { 1485437c78f9SAlex Elder u32 size = count * GSI_RING_ELEMENT_SIZE; 1486650d1603SAlex Elder struct device *dev = gsi->dev; 1487650d1603SAlex Elder dma_addr_t addr; 1488650d1603SAlex Elder 1489437c78f9SAlex Elder /* Hardware requires a 2^n ring size, with alignment equal to size. 149019aaf72cSAlex Elder * The DMA address returned by dma_alloc_coherent() is guaranteed to 149119aaf72cSAlex Elder * be a power-of-2 number of pages, which satisfies the requirement. 1492437c78f9SAlex Elder */ 1493650d1603SAlex Elder ring->virt = dma_alloc_coherent(dev, size, &addr, GFP_KERNEL); 149419aaf72cSAlex Elder if (!ring->virt) 1495650d1603SAlex Elder return -ENOMEM; 149619aaf72cSAlex Elder 1497650d1603SAlex Elder ring->addr = addr; 1498650d1603SAlex Elder ring->count = count; 1499650d1603SAlex Elder 1500650d1603SAlex Elder return 0; 1501650d1603SAlex Elder } 1502650d1603SAlex Elder 1503650d1603SAlex Elder /* Free a previously-allocated ring */ 1504650d1603SAlex Elder static void gsi_ring_free(struct gsi *gsi, struct gsi_ring *ring) 1505650d1603SAlex Elder { 1506650d1603SAlex Elder size_t size = ring->count * GSI_RING_ELEMENT_SIZE; 1507650d1603SAlex Elder 1508650d1603SAlex Elder dma_free_coherent(gsi->dev, size, ring->virt, ring->addr); 1509650d1603SAlex Elder } 1510650d1603SAlex Elder 1511650d1603SAlex Elder /* Allocate an available event ring id */ 1512650d1603SAlex Elder static int gsi_evt_ring_id_alloc(struct gsi *gsi) 1513650d1603SAlex Elder { 1514650d1603SAlex Elder u32 evt_ring_id; 1515650d1603SAlex Elder 1516650d1603SAlex Elder if (gsi->event_bitmap == ~0U) { 1517650d1603SAlex Elder dev_err(gsi->dev, "event rings exhausted\n"); 1518650d1603SAlex Elder return -ENOSPC; 1519650d1603SAlex Elder } 1520650d1603SAlex Elder 1521650d1603SAlex Elder evt_ring_id = ffz(gsi->event_bitmap); 1522650d1603SAlex Elder gsi->event_bitmap |= BIT(evt_ring_id); 1523650d1603SAlex Elder 1524650d1603SAlex Elder return (int)evt_ring_id; 1525650d1603SAlex Elder } 1526650d1603SAlex Elder 1527650d1603SAlex Elder /* Free a previously-allocated event ring id */ 1528650d1603SAlex Elder static void gsi_evt_ring_id_free(struct gsi *gsi, u32 evt_ring_id) 1529650d1603SAlex Elder { 1530650d1603SAlex Elder gsi->event_bitmap &= ~BIT(evt_ring_id); 1531650d1603SAlex Elder } 1532650d1603SAlex Elder 1533650d1603SAlex Elder /* Ring a channel doorbell, reporting the first un-filled entry */ 1534650d1603SAlex Elder void gsi_channel_doorbell(struct gsi_channel *channel) 1535650d1603SAlex Elder { 1536650d1603SAlex Elder struct gsi_ring *tre_ring = &channel->tre_ring; 1537650d1603SAlex Elder u32 channel_id = gsi_channel_id(channel); 1538650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1539650d1603SAlex Elder u32 val; 1540650d1603SAlex Elder 1541650d1603SAlex Elder /* Note: index *must* be used modulo the ring count here */ 1542650d1603SAlex Elder val = gsi_ring_addr(tre_ring, tre_ring->index % tre_ring->count); 1543650d1603SAlex Elder iowrite32(val, gsi->virt + GSI_CH_C_DOORBELL_0_OFFSET(channel_id)); 1544650d1603SAlex Elder } 1545650d1603SAlex Elder 1546650d1603SAlex Elder /* Consult hardware, move any newly completed transactions to completed list */ 1547223f5b34SAlex Elder static struct gsi_trans *gsi_channel_update(struct gsi_channel *channel) 1548650d1603SAlex Elder { 1549650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1550650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1551650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1552650d1603SAlex Elder struct gsi_trans *trans; 1553650d1603SAlex Elder struct gsi_ring *ring; 1554650d1603SAlex Elder u32 offset; 1555650d1603SAlex Elder u32 index; 1556650d1603SAlex Elder 1557650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 1558650d1603SAlex Elder ring = &evt_ring->ring; 1559650d1603SAlex Elder 1560650d1603SAlex Elder /* See if there's anything new to process; if not, we're done. Note 1561650d1603SAlex Elder * that index always refers to an entry *within* the event ring. 1562650d1603SAlex Elder */ 1563650d1603SAlex Elder offset = GSI_EV_CH_E_CNTXT_4_OFFSET(evt_ring_id); 1564650d1603SAlex Elder index = gsi_ring_index(ring, ioread32(gsi->virt + offset)); 1565650d1603SAlex Elder if (index == ring->index % ring->count) 1566223f5b34SAlex Elder return NULL; 1567650d1603SAlex Elder 1568650d1603SAlex Elder /* Get the transaction for the latest completed event. Take a 1569650d1603SAlex Elder * reference to keep it from completing before we give the events 1570650d1603SAlex Elder * for this and previous transactions back to the hardware. 1571650d1603SAlex Elder */ 1572650d1603SAlex Elder trans = gsi_event_trans(channel, gsi_ring_virt(ring, index - 1)); 1573650d1603SAlex Elder refcount_inc(&trans->refcount); 1574650d1603SAlex Elder 1575650d1603SAlex Elder /* For RX channels, update each completed transaction with the number 1576650d1603SAlex Elder * of bytes that were actually received. For TX channels, report 1577650d1603SAlex Elder * the number of transactions and bytes this completion represents 1578650d1603SAlex Elder * up the network stack. 1579650d1603SAlex Elder */ 1580650d1603SAlex Elder if (channel->toward_ipa) 1581650d1603SAlex Elder gsi_channel_tx_update(channel, trans); 1582650d1603SAlex Elder else 1583650d1603SAlex Elder gsi_evt_ring_rx_update(evt_ring, index); 1584650d1603SAlex Elder 1585650d1603SAlex Elder gsi_trans_move_complete(trans); 1586650d1603SAlex Elder 1587650d1603SAlex Elder /* Tell the hardware we've handled these events */ 1588650d1603SAlex Elder gsi_evt_ring_doorbell(channel->gsi, channel->evt_ring_id, index); 1589650d1603SAlex Elder 1590650d1603SAlex Elder gsi_trans_free(trans); 1591223f5b34SAlex Elder 1592223f5b34SAlex Elder return gsi_channel_trans_complete(channel); 1593650d1603SAlex Elder } 1594650d1603SAlex Elder 1595650d1603SAlex Elder /** 1596650d1603SAlex Elder * gsi_channel_poll_one() - Return a single completed transaction on a channel 1597650d1603SAlex Elder * @channel: Channel to be polled 1598650d1603SAlex Elder * 1599e3eea08eSAlex Elder * Return: Transaction pointer, or null if none are available 1600650d1603SAlex Elder * 1601650d1603SAlex Elder * This function returns the first entry on a channel's completed transaction 1602650d1603SAlex Elder * list. If that list is empty, the hardware is consulted to determine 1603650d1603SAlex Elder * whether any new transactions have completed. If so, they're moved to the 1604650d1603SAlex Elder * completed list and the new first entry is returned. If there are no more 1605650d1603SAlex Elder * completed transactions, a null pointer is returned. 1606650d1603SAlex Elder */ 1607650d1603SAlex Elder static struct gsi_trans *gsi_channel_poll_one(struct gsi_channel *channel) 1608650d1603SAlex Elder { 1609650d1603SAlex Elder struct gsi_trans *trans; 1610650d1603SAlex Elder 1611650d1603SAlex Elder /* Get the first transaction from the completed list */ 1612650d1603SAlex Elder trans = gsi_channel_trans_complete(channel); 1613223f5b34SAlex Elder if (!trans) /* List is empty; see if there's more to do */ 1614223f5b34SAlex Elder trans = gsi_channel_update(channel); 1615650d1603SAlex Elder 1616650d1603SAlex Elder if (trans) 1617650d1603SAlex Elder gsi_trans_move_polled(trans); 1618650d1603SAlex Elder 1619650d1603SAlex Elder return trans; 1620650d1603SAlex Elder } 1621650d1603SAlex Elder 1622650d1603SAlex Elder /** 1623650d1603SAlex Elder * gsi_channel_poll() - NAPI poll function for a channel 1624650d1603SAlex Elder * @napi: NAPI structure for the channel 1625650d1603SAlex Elder * @budget: Budget supplied by NAPI core 1626e3eea08eSAlex Elder * 1627e3eea08eSAlex Elder * Return: Number of items polled (<= budget) 1628650d1603SAlex Elder * 1629650d1603SAlex Elder * Single transactions completed by hardware are polled until either 1630650d1603SAlex Elder * the budget is exhausted, or there are no more. Each transaction 1631650d1603SAlex Elder * polled is passed to gsi_trans_complete(), to perform remaining 1632650d1603SAlex Elder * completion processing and retire/free the transaction. 1633650d1603SAlex Elder */ 1634650d1603SAlex Elder static int gsi_channel_poll(struct napi_struct *napi, int budget) 1635650d1603SAlex Elder { 1636650d1603SAlex Elder struct gsi_channel *channel; 1637c80c4a1eSAlex Elder int count; 1638650d1603SAlex Elder 1639650d1603SAlex Elder channel = container_of(napi, struct gsi_channel, napi); 1640c80c4a1eSAlex Elder for (count = 0; count < budget; count++) { 1641650d1603SAlex Elder struct gsi_trans *trans; 1642650d1603SAlex Elder 1643650d1603SAlex Elder trans = gsi_channel_poll_one(channel); 1644650d1603SAlex Elder if (!trans) 1645650d1603SAlex Elder break; 1646650d1603SAlex Elder gsi_trans_complete(trans); 1647650d1603SAlex Elder } 1648650d1603SAlex Elder 1649148604e7SAlex Elder if (count < budget && napi_complete(napi)) 16505725593eSAlex Elder gsi_irq_ieob_enable_one(channel->gsi, channel->evt_ring_id); 1651650d1603SAlex Elder 1652650d1603SAlex Elder return count; 1653650d1603SAlex Elder } 1654650d1603SAlex Elder 1655650d1603SAlex Elder /* The event bitmap represents which event ids are available for allocation. 1656650d1603SAlex Elder * Set bits are not available, clear bits can be used. This function 1657650d1603SAlex Elder * initializes the map so all events supported by the hardware are available, 1658650d1603SAlex Elder * then precludes any reserved events from being allocated. 1659650d1603SAlex Elder */ 1660650d1603SAlex Elder static u32 gsi_event_bitmap_init(u32 evt_ring_max) 1661650d1603SAlex Elder { 1662650d1603SAlex Elder u32 event_bitmap = GENMASK(BITS_PER_LONG - 1, evt_ring_max); 1663650d1603SAlex Elder 1664650d1603SAlex Elder event_bitmap |= GENMASK(GSI_MHI_EVENT_ID_END, GSI_MHI_EVENT_ID_START); 1665650d1603SAlex Elder 1666650d1603SAlex Elder return event_bitmap; 1667650d1603SAlex Elder } 1668650d1603SAlex Elder 1669650d1603SAlex Elder /* Setup function for a single channel */ 1670d387c761SAlex Elder static int gsi_channel_setup_one(struct gsi *gsi, u32 channel_id) 1671650d1603SAlex Elder { 1672650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1673650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1674650d1603SAlex Elder int ret; 1675650d1603SAlex Elder 16766170b6daSAlex Elder if (!gsi_channel_initialized(channel)) 16776170b6daSAlex Elder return 0; 1678650d1603SAlex Elder 1679650d1603SAlex Elder ret = gsi_evt_ring_alloc_command(gsi, evt_ring_id); 1680650d1603SAlex Elder if (ret) 1681650d1603SAlex Elder return ret; 1682650d1603SAlex Elder 1683650d1603SAlex Elder gsi_evt_ring_program(gsi, evt_ring_id); 1684650d1603SAlex Elder 1685650d1603SAlex Elder ret = gsi_channel_alloc_command(gsi, channel_id); 1686650d1603SAlex Elder if (ret) 1687650d1603SAlex Elder goto err_evt_ring_de_alloc; 1688650d1603SAlex Elder 1689d387c761SAlex Elder gsi_channel_program(channel, true); 1690650d1603SAlex Elder 1691650d1603SAlex Elder if (channel->toward_ipa) 1692650d1603SAlex Elder netif_tx_napi_add(&gsi->dummy_dev, &channel->napi, 1693650d1603SAlex Elder gsi_channel_poll, NAPI_POLL_WEIGHT); 1694650d1603SAlex Elder else 1695650d1603SAlex Elder netif_napi_add(&gsi->dummy_dev, &channel->napi, 1696650d1603SAlex Elder gsi_channel_poll, NAPI_POLL_WEIGHT); 1697650d1603SAlex Elder 1698650d1603SAlex Elder return 0; 1699650d1603SAlex Elder 1700650d1603SAlex Elder err_evt_ring_de_alloc: 1701650d1603SAlex Elder /* We've done nothing with the event ring yet so don't reset */ 1702650d1603SAlex Elder gsi_evt_ring_de_alloc_command(gsi, evt_ring_id); 1703650d1603SAlex Elder 1704650d1603SAlex Elder return ret; 1705650d1603SAlex Elder } 1706650d1603SAlex Elder 1707650d1603SAlex Elder /* Inverse of gsi_channel_setup_one() */ 1708650d1603SAlex Elder static void gsi_channel_teardown_one(struct gsi *gsi, u32 channel_id) 1709650d1603SAlex Elder { 1710650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 1711650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1712650d1603SAlex Elder 17136170b6daSAlex Elder if (!gsi_channel_initialized(channel)) 17146170b6daSAlex Elder return; 1715650d1603SAlex Elder 1716650d1603SAlex Elder netif_napi_del(&channel->napi); 1717650d1603SAlex Elder 1718650d1603SAlex Elder gsi_channel_de_alloc_command(gsi, channel_id); 1719650d1603SAlex Elder gsi_evt_ring_reset_command(gsi, evt_ring_id); 1720650d1603SAlex Elder gsi_evt_ring_de_alloc_command(gsi, evt_ring_id); 1721650d1603SAlex Elder } 1722650d1603SAlex Elder 1723650d1603SAlex Elder static int gsi_generic_command(struct gsi *gsi, u32 channel_id, 1724650d1603SAlex Elder enum gsi_generic_cmd_opcode opcode) 1725650d1603SAlex Elder { 1726650d1603SAlex Elder struct completion *completion = &gsi->completion; 1727d9cbe818SAlex Elder bool timeout; 1728650d1603SAlex Elder u32 val; 1729650d1603SAlex Elder 1730d6c9e3f5SAlex Elder /* The error global interrupt type is always enabled (until we 1731d6c9e3f5SAlex Elder * teardown), so we won't change that. A generic EE command 1732d6c9e3f5SAlex Elder * completes with a GSI global interrupt of type GP_INT1. We 1733d6c9e3f5SAlex Elder * only perform one generic command at a time (to allocate or 1734d6c9e3f5SAlex Elder * halt a modem channel) and only from this function. So we 1735d6c9e3f5SAlex Elder * enable the GP_INT1 IRQ type here while we're expecting it. 1736d6c9e3f5SAlex Elder */ 17376c6358ccSAlex Elder val = BIT(ERROR_INT) | BIT(GP_INT1); 1738d6c9e3f5SAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 1739d6c9e3f5SAlex Elder 17400b1ba18aSAlex Elder /* First zero the result code field */ 17410b1ba18aSAlex Elder val = ioread32(gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 17420b1ba18aSAlex Elder val &= ~GENERIC_EE_RESULT_FMASK; 17430b1ba18aSAlex Elder iowrite32(val, gsi->virt + GSI_CNTXT_SCRATCH_0_OFFSET); 17440b1ba18aSAlex Elder 17450b1ba18aSAlex Elder /* Now issue the command */ 1746650d1603SAlex Elder val = u32_encode_bits(opcode, GENERIC_OPCODE_FMASK); 1747650d1603SAlex Elder val |= u32_encode_bits(channel_id, GENERIC_CHID_FMASK); 1748650d1603SAlex Elder val |= u32_encode_bits(GSI_EE_MODEM, GENERIC_EE_FMASK); 1749650d1603SAlex Elder 1750d9cbe818SAlex Elder timeout = !gsi_command(gsi, GSI_GENERIC_CMD_OFFSET, val, completion); 1751d6c9e3f5SAlex Elder 1752d6c9e3f5SAlex Elder /* Disable the GP_INT1 IRQ type again */ 17536c6358ccSAlex Elder iowrite32(BIT(ERROR_INT), gsi->virt + GSI_CNTXT_GLOB_IRQ_EN_OFFSET); 1754d6c9e3f5SAlex Elder 1755d9cbe818SAlex Elder if (!timeout) 175611361456SAlex Elder return gsi->result; 1757650d1603SAlex Elder 1758650d1603SAlex Elder dev_err(gsi->dev, "GSI generic command %u to channel %u timed out\n", 1759650d1603SAlex Elder opcode, channel_id); 1760650d1603SAlex Elder 1761650d1603SAlex Elder return -ETIMEDOUT; 1762650d1603SAlex Elder } 1763650d1603SAlex Elder 1764650d1603SAlex Elder static int gsi_modem_channel_alloc(struct gsi *gsi, u32 channel_id) 1765650d1603SAlex Elder { 1766650d1603SAlex Elder return gsi_generic_command(gsi, channel_id, 1767650d1603SAlex Elder GSI_GENERIC_ALLOCATE_CHANNEL); 1768650d1603SAlex Elder } 1769650d1603SAlex Elder 1770650d1603SAlex Elder static void gsi_modem_channel_halt(struct gsi *gsi, u32 channel_id) 1771650d1603SAlex Elder { 177211361456SAlex Elder u32 retries = GSI_CHANNEL_MODEM_HALT_RETRIES; 177311361456SAlex Elder int ret; 177411361456SAlex Elder 177511361456SAlex Elder do 177611361456SAlex Elder ret = gsi_generic_command(gsi, channel_id, 177711361456SAlex Elder GSI_GENERIC_HALT_CHANNEL); 177811361456SAlex Elder while (ret == -EAGAIN && retries--); 177911361456SAlex Elder 178011361456SAlex Elder if (ret) 178111361456SAlex Elder dev_err(gsi->dev, "error %d halting modem channel %u\n", 178211361456SAlex Elder ret, channel_id); 1783650d1603SAlex Elder } 1784650d1603SAlex Elder 1785650d1603SAlex Elder /* Setup function for channels */ 1786d387c761SAlex Elder static int gsi_channel_setup(struct gsi *gsi) 1787650d1603SAlex Elder { 1788650d1603SAlex Elder u32 channel_id = 0; 1789650d1603SAlex Elder u32 mask; 1790650d1603SAlex Elder int ret; 1791650d1603SAlex Elder 1792650d1603SAlex Elder gsi_irq_enable(gsi); 1793650d1603SAlex Elder 1794650d1603SAlex Elder mutex_lock(&gsi->mutex); 1795650d1603SAlex Elder 1796650d1603SAlex Elder do { 1797d387c761SAlex Elder ret = gsi_channel_setup_one(gsi, channel_id); 1798650d1603SAlex Elder if (ret) 1799650d1603SAlex Elder goto err_unwind; 1800650d1603SAlex Elder } while (++channel_id < gsi->channel_count); 1801650d1603SAlex Elder 1802650d1603SAlex Elder /* Make sure no channels were defined that hardware does not support */ 1803650d1603SAlex Elder while (channel_id < GSI_CHANNEL_COUNT_MAX) { 1804650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id++]; 1805650d1603SAlex Elder 18066170b6daSAlex Elder if (!gsi_channel_initialized(channel)) 18076170b6daSAlex Elder continue; 1808650d1603SAlex Elder 18091d23a56bSAlex Elder ret = -EINVAL; 1810650d1603SAlex Elder dev_err(gsi->dev, "channel %u not supported by hardware\n", 1811650d1603SAlex Elder channel_id - 1); 1812650d1603SAlex Elder channel_id = gsi->channel_count; 1813650d1603SAlex Elder goto err_unwind; 1814650d1603SAlex Elder } 1815650d1603SAlex Elder 1816650d1603SAlex Elder /* Allocate modem channels if necessary */ 1817650d1603SAlex Elder mask = gsi->modem_channel_bitmap; 1818650d1603SAlex Elder while (mask) { 1819650d1603SAlex Elder u32 modem_channel_id = __ffs(mask); 1820650d1603SAlex Elder 1821650d1603SAlex Elder ret = gsi_modem_channel_alloc(gsi, modem_channel_id); 1822650d1603SAlex Elder if (ret) 1823650d1603SAlex Elder goto err_unwind_modem; 1824650d1603SAlex Elder 1825650d1603SAlex Elder /* Clear bit from mask only after success (for unwind) */ 1826650d1603SAlex Elder mask ^= BIT(modem_channel_id); 1827650d1603SAlex Elder } 1828650d1603SAlex Elder 1829650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1830650d1603SAlex Elder 1831650d1603SAlex Elder return 0; 1832650d1603SAlex Elder 1833650d1603SAlex Elder err_unwind_modem: 1834650d1603SAlex Elder /* Compute which modem channels need to be deallocated */ 1835650d1603SAlex Elder mask ^= gsi->modem_channel_bitmap; 1836650d1603SAlex Elder while (mask) { 1837993cac15SAlex Elder channel_id = __fls(mask); 1838650d1603SAlex Elder 1839650d1603SAlex Elder mask ^= BIT(channel_id); 1840650d1603SAlex Elder 1841650d1603SAlex Elder gsi_modem_channel_halt(gsi, channel_id); 1842650d1603SAlex Elder } 1843650d1603SAlex Elder 1844650d1603SAlex Elder err_unwind: 1845650d1603SAlex Elder while (channel_id--) 1846650d1603SAlex Elder gsi_channel_teardown_one(gsi, channel_id); 1847650d1603SAlex Elder 1848650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1849650d1603SAlex Elder 1850650d1603SAlex Elder gsi_irq_disable(gsi); 1851650d1603SAlex Elder 1852650d1603SAlex Elder return ret; 1853650d1603SAlex Elder } 1854650d1603SAlex Elder 1855650d1603SAlex Elder /* Inverse of gsi_channel_setup() */ 1856650d1603SAlex Elder static void gsi_channel_teardown(struct gsi *gsi) 1857650d1603SAlex Elder { 1858650d1603SAlex Elder u32 mask = gsi->modem_channel_bitmap; 1859650d1603SAlex Elder u32 channel_id; 1860650d1603SAlex Elder 1861650d1603SAlex Elder mutex_lock(&gsi->mutex); 1862650d1603SAlex Elder 1863650d1603SAlex Elder while (mask) { 1864993cac15SAlex Elder channel_id = __fls(mask); 1865650d1603SAlex Elder 1866650d1603SAlex Elder mask ^= BIT(channel_id); 1867650d1603SAlex Elder 1868650d1603SAlex Elder gsi_modem_channel_halt(gsi, channel_id); 1869650d1603SAlex Elder } 1870650d1603SAlex Elder 1871650d1603SAlex Elder channel_id = gsi->channel_count - 1; 1872650d1603SAlex Elder do 1873650d1603SAlex Elder gsi_channel_teardown_one(gsi, channel_id); 1874650d1603SAlex Elder while (channel_id--); 1875650d1603SAlex Elder 1876650d1603SAlex Elder mutex_unlock(&gsi->mutex); 1877650d1603SAlex Elder 1878650d1603SAlex Elder gsi_irq_disable(gsi); 1879650d1603SAlex Elder } 1880650d1603SAlex Elder 1881650d1603SAlex Elder /* Setup function for GSI. GSI firmware must be loaded and initialized */ 1882d387c761SAlex Elder int gsi_setup(struct gsi *gsi) 1883650d1603SAlex Elder { 1884650d1603SAlex Elder u32 val; 1885bae70a80SAlex Elder int ret; 1886650d1603SAlex Elder 1887650d1603SAlex Elder /* Here is where we first touch the GSI hardware */ 1888650d1603SAlex Elder val = ioread32(gsi->virt + GSI_GSI_STATUS_OFFSET); 1889650d1603SAlex Elder if (!(val & ENABLED_FMASK)) { 1890bae70a80SAlex Elder dev_err(gsi->dev, "GSI has not been enabled\n"); 1891650d1603SAlex Elder return -EIO; 1892650d1603SAlex Elder } 1893650d1603SAlex Elder 189457ab8ca4SAlex Elder gsi_irq_setup(gsi); /* No matching teardown required */ 189597eb94c8SAlex Elder 1896bae70a80SAlex Elder ret = gsi_ring_setup(gsi); /* No matching teardown required */ 1897bae70a80SAlex Elder if (ret) 1898bae70a80SAlex Elder return ret; 1899650d1603SAlex Elder 1900650d1603SAlex Elder /* Initialize the error log */ 1901650d1603SAlex Elder iowrite32(0, gsi->virt + GSI_ERROR_LOG_OFFSET); 1902650d1603SAlex Elder 1903650d1603SAlex Elder /* Writing 1 indicates IRQ interrupts; 0 would be MSI */ 1904650d1603SAlex Elder iowrite32(1, gsi->virt + GSI_CNTXT_INTSET_OFFSET); 1905650d1603SAlex Elder 190657ab8ca4SAlex Elder return gsi_channel_setup(gsi); 1907650d1603SAlex Elder } 1908650d1603SAlex Elder 1909650d1603SAlex Elder /* Inverse of gsi_setup() */ 1910650d1603SAlex Elder void gsi_teardown(struct gsi *gsi) 1911650d1603SAlex Elder { 1912650d1603SAlex Elder gsi_channel_teardown(gsi); 1913650d1603SAlex Elder } 1914650d1603SAlex Elder 1915650d1603SAlex Elder /* Initialize a channel's event ring */ 1916650d1603SAlex Elder static int gsi_channel_evt_ring_init(struct gsi_channel *channel) 1917650d1603SAlex Elder { 1918650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1919650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1920650d1603SAlex Elder int ret; 1921650d1603SAlex Elder 1922650d1603SAlex Elder ret = gsi_evt_ring_id_alloc(gsi); 1923650d1603SAlex Elder if (ret < 0) 1924650d1603SAlex Elder return ret; 1925650d1603SAlex Elder channel->evt_ring_id = ret; 1926650d1603SAlex Elder 1927650d1603SAlex Elder evt_ring = &gsi->evt_ring[channel->evt_ring_id]; 1928650d1603SAlex Elder evt_ring->channel = channel; 1929650d1603SAlex Elder 1930650d1603SAlex Elder ret = gsi_ring_alloc(gsi, &evt_ring->ring, channel->event_count); 1931650d1603SAlex Elder if (!ret) 1932650d1603SAlex Elder return 0; /* Success! */ 1933650d1603SAlex Elder 1934650d1603SAlex Elder dev_err(gsi->dev, "error %d allocating channel %u event ring\n", 1935650d1603SAlex Elder ret, gsi_channel_id(channel)); 1936650d1603SAlex Elder 1937650d1603SAlex Elder gsi_evt_ring_id_free(gsi, channel->evt_ring_id); 1938650d1603SAlex Elder 1939650d1603SAlex Elder return ret; 1940650d1603SAlex Elder } 1941650d1603SAlex Elder 1942650d1603SAlex Elder /* Inverse of gsi_channel_evt_ring_init() */ 1943650d1603SAlex Elder static void gsi_channel_evt_ring_exit(struct gsi_channel *channel) 1944650d1603SAlex Elder { 1945650d1603SAlex Elder u32 evt_ring_id = channel->evt_ring_id; 1946650d1603SAlex Elder struct gsi *gsi = channel->gsi; 1947650d1603SAlex Elder struct gsi_evt_ring *evt_ring; 1948650d1603SAlex Elder 1949650d1603SAlex Elder evt_ring = &gsi->evt_ring[evt_ring_id]; 1950650d1603SAlex Elder gsi_ring_free(gsi, &evt_ring->ring); 1951650d1603SAlex Elder gsi_evt_ring_id_free(gsi, evt_ring_id); 1952650d1603SAlex Elder } 1953650d1603SAlex Elder 195457ab8ca4SAlex Elder /* Init function for event rings; there is no gsi_evt_ring_exit() */ 1955650d1603SAlex Elder static void gsi_evt_ring_init(struct gsi *gsi) 1956650d1603SAlex Elder { 1957650d1603SAlex Elder u32 evt_ring_id = 0; 1958650d1603SAlex Elder 1959650d1603SAlex Elder gsi->event_bitmap = gsi_event_bitmap_init(GSI_EVT_RING_COUNT_MAX); 1960a054539dSAlex Elder gsi->ieob_enabled_bitmap = 0; 1961650d1603SAlex Elder do 1962650d1603SAlex Elder init_completion(&gsi->evt_ring[evt_ring_id].completion); 1963650d1603SAlex Elder while (++evt_ring_id < GSI_EVT_RING_COUNT_MAX); 1964650d1603SAlex Elder } 1965650d1603SAlex Elder 1966650d1603SAlex Elder static bool gsi_channel_data_valid(struct gsi *gsi, 1967650d1603SAlex Elder const struct ipa_gsi_endpoint_data *data) 1968650d1603SAlex Elder { 1969650d1603SAlex Elder u32 channel_id = data->channel_id; 1970650d1603SAlex Elder struct device *dev = gsi->dev; 1971650d1603SAlex Elder 1972650d1603SAlex Elder /* Make sure channel ids are in the range driver supports */ 1973650d1603SAlex Elder if (channel_id >= GSI_CHANNEL_COUNT_MAX) { 19748463488aSAlex Elder dev_err(dev, "bad channel id %u; must be less than %u\n", 1975650d1603SAlex Elder channel_id, GSI_CHANNEL_COUNT_MAX); 1976650d1603SAlex Elder return false; 1977650d1603SAlex Elder } 1978650d1603SAlex Elder 1979650d1603SAlex Elder if (data->ee_id != GSI_EE_AP && data->ee_id != GSI_EE_MODEM) { 19808463488aSAlex Elder dev_err(dev, "bad EE id %u; not AP or modem\n", data->ee_id); 1981650d1603SAlex Elder return false; 1982650d1603SAlex Elder } 1983650d1603SAlex Elder 1984650d1603SAlex Elder if (!data->channel.tlv_count || 1985650d1603SAlex Elder data->channel.tlv_count > GSI_TLV_MAX) { 19868463488aSAlex Elder dev_err(dev, "channel %u bad tlv_count %u; must be 1..%u\n", 1987650d1603SAlex Elder channel_id, data->channel.tlv_count, GSI_TLV_MAX); 1988650d1603SAlex Elder return false; 1989650d1603SAlex Elder } 1990650d1603SAlex Elder 1991650d1603SAlex Elder /* We have to allow at least one maximally-sized transaction to 1992650d1603SAlex Elder * be outstanding (which would use tlv_count TREs). Given how 1993650d1603SAlex Elder * gsi_channel_tre_max() is computed, tre_count has to be almost 1994650d1603SAlex Elder * twice the TLV FIFO size to satisfy this requirement. 1995650d1603SAlex Elder */ 1996650d1603SAlex Elder if (data->channel.tre_count < 2 * data->channel.tlv_count - 1) { 1997650d1603SAlex Elder dev_err(dev, "channel %u TLV count %u exceeds TRE count %u\n", 1998650d1603SAlex Elder channel_id, data->channel.tlv_count, 1999650d1603SAlex Elder data->channel.tre_count); 2000650d1603SAlex Elder return false; 2001650d1603SAlex Elder } 2002650d1603SAlex Elder 2003650d1603SAlex Elder if (!is_power_of_2(data->channel.tre_count)) { 20048463488aSAlex Elder dev_err(dev, "channel %u bad tre_count %u; not power of 2\n", 2005650d1603SAlex Elder channel_id, data->channel.tre_count); 2006650d1603SAlex Elder return false; 2007650d1603SAlex Elder } 2008650d1603SAlex Elder 2009650d1603SAlex Elder if (!is_power_of_2(data->channel.event_count)) { 20108463488aSAlex Elder dev_err(dev, "channel %u bad event_count %u; not power of 2\n", 2011650d1603SAlex Elder channel_id, data->channel.event_count); 2012650d1603SAlex Elder return false; 2013650d1603SAlex Elder } 2014650d1603SAlex Elder 2015650d1603SAlex Elder return true; 2016650d1603SAlex Elder } 2017650d1603SAlex Elder 2018650d1603SAlex Elder /* Init function for a single channel */ 2019650d1603SAlex Elder static int gsi_channel_init_one(struct gsi *gsi, 2020650d1603SAlex Elder const struct ipa_gsi_endpoint_data *data, 202114dbf977SAlex Elder bool command) 2022650d1603SAlex Elder { 2023650d1603SAlex Elder struct gsi_channel *channel; 2024650d1603SAlex Elder u32 tre_count; 2025650d1603SAlex Elder int ret; 2026650d1603SAlex Elder 2027650d1603SAlex Elder if (!gsi_channel_data_valid(gsi, data)) 2028650d1603SAlex Elder return -EINVAL; 2029650d1603SAlex Elder 2030650d1603SAlex Elder /* Worst case we need an event for every outstanding TRE */ 2031650d1603SAlex Elder if (data->channel.tre_count > data->channel.event_count) { 2032650d1603SAlex Elder tre_count = data->channel.event_count; 20330721999fSAlex Elder dev_warn(gsi->dev, "channel %u limited to %u TREs\n", 20340721999fSAlex Elder data->channel_id, tre_count); 2035650d1603SAlex Elder } else { 2036650d1603SAlex Elder tre_count = data->channel.tre_count; 2037650d1603SAlex Elder } 2038650d1603SAlex Elder 2039650d1603SAlex Elder channel = &gsi->channel[data->channel_id]; 2040650d1603SAlex Elder memset(channel, 0, sizeof(*channel)); 2041650d1603SAlex Elder 2042650d1603SAlex Elder channel->gsi = gsi; 2043650d1603SAlex Elder channel->toward_ipa = data->toward_ipa; 2044650d1603SAlex Elder channel->command = command; 2045650d1603SAlex Elder channel->tlv_count = data->channel.tlv_count; 2046650d1603SAlex Elder channel->tre_count = tre_count; 2047650d1603SAlex Elder channel->event_count = data->channel.event_count; 2048650d1603SAlex Elder init_completion(&channel->completion); 2049650d1603SAlex Elder 2050650d1603SAlex Elder ret = gsi_channel_evt_ring_init(channel); 2051650d1603SAlex Elder if (ret) 2052650d1603SAlex Elder goto err_clear_gsi; 2053650d1603SAlex Elder 2054650d1603SAlex Elder ret = gsi_ring_alloc(gsi, &channel->tre_ring, data->channel.tre_count); 2055650d1603SAlex Elder if (ret) { 2056650d1603SAlex Elder dev_err(gsi->dev, "error %d allocating channel %u ring\n", 2057650d1603SAlex Elder ret, data->channel_id); 2058650d1603SAlex Elder goto err_channel_evt_ring_exit; 2059650d1603SAlex Elder } 2060650d1603SAlex Elder 2061650d1603SAlex Elder ret = gsi_channel_trans_init(gsi, data->channel_id); 2062650d1603SAlex Elder if (ret) 2063650d1603SAlex Elder goto err_ring_free; 2064650d1603SAlex Elder 2065650d1603SAlex Elder if (command) { 2066650d1603SAlex Elder u32 tre_max = gsi_channel_tre_max(gsi, data->channel_id); 2067650d1603SAlex Elder 2068650d1603SAlex Elder ret = ipa_cmd_pool_init(channel, tre_max); 2069650d1603SAlex Elder } 2070650d1603SAlex Elder if (!ret) 2071650d1603SAlex Elder return 0; /* Success! */ 2072650d1603SAlex Elder 2073650d1603SAlex Elder gsi_channel_trans_exit(channel); 2074650d1603SAlex Elder err_ring_free: 2075650d1603SAlex Elder gsi_ring_free(gsi, &channel->tre_ring); 2076650d1603SAlex Elder err_channel_evt_ring_exit: 2077650d1603SAlex Elder gsi_channel_evt_ring_exit(channel); 2078650d1603SAlex Elder err_clear_gsi: 2079650d1603SAlex Elder channel->gsi = NULL; /* Mark it not (fully) initialized */ 2080650d1603SAlex Elder 2081650d1603SAlex Elder return ret; 2082650d1603SAlex Elder } 2083650d1603SAlex Elder 2084650d1603SAlex Elder /* Inverse of gsi_channel_init_one() */ 2085650d1603SAlex Elder static void gsi_channel_exit_one(struct gsi_channel *channel) 2086650d1603SAlex Elder { 20876170b6daSAlex Elder if (!gsi_channel_initialized(channel)) 20886170b6daSAlex Elder return; 2089650d1603SAlex Elder 2090650d1603SAlex Elder if (channel->command) 2091650d1603SAlex Elder ipa_cmd_pool_exit(channel); 2092650d1603SAlex Elder gsi_channel_trans_exit(channel); 2093650d1603SAlex Elder gsi_ring_free(channel->gsi, &channel->tre_ring); 2094650d1603SAlex Elder gsi_channel_evt_ring_exit(channel); 2095650d1603SAlex Elder } 2096650d1603SAlex Elder 2097650d1603SAlex Elder /* Init function for channels */ 209814dbf977SAlex Elder static int gsi_channel_init(struct gsi *gsi, u32 count, 209956dfe8deSAlex Elder const struct ipa_gsi_endpoint_data *data) 2100650d1603SAlex Elder { 210156dfe8deSAlex Elder bool modem_alloc; 2102650d1603SAlex Elder int ret = 0; 2103650d1603SAlex Elder u32 i; 2104650d1603SAlex Elder 210556dfe8deSAlex Elder /* IPA v4.2 requires the AP to allocate channels for the modem */ 210656dfe8deSAlex Elder modem_alloc = gsi->version == IPA_VERSION_4_2; 210756dfe8deSAlex Elder 210857ab8ca4SAlex Elder gsi_evt_ring_init(gsi); /* No matching exit required */ 2109650d1603SAlex Elder 2110650d1603SAlex Elder /* The endpoint data array is indexed by endpoint name */ 2111650d1603SAlex Elder for (i = 0; i < count; i++) { 2112650d1603SAlex Elder bool command = i == IPA_ENDPOINT_AP_COMMAND_TX; 2113650d1603SAlex Elder 2114650d1603SAlex Elder if (ipa_gsi_endpoint_data_empty(&data[i])) 2115650d1603SAlex Elder continue; /* Skip over empty slots */ 2116650d1603SAlex Elder 2117650d1603SAlex Elder /* Mark modem channels to be allocated (hardware workaround) */ 2118650d1603SAlex Elder if (data[i].ee_id == GSI_EE_MODEM) { 2119650d1603SAlex Elder if (modem_alloc) 2120650d1603SAlex Elder gsi->modem_channel_bitmap |= 2121650d1603SAlex Elder BIT(data[i].channel_id); 2122650d1603SAlex Elder continue; 2123650d1603SAlex Elder } 2124650d1603SAlex Elder 212514dbf977SAlex Elder ret = gsi_channel_init_one(gsi, &data[i], command); 2126650d1603SAlex Elder if (ret) 2127650d1603SAlex Elder goto err_unwind; 2128650d1603SAlex Elder } 2129650d1603SAlex Elder 2130650d1603SAlex Elder return ret; 2131650d1603SAlex Elder 2132650d1603SAlex Elder err_unwind: 2133650d1603SAlex Elder while (i--) { 2134650d1603SAlex Elder if (ipa_gsi_endpoint_data_empty(&data[i])) 2135650d1603SAlex Elder continue; 2136650d1603SAlex Elder if (modem_alloc && data[i].ee_id == GSI_EE_MODEM) { 2137650d1603SAlex Elder gsi->modem_channel_bitmap &= ~BIT(data[i].channel_id); 2138650d1603SAlex Elder continue; 2139650d1603SAlex Elder } 2140650d1603SAlex Elder gsi_channel_exit_one(&gsi->channel[data->channel_id]); 2141650d1603SAlex Elder } 2142650d1603SAlex Elder 2143650d1603SAlex Elder return ret; 2144650d1603SAlex Elder } 2145650d1603SAlex Elder 2146650d1603SAlex Elder /* Inverse of gsi_channel_init() */ 2147650d1603SAlex Elder static void gsi_channel_exit(struct gsi *gsi) 2148650d1603SAlex Elder { 2149650d1603SAlex Elder u32 channel_id = GSI_CHANNEL_COUNT_MAX - 1; 2150650d1603SAlex Elder 2151650d1603SAlex Elder do 2152650d1603SAlex Elder gsi_channel_exit_one(&gsi->channel[channel_id]); 2153650d1603SAlex Elder while (channel_id--); 2154650d1603SAlex Elder gsi->modem_channel_bitmap = 0; 2155650d1603SAlex Elder } 2156650d1603SAlex Elder 2157650d1603SAlex Elder /* Init function for GSI. GSI hardware does not need to be "ready" */ 21581d0c09deSAlex Elder int gsi_init(struct gsi *gsi, struct platform_device *pdev, 21591d0c09deSAlex Elder enum ipa_version version, u32 count, 21601d0c09deSAlex Elder const struct ipa_gsi_endpoint_data *data) 2161650d1603SAlex Elder { 21628463488aSAlex Elder struct device *dev = &pdev->dev; 2163650d1603SAlex Elder struct resource *res; 2164650d1603SAlex Elder resource_size_t size; 2165cdeee49fSAlex Elder u32 adjust; 2166650d1603SAlex Elder int ret; 2167650d1603SAlex Elder 2168650d1603SAlex Elder gsi_validate_build(); 2169650d1603SAlex Elder 21708463488aSAlex Elder gsi->dev = dev; 217114dbf977SAlex Elder gsi->version = version; 2172650d1603SAlex Elder 2173571b1e7eSAlex Elder /* GSI uses NAPI on all channels. Create a dummy network device 2174571b1e7eSAlex Elder * for the channel NAPI contexts to be associated with. 2175650d1603SAlex Elder */ 2176650d1603SAlex Elder init_dummy_netdev(&gsi->dummy_dev); 2177650d1603SAlex Elder 2178650d1603SAlex Elder /* Get GSI memory range and map it */ 2179650d1603SAlex Elder res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "gsi"); 2180650d1603SAlex Elder if (!res) { 21818463488aSAlex Elder dev_err(dev, "DT error getting \"gsi\" memory property\n"); 21820b8d6761SAlex Elder return -ENODEV; 2183650d1603SAlex Elder } 2184650d1603SAlex Elder 2185650d1603SAlex Elder size = resource_size(res); 2186650d1603SAlex Elder if (res->start > U32_MAX || size > U32_MAX - res->start) { 21878463488aSAlex Elder dev_err(dev, "DT memory resource \"gsi\" out of range\n"); 21880b8d6761SAlex Elder return -EINVAL; 2189650d1603SAlex Elder } 2190650d1603SAlex Elder 2191cdeee49fSAlex Elder /* Make sure we can make our pointer adjustment if necessary */ 2192cdeee49fSAlex Elder adjust = gsi->version < IPA_VERSION_4_5 ? 0 : GSI_EE_REG_ADJUST; 2193cdeee49fSAlex Elder if (res->start < adjust) { 2194cdeee49fSAlex Elder dev_err(dev, "DT memory resource \"gsi\" too low (< %u)\n", 2195cdeee49fSAlex Elder adjust); 2196cdeee49fSAlex Elder return -EINVAL; 2197cdeee49fSAlex Elder } 2198cdeee49fSAlex Elder 2199571b1e7eSAlex Elder gsi->virt_raw = ioremap(res->start, size); 2200571b1e7eSAlex Elder if (!gsi->virt_raw) { 22018463488aSAlex Elder dev_err(dev, "unable to remap \"gsi\" memory\n"); 22020b8d6761SAlex Elder return -ENOMEM; 2203650d1603SAlex Elder } 2204571b1e7eSAlex Elder /* Most registers are accessed using an adjusted register range */ 2205571b1e7eSAlex Elder gsi->virt = gsi->virt_raw - adjust; 2206650d1603SAlex Elder 22070b8d6761SAlex Elder init_completion(&gsi->completion); 22080b8d6761SAlex Elder 22090b8d6761SAlex Elder ret = gsi_irq_init(gsi, pdev); 2210650d1603SAlex Elder if (ret) 2211650d1603SAlex Elder goto err_iounmap; 2212650d1603SAlex Elder 22130b8d6761SAlex Elder ret = gsi_channel_init(gsi, count, data); 22140b8d6761SAlex Elder if (ret) 22150b8d6761SAlex Elder goto err_irq_exit; 22160b8d6761SAlex Elder 2217650d1603SAlex Elder mutex_init(&gsi->mutex); 2218650d1603SAlex Elder 2219650d1603SAlex Elder return 0; 2220650d1603SAlex Elder 22210b8d6761SAlex Elder err_irq_exit: 22220b8d6761SAlex Elder gsi_irq_exit(gsi); 2223650d1603SAlex Elder err_iounmap: 2224571b1e7eSAlex Elder iounmap(gsi->virt_raw); 2225650d1603SAlex Elder 2226650d1603SAlex Elder return ret; 2227650d1603SAlex Elder } 2228650d1603SAlex Elder 2229650d1603SAlex Elder /* Inverse of gsi_init() */ 2230650d1603SAlex Elder void gsi_exit(struct gsi *gsi) 2231650d1603SAlex Elder { 2232650d1603SAlex Elder mutex_destroy(&gsi->mutex); 2233650d1603SAlex Elder gsi_channel_exit(gsi); 22340b8d6761SAlex Elder gsi_irq_exit(gsi); 2235571b1e7eSAlex Elder iounmap(gsi->virt_raw); 2236650d1603SAlex Elder } 2237650d1603SAlex Elder 2238650d1603SAlex Elder /* The maximum number of outstanding TREs on a channel. This limits 2239650d1603SAlex Elder * a channel's maximum number of transactions outstanding (worst case 2240650d1603SAlex Elder * is one TRE per transaction). 2241650d1603SAlex Elder * 2242650d1603SAlex Elder * The absolute limit is the number of TREs in the channel's TRE ring, 2243650d1603SAlex Elder * and in theory we should be able use all of them. But in practice, 2244650d1603SAlex Elder * doing that led to the hardware reporting exhaustion of event ring 2245650d1603SAlex Elder * slots for writing completion information. So the hardware limit 2246650d1603SAlex Elder * would be (tre_count - 1). 2247650d1603SAlex Elder * 2248650d1603SAlex Elder * We reduce it a bit further though. Transaction resource pools are 2249650d1603SAlex Elder * sized to be a little larger than this maximum, to allow resource 2250650d1603SAlex Elder * allocations to always be contiguous. The number of entries in a 2251650d1603SAlex Elder * TRE ring buffer is a power of 2, and the extra resources in a pool 2252650d1603SAlex Elder * tends to nearly double the memory allocated for it. Reducing the 2253650d1603SAlex Elder * maximum number of outstanding TREs allows the number of entries in 2254650d1603SAlex Elder * a pool to avoid crossing that power-of-2 boundary, and this can 2255650d1603SAlex Elder * substantially reduce pool memory requirements. The number we 2256650d1603SAlex Elder * reduce it by matches the number added in gsi_trans_pool_init(). 2257650d1603SAlex Elder */ 2258650d1603SAlex Elder u32 gsi_channel_tre_max(struct gsi *gsi, u32 channel_id) 2259650d1603SAlex Elder { 2260650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 2261650d1603SAlex Elder 2262650d1603SAlex Elder /* Hardware limit is channel->tre_count - 1 */ 2263650d1603SAlex Elder return channel->tre_count - (channel->tlv_count - 1); 2264650d1603SAlex Elder } 2265650d1603SAlex Elder 2266650d1603SAlex Elder /* Returns the maximum number of TREs in a single transaction for a channel */ 2267650d1603SAlex Elder u32 gsi_channel_trans_tre_max(struct gsi *gsi, u32 channel_id) 2268650d1603SAlex Elder { 2269650d1603SAlex Elder struct gsi_channel *channel = &gsi->channel[channel_id]; 2270650d1603SAlex Elder 2271650d1603SAlex Elder return channel->tlv_count; 2272650d1603SAlex Elder } 2273