Re: [PATCH v1 2/3] i2c: qcom-slave: Add driver for Qualcomm I2C slave controller
Viken Dadhaniya <[email protected]> Sun, 2 Aug 2026 18:52:00 +0530
| Newsgroups | org.kernel.vger.linux-i2c,org.kernel.vger.linux-arm-msm,org.kernel.vger.linux-devicetree,org.kernel.vger.linux-kernel |
|---|---|
| Message-ID | <[email protected]> |
On 7/5/2026 9:23 PM, Bjorn Andersson wrote: > On Sun, Jun 28, 2026 at 08:09:05PM +0530, Viken Dadhaniya wrote: >> Add support for the dedicated Qualcomm I2C slave controller found on > > Please start your commit messages with a "problem" description, > establish why the patch is needed, rather than the action the patch is > taking. Acknowledged. The commit message has been rewritten in v2 to lead with the problem statement. > >> QDU1000 and related SoCs. This IP block operates only in slave mode and is >> separate from the existing Qualcomm I2C master controllers, so those >> drivers cannot support systems that need the SoC to respond as an I2C or >> SMBus target. >> >> Register the controller as an SMBus adapter and support byte, byte-data, >> word-data and block-data transfers through the standard /dev/i2c-X >> interface. Handle the controller IRQ events for RX and TX FIFO service, >> STOP and repeated-start conditions, clock stretching, and error recovery. >> Enable the required AHB and XO clocks, vote for interconnect bandwidth, and >> restore the hardware state across suspend and resume. >> > > I don't think you read Documentation/i2c/slave-interface.rst. To me this > looks like a i2c "master", that is being abused to serve the role of a > slave; which of course implies that you have a non-standard slave device > implementation working with this. Agreed. v2 drops the SMBus layer entirely and uses the standard Linux I2C slave framework (reg_target/unreg_target, i2c_slave_event) as documented in Documentation/i2c/slave-interface.rst. > >> Read the initial slave address from the qcom,slave-addr device tree >> property. The controller node already uses reg for its MMIO resource, and >> the slave address is programmable, including through the SMBus ioctl >> interface. > > This seems to be a workaround for the fact that you don't actually > implement an i2c slave bus driver. Agreed. Both dropped in v2. The slave address is now taken from i2c_client->addr at reg_target() time. > > Regards, > Bjorn > >> >> Signed-off-by: Viken Dadhaniya <[email protected]> >> --- >> drivers/i2c/busses/Kconfig | 14 + >> drivers/i2c/busses/Makefile | 1 + >> drivers/i2c/busses/i2c-qcom-slave.c | 777 ++++++++++++++++++++++++++++++++++++ >> 3 files changed, 792 insertions(+) >> >> diff --git a/drivers/i2c/busses/Kconfig b/drivers/i2c/busses/Kconfig >> index d7b89508311f..fd7f9c3a67c3 100644 >> --- a/drivers/i2c/busses/Kconfig >> +++ b/drivers/i2c/busses/Kconfig >> @@ -1070,6 +1070,20 @@ config I2C_QCOM_GENI >> This driver can also be built as a module. If so, the module >> will be called i2c-qcom-geni. >> >> +config I2C_QCOM_SLAVE >> + tristate "Qualcomm I2C slave controller" >> + depends on ARCH_QCOM || COMPILE_TEST >> + depends on COMMON_CLK >> + depends on INTERCONNECT >> + help >> + This driver supports I2C slave mode on Qualcomm Technologies >> + SoCs. If you say yes to this option, support will be included >> + for the built-in I2C slave controller on QDU1000 and other >> + compatible Qualcomm SoCs. >> + >> + This driver can also be built as a module. If so, the module >> + will be called i2c-qcom-slave. >> + >> config I2C_QUP >> tristate "Qualcomm QUP based I2C controller" >> depends on ARCH_QCOM || COMPILE_TEST >> diff --git a/drivers/i2c/busses/Makefile b/drivers/i2c/busses/Makefile >> index 3755c54b3d82..209523685d9b 100644 >> --- a/drivers/i2c/busses/Makefile >> +++ b/drivers/i2c/busses/Makefile >> @@ -101,6 +101,7 @@ obj-$(CONFIG_I2C_PXA) += i2c-pxa.o >> obj-$(CONFIG_I2C_PXA_PCI) += i2c-pxa-pci.o >> obj-$(CONFIG_I2C_QCOM_CCI) += i2c-qcom-cci.o >> obj-$(CONFIG_I2C_QCOM_GENI) += i2c-qcom-geni.o >> +obj-$(CONFIG_I2C_QCOM_SLAVE) += i2c-qcom-slave.o >> obj-$(CONFIG_I2C_QUP) += i2c-qup.o >> obj-$(CONFIG_I2C_RIIC) += i2c-riic.o >> obj-$(CONFIG_I2C_RK3X) += i2c-rk3x.o >> diff --git a/drivers/i2c/busses/i2c-qcom-slave.c b/drivers/i2c/busses/i2c-qcom-slave.c >> new file mode 100644 >> index 000000000000..ce16aa9708c3 >> --- /dev/null >> +++ b/drivers/i2c/busses/i2c-qcom-slave.c >> @@ -0,0 +1,777 @@ >> +// SPDX-License-Identifier: GPL-2.0-only >> +/* >> + * Copyright (c) Qualcomm Technologies, Inc. and/or its subsidiaries. >> + */ >> + >> +#include <linux/bitfield.h> >> +#include <linux/clk.h> >> +#include <linux/i2c.h> >> +#include <linux/interconnect.h> >> +#include <linux/interrupt.h> >> +#include <linux/io.h> >> +#include <linux/module.h> >> +#include <linux/platform_device.h> >> +#include <linux/spinlock.h> >> + >> +/* Register offsets */ >> +#define I2C_S_DEVICE_ADDR 0x00 >> +#define I2C_S_IRQ_STATUS 0x08 >> +#define I2C_S_IRQ_CLR 0x0C >> +#define I2C_S_IRQ_EN 0x10 >> +#define I2C_S_CONFIG 0x18 >> +#define I2C_S_CONTROL 0x1C >> +#define I2C_S_FIFOS_STATUS 0x20 >> +#define I2C_S_TX_FIFO 0x24 >> +#define I2C_S_RX_FIFO 0x28 >> +#define I2C_S_DEBUG_REG1 0x3C >> +#define I2C_S_DEBUG_REG2 0x40 >> +#define I2C_S_SW_RESET_REG 0x4C >> +#define I2C_S_CLK_LOW_TIMEOUT 0x50 >> +#define I2C_S_CLK_RELEASE_DELAY_CNT_VAL 0x54 >> +#define I2C_S_SDA_HOLD_CNT_VAL 0x58 >> + >> +/* I2C_S_CONFIG register fields */ >> +#define CORE_EN BIT(0) >> + >> +/* I2C_S_CONTROL register fields */ >> +#define CLEAR_RX_FIFO BIT(0) >> +#define CLEAR_TX_FIFO BIT(1) >> +#define NACK BIT(2) >> +#define ACK_RESUME BIT(3) >> + >> +/* I2C_S_SW_RESET_REG register fields */ >> +#define SW_RESET BIT(0) >> + >> +/* I2C_S_FIFOS_STATUS register fields */ >> +#define TX_FIFO_COUNT_MASK GENMASK(15, 0) >> +#define RX_FIFO_COUNT_MASK GENMASK(31, 16) >> + >> +/* Enabled IRQ bits: 0-6 and 8-9 (bit 7 GCA and bits 10-11 SMBAlert not used) */ >> +#define QCOM_I2C_SLAVE_ALL_IRQ (GENMASK(9, 0) & ~BIT(7)) >> + >> +#define I2C_SLAVE_MAX_MSG_SIZE 32 >> +#define I2C_SLAVE_BYTE_DATA 1 >> +#define I2C_SLAVE_WORD_DATA 2 >> + >> +/* Interconnect bandwidth vote in bytes per second */ >> +#define APPS_PROC_TO_I2C_SLAVE_VOTE 1190000 >> + >> +/** >> + * enum qcom_i2c_slave_irq - IRQ bit positions in I2C_S_IRQ_STATUS >> + * @STOP_DETECTED: I2C stop condition detected on the bus >> + * @RX_FIFO_FULL: receive FIFO has reached capacity >> + * @TX_FIFO_EMPTY: transmit FIFO is empty >> + * @RX_DATA_AVAIL: receive data is available in the RX FIFO >> + * @CLOCK_LOW_TIMEOUT: SCL held low longer than the configured timeout >> + * @STRCH_WR: clock stretching during a write (Rx) phase >> + * @STRCH_RD: clock stretching during a read (Tx) phase >> + * @ERR_CONDITION: unexpected start or stop bit detected (error) >> + * @RESTART_DETECTED: repeated start condition detected >> + */ >> +enum qcom_i2c_slave_irq { >> + STOP_DETECTED = 0, >> + RX_FIFO_FULL, >> + TX_FIFO_EMPTY, >> + RX_DATA_AVAIL, >> + CLOCK_LOW_TIMEOUT, >> + STRCH_WR, >> + STRCH_RD, >> + ERR_CONDITION = 8, /* bit 7 (GCA_DETECTED) not used */ >> + RESTART_DETECTED, >> +}; >> + >> +static const char *const qcom_i2c_slave_irq_names[] = { >> + [STOP_DETECTED] = "Stop bit detected", >> + [RX_FIFO_FULL] = "Rx FIFO full", >> + [TX_FIFO_EMPTY] = "Tx FIFO empty", >> + [RX_DATA_AVAIL] = "Rx data available", >> + [CLOCK_LOW_TIMEOUT] = "Clock low timeout", >> + [STRCH_WR] = "Clock stretching during write (Rx) phase", >> + [STRCH_RD] = "Clock stretching during read (Tx) phase", >> + [ERR_CONDITION] = "Error condition: unexpected Start/Stop bits", >> + [RESTART_DETECTED] = "Repeated start bit detected", >> +}; >> + >> +/** >> + * struct qcom_i2c_slave - Qualcomm I2C slave controller private data >> + * @dev: driver model device node >> + * @base: base address of HW registers >> + * @adap: I2C adapter for userspace access >> + * @ahb_clk: AHB bus clock >> + * @xo_clk: XO reference clock >> + * @icc_path: interconnect bandwidth path >> + * @lock: protects rx_count, rx_msg_buf, tx_count, tx_msg_buf >> + * @slave_addr: current I2C slave address >> + * @rx_count: number of valid bytes in rx_msg_buf >> + * @rx_msg_buf: receive data staging buffer >> + * @tx_count: number of valid bytes in tx_msg_buf >> + * @tx_msg_buf: transmit data staging buffer >> + * @irq: interrupt line number >> + */ >> +struct qcom_i2c_slave { >> + struct device *dev; >> + void __iomem *base; >> + struct i2c_adapter adap; >> + struct clk *ahb_clk; >> + struct clk *xo_clk; >> + struct icc_path *icc_path; >> + spinlock_t lock; /* protects rx_count, rx_msg_buf, tx_count, tx_msg_buf */ >> + u16 slave_addr; >> + u8 rx_count; >> + u8 rx_msg_buf[I2C_SLAVE_MAX_MSG_SIZE]; >> + u8 tx_count; >> + u8 tx_msg_buf[I2C_SLAVE_MAX_MSG_SIZE]; >> + int irq; >> +}; >> + >> +/** >> + * qcom_i2c_slave_dump_regs - log all relevant controller register values >> + * @slave: controller private data >> + * >> + * Dumps the current values of key hardware registers to the kernel debug >> + * log. Intended for use during error recovery to aid diagnostics. >> + */ >> +static void qcom_i2c_slave_dump_regs(struct qcom_i2c_slave *slave) >> +{ >> + dev_dbg(slave->dev, "I2C_S_DEVICE_ADDR: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_DEVICE_ADDR)); >> + dev_dbg(slave->dev, "I2C_S_IRQ_STATUS: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_IRQ_STATUS)); >> + dev_dbg(slave->dev, "I2C_S_CONFIG: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_CONFIG)); >> + dev_dbg(slave->dev, "I2C_S_IRQ_EN: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_IRQ_EN)); >> + dev_dbg(slave->dev, "I2C_S_FIFOS_STATUS: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_FIFOS_STATUS)); >> + dev_dbg(slave->dev, "I2C_S_DEBUG_REG1: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_DEBUG_REG1)); >> + dev_dbg(slave->dev, "I2C_S_DEBUG_REG2: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_DEBUG_REG2)); >> + dev_dbg(slave->dev, "I2C_S_CLK_LOW_TIMEOUT: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_CLK_LOW_TIMEOUT)); >> + dev_dbg(slave->dev, "I2C_S_CLK_RELEASE_DELAY_CNT_VAL: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_CLK_RELEASE_DELAY_CNT_VAL)); >> + dev_dbg(slave->dev, "I2C_S_SDA_HOLD_CNT_VAL: 0x%x\n", >> + readl_relaxed(slave->base + I2C_S_SDA_HOLD_CNT_VAL)); >> +} >> + >> +/** >> + * qcom_i2c_slave_write_fifo - write staged TX data to the TX FIFO >> + * @slave: controller private data >> + * >> + * Writes all bytes from the tx_msg_buf staging buffer into the hardware >> + * TX FIFO and resets tx_count to zero. >> + * >> + * Context: Must be called with slave->lock held. >> + */ >> +static void qcom_i2c_slave_write_fifo(struct qcom_i2c_slave *slave) >> +{ >> + int i; >> + >> + if (!slave->tx_count) { >> + dev_err(slave->dev, "TX FIFO write count is zero\n"); >> + return; >> + } >> + >> + for (i = 0; i < slave->tx_count; i++) { >> + dev_dbg(slave->dev, "Data to TX FIFO: 0x%x\n", >> + slave->tx_msg_buf[i]); >> + writel(slave->tx_msg_buf[i], slave->base + I2C_S_TX_FIFO); >> + } >> + >> + slave->tx_count = 0; >> +} >> + >> +/** >> + * qcom_i2c_slave_read_fifo - drain the RX FIFO into the staging buffer >> + * @slave: controller private data >> + * >> + * Reads all available bytes from the hardware RX FIFO into rx_msg_buf. >> + * Stops early if the staging buffer is full. >> + * >> + * Context: Must be called with slave->lock held. >> + */ >> +static void qcom_i2c_slave_read_fifo(struct qcom_i2c_slave *slave) >> +{ >> + unsigned int rx_data_count; >> + int i; >> + >> + rx_data_count = FIELD_GET(RX_FIFO_COUNT_MASK, >> + readl_relaxed(slave->base + I2C_S_FIFOS_STATUS)); >> + if (!rx_data_count) { >> + dev_dbg(slave->dev, "RX FIFO empty\n"); >> + return; >> + } >> + >> + if (slave->rx_count >= I2C_SLAVE_MAX_MSG_SIZE) { >> + dev_err(slave->dev, "RX data buffer full\n"); >> + return; >> + } >> + >> + for (i = 0; i < rx_data_count && >> + slave->rx_count < I2C_SLAVE_MAX_MSG_SIZE; i++) { >> + slave->rx_msg_buf[slave->rx_count] = >> + readl_relaxed(slave->base + I2C_S_RX_FIFO); >> + dev_dbg(slave->dev, "Data from RX FIFO: 0x%x\n", >> + slave->rx_msg_buf[slave->rx_count]); >> + slave->rx_count++; >> + } >> +} >> + >> +/** >> + * qcom_i2c_slave_set_bits - set bits in a controller register >> + * @slave: controller private data >> + * @reg: register offset from the controller base address >> + * @mask: bitmask of bits to set >> + * >> + * Performs a read-modify-write to set the bits specified by @mask in the >> + * register at @reg without disturbing other bits. >> + */ >> +static void qcom_i2c_slave_set_bits(struct qcom_i2c_slave *slave, >> + u32 reg, u32 mask) >> +{ >> + writel(readl_relaxed(slave->base + reg) | mask, slave->base + reg); >> +} >> + >> +/** >> + * qcom_i2c_slave_clear_irq - acknowledge and clear pending interrupts >> + * @slave: controller private data >> + * @mask: bitmask of interrupt bits to clear >> + * >> + * Writes @mask to the IRQ clear register to acknowledge the specified >> + * interrupt sources. >> + */ >> +static void qcom_i2c_slave_clear_irq(struct qcom_i2c_slave *slave, u32 mask) >> +{ >> + writel(mask, slave->base + I2C_S_IRQ_CLR); >> +} >> + >> +/** >> + * qcom_i2c_slave_hw_init - initialise or re-initialise the controller hardware >> + * @slave: controller private data >> + * >> + * Flushes both FIFOs, enables the supported interrupts (QCOM_I2C_SLAVE_ALL_IRQ), >> + * the slave address register, and enables the core. Called from probe and >> + * resume to ensure the hardware is in a known good state. >> + */ >> +static void qcom_i2c_slave_hw_init(struct qcom_i2c_slave *slave) >> +{ >> + writel(CLEAR_TX_FIFO | CLEAR_RX_FIFO, slave->base + I2C_S_CONTROL); >> + writel(QCOM_I2C_SLAVE_ALL_IRQ, slave->base + I2C_S_IRQ_EN); >> + writel(slave->slave_addr, slave->base + I2C_S_DEVICE_ADDR); >> + writel(CORE_EN, slave->base + I2C_S_CONFIG); >> +} >> + >> +/** >> + * qcom_i2c_slave_interrupt - top-level interrupt handler >> + * @irq: interrupt number >> + * @dev_id: pointer to the controller private data >> + * >> + * Reads the IRQ status register and dispatches handling for each active >> + * interrupt source. Fatal conditions (ERR_CONDITION, CLOCK_LOW_TIMEOUT) >> + * trigger a full controller reset and return early. All other events are >> + * handled in order with the spinlock held. >> + * >> + * Return: %IRQ_HANDLED if at least one interrupt was processed, %IRQ_NONE >> + * if the status register was empty. >> + */ >> +static irqreturn_t qcom_i2c_slave_interrupt(int irq, void *dev_id) >> +{ >> + struct qcom_i2c_slave *slave = dev_id; >> + u32 irq_stat; >> + >> + irq_stat = readl_relaxed(slave->base + I2C_S_IRQ_STATUS); >> + if (!irq_stat) >> + return IRQ_NONE; >> + >> + dev_dbg(slave->dev, "IRQ status: 0x%x\n", irq_stat); >> + >> + /* >> + * ERR_CONDITION and CLOCK_LOW_TIMEOUT require full recovery. >> + * Return early after handling to avoid processing stale irq_stat bits. >> + */ >> + if (irq_stat & (BIT(ERR_CONDITION) | BIT(CLOCK_LOW_TIMEOUT))) { >> + enum qcom_i2c_slave_irq irq_type = (irq_stat & BIT(ERR_CONDITION)) ? >> + ERR_CONDITION : CLOCK_LOW_TIMEOUT; >> + dev_err(slave->dev, "%s\n", qcom_i2c_slave_irq_names[irq_type]); >> + qcom_i2c_slave_dump_regs(slave); >> + qcom_i2c_slave_set_bits(slave, I2C_S_SW_RESET_REG, SW_RESET); >> + qcom_i2c_slave_clear_irq(slave, QCOM_I2C_SLAVE_ALL_IRQ); >> + writel(QCOM_I2C_SLAVE_ALL_IRQ, slave->base + I2C_S_IRQ_EN); >> + qcom_i2c_slave_set_bits(slave, I2C_S_CONTROL, >> + CLEAR_TX_FIFO | CLEAR_RX_FIFO); >> + qcom_i2c_slave_set_bits(slave, I2C_S_CONFIG, CORE_EN); >> + writel(NACK, slave->base + I2C_S_CONTROL); >> + return IRQ_HANDLED; >> + } >> + >> + spin_lock(&slave->lock); >> + >> + if (irq_stat & BIT(STOP_DETECTED)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[STOP_DETECTED]); >> + qcom_i2c_slave_read_fifo(slave); >> + qcom_i2c_slave_clear_irq(slave, BIT(STOP_DETECTED)); >> + } >> + >> + if (irq_stat & BIT(RX_FIFO_FULL)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[RX_FIFO_FULL]); >> + writel(NACK, slave->base + I2C_S_CONTROL); >> + qcom_i2c_slave_clear_irq(slave, BIT(RX_FIFO_FULL)); >> + } >> + >> + if (irq_stat & BIT(STRCH_RD)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[STRCH_RD]); >> + if (readl_relaxed(slave->base + I2C_S_FIFOS_STATUS) & TX_FIFO_COUNT_MASK) >> + writel(ACK_RESUME, slave->base + I2C_S_CONTROL); >> + else >> + writel(NACK, slave->base + I2C_S_CONTROL); >> + qcom_i2c_slave_clear_irq(slave, BIT(STRCH_RD)); >> + } >> + >> + if (irq_stat & BIT(RX_DATA_AVAIL)) { >> + /* >> + * Intermediate notification only — received data is consumed >> + * in the STOP_DETECTED handler. Acknowledge and clear. >> + */ >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[RX_DATA_AVAIL]); >> + qcom_i2c_slave_clear_irq(slave, BIT(RX_DATA_AVAIL)); >> + } >> + >> + if (irq_stat & BIT(STRCH_WR)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[STRCH_WR]); >> + if (slave->rx_count < I2C_SLAVE_MAX_MSG_SIZE) >> + writel(ACK_RESUME, slave->base + I2C_S_CONTROL); >> + else >> + writel(NACK, slave->base + I2C_S_CONTROL); >> + qcom_i2c_slave_clear_irq(slave, BIT(STRCH_WR)); >> + } >> + >> + if (irq_stat & BIT(TX_FIFO_EMPTY)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[TX_FIFO_EMPTY]); >> + if (slave->tx_count) >> + qcom_i2c_slave_write_fifo(slave); >> + qcom_i2c_slave_clear_irq(slave, BIT(TX_FIFO_EMPTY)); >> + } >> + >> + if (irq_stat & BIT(RESTART_DETECTED)) { >> + dev_dbg(slave->dev, "%s\n", qcom_i2c_slave_irq_names[RESTART_DETECTED]); >> + writel(ACK_RESUME, slave->base + I2C_S_CONTROL); >> + qcom_i2c_slave_clear_irq(slave, BIT(RESTART_DETECTED)); >> + } >> + >> + spin_unlock(&slave->lock); >> + >> + return IRQ_HANDLED; >> +} >> + >> +/** >> + * qcom_i2c_slave_write - stage TX data and write it to the TX FIFO >> + * @slave: controller private data >> + * @buf: data to transmit >> + * @count: number of bytes to transmit >> + * >> + * Return: 0 on success, -%EINVAL if @buf is NULL, @count is zero, or >> + * @count exceeds %I2C_SLAVE_MAX_MSG_SIZE. >> + */ >> +static int qcom_i2c_slave_write(struct qcom_i2c_slave *slave, >> + const u8 *buf, size_t count) >> +{ >> + unsigned long flags; >> + >> + if (!buf || !count) >> + return -EINVAL; >> + >> + if (count > I2C_SLAVE_MAX_MSG_SIZE) >> + return -EINVAL; >> + >> + spin_lock_irqsave(&slave->lock, flags); >> + memcpy(slave->tx_msg_buf, buf, count); >> + slave->tx_count = count; >> + qcom_i2c_slave_write_fifo(slave); >> + spin_unlock_irqrestore(&slave->lock, flags); >> + >> + return 0; >> +} >> + >> +/** >> + * qcom_i2c_slave_read - copy received data from the staging buffer >> + * @slave: controller private data >> + * @buf: destination buffer >> + * @count: number of bytes requested >> + * >> + * Return: number of bytes copied on success, negative error code on failure. >> + */ >> +static int qcom_i2c_slave_read(struct qcom_i2c_slave *slave, >> + u8 *buf, size_t count) >> +{ >> + unsigned long flags; >> + int ret; >> + >> + if (!buf || !count) >> + return -EINVAL; >> + >> + spin_lock_irqsave(&slave->lock, flags); >> + >> + if (count <= I2C_SLAVE_WORD_DATA && slave->rx_count < count) { >> + dev_err(slave->dev, "Data not available\n"); >> + spin_unlock_irqrestore(&slave->lock, flags); >> + return -EINVAL; >> + } >> + >> + if (count > I2C_SLAVE_WORD_DATA) >> + count = slave->rx_count; >> + >> + memcpy(buf, slave->rx_msg_buf, count); >> + slave->rx_count -= count; >> + memmove(slave->rx_msg_buf, slave->rx_msg_buf + count, slave->rx_count); >> + ret = count; >> + >> + spin_unlock_irqrestore(&slave->lock, flags); >> + >> + return ret; >> +} >> + >> +/** >> + * qcom_i2c_slave_xfer - SMBus transfer callback >> + * @adap: I2C adapter >> + * @addr: slave address (used to update the HW address register) >> + * @flags: I2C client flags >> + * @read_write: direction flag (I2C_SMBUS_READ or I2C_SMBUS_WRITE) >> + * @command: SMBus command code >> + * @protocol: SMBus protocol type >> + * @data: pointer to SMBus data union >> + * >> + * Return: 0 on success, negative error code on failure. >> + */ >> +static int qcom_i2c_slave_xfer(struct i2c_adapter *adap, u16 addr, >> + unsigned short flags, char read_write, >> + u8 command, int protocol, >> + union i2c_smbus_data *data) >> +{ >> + struct qcom_i2c_slave *slave = i2c_get_adapdata(adap); >> + u8 buf[I2C_SMBUS_BLOCK_MAX]; >> + int ret = 0, count, i; >> + >> + dev_dbg(slave->dev, >> + "SMBus xfer: addr=0x%x flags=0x%x cmd=0x%x rw=%d proto=%d\n", >> + addr, flags, command, read_write, protocol); >> + >> + /* >> + * The SMBus command byte is not used for transfer routing. As a slave >> + * controller this device responds to whatever the master sends; >> + * command interpretation is left to the userspace application. >> + */ >> + >> + /* >> + * The I2C framework resets the slave address to 0 on every open/close >> + * of the device node. Only update the HW register for non-zero values >> + * that differ from the current address. >> + */ >> + if (addr && addr != slave->slave_addr) { >> + slave->slave_addr = addr; >> + writel_relaxed(addr, slave->base + I2C_S_DEVICE_ADDR); >> + } >> + >> + if (read_write == I2C_SMBUS_READ) { >> + switch (protocol) { >> + case I2C_SMBUS_BYTE: >> + case I2C_SMBUS_BYTE_DATA: >> + count = qcom_i2c_slave_read(slave, buf, I2C_SLAVE_BYTE_DATA); >> + if (count == I2C_SLAVE_BYTE_DATA) { >> + data->byte = buf[0]; >> + return 0; >> + } >> + ret = count; >> + break; >> + >> + case I2C_SMBUS_WORD_DATA: >> + count = qcom_i2c_slave_read(slave, buf, I2C_SLAVE_WORD_DATA); >> + if (count == I2C_SLAVE_WORD_DATA) { >> + data->word = buf[0] | (buf[1] << 8); >> + return 0; >> + } >> + ret = count; >> + break; >> + >> + case I2C_SMBUS_BLOCK_DATA: >> + count = qcom_i2c_slave_read(slave, buf, I2C_SMBUS_BLOCK_MAX); >> + if (count > 0) { >> + data->block[0] = count; >> + for (i = 0; i < count; i++) >> + data->block[i + 1] = buf[i]; >> + return 0; >> + } >> + ret = -EINVAL; >> + break; >> + >> + default: >> + ret = -EOPNOTSUPP; >> + break; >> + } >> + } else if (read_write == I2C_SMBUS_WRITE) { >> + switch (protocol) { >> + case I2C_SMBUS_BYTE: >> + case I2C_SMBUS_BYTE_DATA: >> + buf[0] = data->byte; >> + ret = qcom_i2c_slave_write(slave, buf, I2C_SLAVE_BYTE_DATA); >> + break; >> + >> + case I2C_SMBUS_WORD_DATA: >> + buf[0] = data->word & 0xFF; >> + buf[1] = data->word >> 8; >> + ret = qcom_i2c_slave_write(slave, buf, I2C_SLAVE_WORD_DATA); >> + break; >> + >> + case I2C_SMBUS_BLOCK_DATA: >> + if (data->block[0] > I2C_SMBUS_BLOCK_MAX) >> + data->block[0] = I2C_SMBUS_BLOCK_MAX; >> + for (i = 0; i < data->block[0]; i++) >> + buf[i] = data->block[i + 1]; >> + ret = qcom_i2c_slave_write(slave, buf, data->block[0]); >> + break; >> + >> + default: >> + ret = -EOPNOTSUPP; >> + break; >> + } >> + } >> + >> + return ret; >> +} >> + >> +/** >> + * qcom_i2c_slave_icc_init - initialise the interconnect bandwidth path >> + * @slave: controller private data >> + * >> + * Obtains the interconnect path, sets the required bandwidth vote, and >> + * enables the path so the controller can access system memory. >> + * >> + * Return: 0 on success, negative error code on failure. >> + */ >> +static int qcom_i2c_slave_icc_init(struct qcom_i2c_slave *slave) >> +{ >> + int ret; >> + >> + slave->icc_path = devm_of_icc_get(slave->dev, "i2c-slave-config"); >> + if (IS_ERR(slave->icc_path)) >> + return dev_err_probe(slave->dev, PTR_ERR(slave->icc_path), >> + "failed to get ICC path\n"); >> + >> + ret = icc_set_bw(slave->icc_path, APPS_PROC_TO_I2C_SLAVE_VOTE, >> + APPS_PROC_TO_I2C_SLAVE_VOTE); >> + if (ret) >> + return dev_err_probe(slave->dev, ret, "icc_set_bw failed\n"); >> + >> + ret = icc_enable(slave->icc_path); >> + if (ret) >> + return dev_err_probe(slave->dev, ret, "ICC enable failed\n"); >> + >> + return 0; >> +} >> + >> +/** >> + * qcom_i2c_slave_func - report the SMBus functionality supported >> + * @adap: I2C adapter >> + * >> + * Return: bitmask of I2C_FUNC_* flags indicating the supported SMBus >> + * protocols (byte, byte-data, word-data, and block-data). >> + */ >> +static u32 qcom_i2c_slave_func(struct i2c_adapter *adap) >> +{ >> + return I2C_FUNC_SMBUS_BYTE | >> + I2C_FUNC_SMBUS_BYTE_DATA | >> + I2C_FUNC_SMBUS_WORD_DATA | >> + I2C_FUNC_SMBUS_BLOCK_DATA; >> +} >> + >> +static const struct i2c_algorithm qcom_i2c_slave_algo = { >> + .smbus_xfer = qcom_i2c_slave_xfer, >> + .functionality = qcom_i2c_slave_func, >> +}; >> + >> +/** >> + * qcom_i2c_slave_probe - probe the Qualcomm I2C slave controller >> + * @pdev: platform device >> + * >> + * Allocates driver state, maps registers, enables clocks and the >> + * interconnect path, registers the interrupt handler, initialises the >> + * hardware, and registers the I2C adapter with the kernel. >> + * >> + * Return: 0 on success, negative error code on failure. >> + */ >> +static int qcom_i2c_slave_probe(struct platform_device *pdev) >> +{ >> + struct qcom_i2c_slave *slave; >> + struct device *dev = &pdev->dev; >> + u32 addr; >> + int ret; >> + >> + slave = devm_kzalloc(dev, sizeof(*slave), GFP_KERNEL); >> + if (!slave) >> + return -ENOMEM; >> + >> + slave->dev = dev; >> + spin_lock_init(&slave->lock); >> + >> + ret = of_property_read_u32(dev->of_node, "qcom,slave-addr", &addr); >> + if (ret) >> + return dev_err_probe(dev, ret, >> + "missing qcom,slave-addr property\n"); >> + >> + slave->base = devm_platform_ioremap_resource(pdev, 0); >> + if (IS_ERR(slave->base)) >> + return PTR_ERR(slave->base); >> + >> + slave->xo_clk = devm_clk_get_enabled(dev, "sm_bus_xo_clk"); >> + if (IS_ERR(slave->xo_clk)) >> + return dev_err_probe(dev, PTR_ERR(slave->xo_clk), >> + "failed to get and enable XO clock\n"); >> + >> + slave->ahb_clk = devm_clk_get_enabled(dev, "sm_bus_ahb_clk"); >> + if (IS_ERR(slave->ahb_clk)) >> + return dev_err_probe(dev, PTR_ERR(slave->ahb_clk), >> + "failed to get and enable AHB clock\n"); >> + >> + slave->irq = platform_get_irq(pdev, 0); >> + if (slave->irq < 0) >> + return slave->irq; >> + >> + ret = devm_request_irq(dev, slave->irq, qcom_i2c_slave_interrupt, 0, >> + dev_name(dev), slave); >> + if (ret) { >> + dev_err(dev, "request_irq failed for IRQ %d: %d\n", >> + slave->irq, ret); >> + return ret; >> + } >> + >> + ret = qcom_i2c_slave_icc_init(slave); >> + if (ret) >> + return ret; >> + >> + slave->slave_addr = addr; >> + >> + qcom_i2c_slave_hw_init(slave); >> + >> + slave->adap.owner = THIS_MODULE; >> + slave->adap.algo = &qcom_i2c_slave_algo; >> + slave->adap.dev.parent = dev; >> + slave->adap.dev.of_node = dev->of_node; >> + strscpy(slave->adap.name, "qcom-i2c-slave", sizeof(slave->adap.name)); >> + >> + i2c_set_adapdata(&slave->adap, slave); >> + platform_set_drvdata(pdev, slave); >> + >> + ret = i2c_add_adapter(&slave->adap); >> + if (ret) { >> + dev_err(dev, "i2c_add_adapter failed: %d\n", ret); >> + icc_disable(slave->icc_path); >> + return ret; >> + } >> + >> + dev_info(dev, "Qualcomm I2C slave probed at address 0x%x\n", addr); >> + return 0; >> +} >> + >> +/** >> + * qcom_i2c_slave_remove - remove the Qualcomm I2C slave controller >> + * @pdev: platform device >> + * >> + * Unregisters the I2C adapter and disables the interconnect path. >> + * Controller clocks are disabled automatically by the devm framework. >> + */ >> +static void qcom_i2c_slave_remove(struct platform_device *pdev) >> +{ >> + struct qcom_i2c_slave *slave = platform_get_drvdata(pdev); >> + >> + i2c_del_adapter(&slave->adap); >> + icc_disable(slave->icc_path); >> + /* clocks are disabled automatically by devm */ >> +} >> + >> +/** >> + * qcom_i2c_slave_suspend - suspend the controller >> + * @dev: device associated with the controller >> + * >> + * Disables the interrupt, releases the interconnect bandwidth vote, and >> + * disables the controller clocks to allow the system to enter a low-power >> + * state. >> + * >> + * Return: 0 always. >> + */ >> +static int qcom_i2c_slave_suspend(struct device *dev) >> +{ >> + struct qcom_i2c_slave *slave = dev_get_drvdata(dev); >> + >> + disable_irq(slave->irq); >> + icc_disable(slave->icc_path); >> + clk_disable_unprepare(slave->xo_clk); >> + clk_disable_unprepare(slave->ahb_clk); >> + >> + return 0; >> +} >> + >> +/** >> + * qcom_i2c_slave_resume - resume the controller >> + * @dev: device associated with the controller >> + * >> + * Re-enables the controller clocks and the interconnect bandwidth path, >> + * restores the hardware register state, then re-enables the interrupt so >> + * the controller is ready to handle transactions. >> + * >> + * Return: 0 on success, negative error code on failure. >> + */ >> +static int qcom_i2c_slave_resume(struct device *dev) >> +{ >> + struct qcom_i2c_slave *slave = dev_get_drvdata(dev); >> + int ret; >> + >> + ret = clk_prepare_enable(slave->ahb_clk); >> + if (ret) { >> + dev_err(dev, "failed to enable AHB clock: %d\n", ret); >> + return ret; >> + } >> + >> + ret = clk_prepare_enable(slave->xo_clk); >> + if (ret) { >> + dev_err(dev, "failed to enable XO clock: %d\n", ret); >> + clk_disable_unprepare(slave->ahb_clk); >> + return ret; >> + } >> + >> + ret = icc_enable(slave->icc_path); >> + if (ret) { >> + dev_err(dev, "ICC enable failed: %d\n", ret); >> + clk_disable_unprepare(slave->xo_clk); >> + clk_disable_unprepare(slave->ahb_clk); >> + return ret; >> + } >> + >> + qcom_i2c_slave_hw_init(slave); >> + enable_irq(slave->irq); >> + return 0; >> +} >> + >> +static SIMPLE_DEV_PM_OPS(qcom_i2c_slave_pm_ops, >> + qcom_i2c_slave_suspend, >> + qcom_i2c_slave_resume); >> + >> +static const struct of_device_id qcom_i2c_slave_dt_match[] = { >> + { .compatible = "qcom,i2c-slave" }, >> + { } >> +}; >> +MODULE_DEVICE_TABLE(of, qcom_i2c_slave_dt_match); >> + >> +static struct platform_driver qcom_i2c_slave_driver = { >> + .driver = { >> + .name = "qcom-i2c-slave", >> + .pm = &qcom_i2c_slave_pm_ops, >> + .of_match_table = qcom_i2c_slave_dt_match, >> + }, >> + .probe = qcom_i2c_slave_probe, >> + .remove = qcom_i2c_slave_remove, >> +}; >> +module_platform_driver(qcom_i2c_slave_driver); >> + >> +MODULE_AUTHOR("Viken Dadhaniya <[email protected]>"); >> +MODULE_LICENSE("GPL"); >> +MODULE_DESCRIPTION("Qualcomm I2C slave controller driver"); >> >> -- >> 2.34.1 >> >>