* [PATCH v2 3/4] i2c: omap: remove unused is_rdr and is_xdr function arguments
2026-11-18 20:52 [PATCH v2 0/4] i2c: omap: add support for DMA Antoni Pokusinski
2026-11-18 20:52 ` [PATCH v2 1/4] dt-bindings: i2c: ti,omap4-i2c: Add DMA properties Antoni Pokusinski
2026-11-18 20:52 ` [PATCH v2 2/4] ARM: dts: am33xx-l4: Add missing DMAs for I2C controllers Antoni Pokusinski
@ 2026-11-18 20:52 ` Antoni Pokusinski
2026-11-18 20:52 ` [PATCH v2 4/4] i2c: omap: add DMA support Antoni Pokusinski
3 siblings, 0 replies; 6+ messages in thread
From: Antoni Pokusinski @ 2026-11-18 20:52 UTC (permalink / raw)
To: vigneshr, andi.shyti, robh, krzk+dt, conor+dt, aaro.koskinen,
andreas, khilman, rogerq, tony, jmkrzyszt, sumit.semwal,
christian.koenig, phasta
Cc: linux-omap, linux-i2c, devicetree, linux-kernel, linux-media,
dri-devel, linaro-mm-sig, Antoni Pokusinski
Both functions omap_i2c_{receive|transmit}_data() have unused arguments
is_{r|x}dr which can be deleted.
Signed-off-by: Antoni Pokusinski <apokusinski01@gmail.com>
---
drivers/i2c/busses/i2c-omap.c | 14 ++++++--------
1 file changed, 6 insertions(+), 8 deletions(-)
diff --git a/drivers/i2c/busses/i2c-omap.c b/drivers/i2c/busses/i2c-omap.c
index f02d294db42a..3f7060d57a86 100644
--- a/drivers/i2c/busses/i2c-omap.c
+++ b/drivers/i2c/busses/i2c-omap.c
@@ -996,8 +996,7 @@ static int errata_omap3_i462(struct omap_i2c_dev *omap)
return 0;
}
-static void omap_i2c_receive_data(struct omap_i2c_dev *omap, u8 num_bytes,
- bool is_rdr)
+static void omap_i2c_receive_data(struct omap_i2c_dev *omap, u8 num_bytes)
{
u16 w;
@@ -1017,8 +1016,7 @@ static void omap_i2c_receive_data(struct omap_i2c_dev *omap, u8 num_bytes,
}
}
-static int omap_i2c_transmit_data(struct omap_i2c_dev *omap, u8 num_bytes,
- bool is_xdr)
+static int omap_i2c_transmit_data(struct omap_i2c_dev *omap, u8 num_bytes)
{
u16 w;
@@ -1122,7 +1120,7 @@ static int omap_i2c_xfer_data(struct omap_i2c_dev *omap)
OMAP_I2C_BUFSTAT_REG) >> 8) & 0x3F;
}
- omap_i2c_receive_data(omap, num_bytes, true);
+ omap_i2c_receive_data(omap, num_bytes);
omap_i2c_ack_stat(omap, OMAP_I2C_STAT_RDR);
continue;
}
@@ -1133,7 +1131,7 @@ static int omap_i2c_xfer_data(struct omap_i2c_dev *omap)
if (omap->threshold)
num_bytes = omap->threshold;
- omap_i2c_receive_data(omap, num_bytes, false);
+ omap_i2c_receive_data(omap, num_bytes);
omap_i2c_ack_stat(omap, OMAP_I2C_STAT_RRDY);
continue;
}
@@ -1145,7 +1143,7 @@ static int omap_i2c_xfer_data(struct omap_i2c_dev *omap)
if (omap->fifo_size)
num_bytes = omap->buf_len;
- ret = omap_i2c_transmit_data(omap, num_bytes, true);
+ ret = omap_i2c_transmit_data(omap, num_bytes);
if (ret < 0)
break;
@@ -1160,7 +1158,7 @@ static int omap_i2c_xfer_data(struct omap_i2c_dev *omap)
if (omap->threshold)
num_bytes = omap->threshold;
- ret = omap_i2c_transmit_data(omap, num_bytes, false);
+ ret = omap_i2c_transmit_data(omap, num_bytes);
if (ret < 0)
break;
--
2.56.1
^ permalink raw reply related [flat|nested] 6+ messages in thread* [PATCH v2 4/4] i2c: omap: add DMA support
2026-11-18 20:52 [PATCH v2 0/4] i2c: omap: add support for DMA Antoni Pokusinski
` (2 preceding siblings ...)
2026-11-18 20:52 ` [PATCH v2 3/4] i2c: omap: remove unused is_rdr and is_xdr function arguments Antoni Pokusinski
@ 2026-11-18 20:52 ` Antoni Pokusinski
2026-11-18 21:10 ` sashiko-bot
3 siblings, 1 reply; 6+ messages in thread
From: Antoni Pokusinski @ 2026-11-18 20:52 UTC (permalink / raw)
To: vigneshr, andi.shyti, robh, krzk+dt, conor+dt, aaro.koskinen,
andreas, khilman, rogerq, tony, jmkrzyszt, sumit.semwal,
christian.koenig, phasta
Cc: linux-omap, linux-i2c, devicetree, linux-kernel, linux-media,
dri-devel, linaro-mm-sig, Antoni Pokusinski
Add support for the TX and RX DMA requests of the OMAP I2C controller.
The DMA transactions are dispatched only if the I2C message size is
a multiple of the configured FIFO threshold and is greater than a
predefined threshold of 8 bytes.
Support for DMA transactions that are not a multiple of the FIFO
threshold can be added in the future using the draining feature.
Signed-off-by: Antoni Pokusinski <apokusinski01@gmail.com>
---
drivers/i2c/busses/i2c-omap.c | 349 ++++++++++++++++++++++++++++++++--
1 file changed, 328 insertions(+), 21 deletions(-)
diff --git a/drivers/i2c/busses/i2c-omap.c b/drivers/i2c/busses/i2c-omap.c
index 3f7060d57a86..acff27f3f438 100644
--- a/drivers/i2c/busses/i2c-omap.c
+++ b/drivers/i2c/busses/i2c-omap.c
@@ -5,6 +5,7 @@
* Copyright (C) 2003 MontaVista Software, Inc.
* Copyright (C) 2005 Nokia Corporation
* Copyright (C) 2004 - 2007 Texas Instruments.
+ * Copyright (C) 2026 Antoni Pokusiński
*
* Originally written by MontaVista Software, Inc.
* Additional contributions by:
@@ -13,10 +14,13 @@
* Juha Yrjölä <juha.yrjola@solidboot.com>
* Syed Khasim <x0khasim@ti.com>
* Nishant Menon <nm@ti.com>
+ * Antoni Pokusiński <apokusinski01@gmail.com>
*/
#include <linux/module.h>
#include <linux/delay.h>
+#include <linux/dma-mapping.h>
+#include <linux/dmaengine.h>
#include <linux/i2c.h>
#include <linux/err.h>
#include <linux/interrupt.h>
@@ -50,6 +54,8 @@
/* timeout for making decision on bus free status */
#define OMAP_I2C_BUS_FREE_TIMEOUT (msecs_to_jiffies(10))
+#define OMAP_I2C_DMA_THRESHOLD 8
+
/* For OMAP3 I2C_IV has changed to I2C_WE (wakeup enable) */
enum {
OMAP_I2C_REV_REG = 0,
@@ -57,6 +63,10 @@ enum {
OMAP_I2C_STAT_REG,
OMAP_I2C_IV_REG,
OMAP_I2C_WE_REG,
+ OMAP_I2C_DMARXENABLE_SET,
+ OMAP_I2C_DMATXENABLE_SET,
+ OMAP_I2C_DMARXENABLE_CLR,
+ OMAP_I2C_DMATXENABLE_CLR,
OMAP_I2C_SYSS_REG,
OMAP_I2C_BUF_REG,
OMAP_I2C_CNT_REG,
@@ -176,12 +186,37 @@ enum {
#define OMAP_I2C_IP_V2_INTERRUPTS_MASK 0x6FFF
+#define OMAP_I2C_SCHEME(rev) ((rev & 0xc000) >> 14)
+
+#define OMAP_I2C_REV_SCHEME_0_MAJOR(rev) (rev >> 4)
+#define OMAP_I2C_REV_SCHEME_0_MINOR(rev) (rev & 0xf)
+
+#define OMAP_I2C_REV_SCHEME_1_MAJOR(rev) ((rev & 0x0700) >> 7)
+#define OMAP_I2C_REV_SCHEME_1_MINOR(rev) (rev & 0x1f)
+#define OMAP_I2C_SCHEME_0 0
+#define OMAP_I2C_SCHEME_1 1
+
+struct omap_i2c_dma {
+ struct dma_chan *chan_rx;
+ struct dma_chan *chan_tx;
+ struct dma_chan *chan_using;
+ struct device *dma_dev;
+ u8 *curr_msg_buf;
+ struct i2c_msg *curr_msg;
+ dma_addr_t dma_buf;
+ unsigned int dma_len;
+ enum dma_data_direction dma_data_dir;
+ struct completion complete;
+ dma_addr_t phy_addr;
+};
+
struct omap_i2c_dev {
struct device *dev;
void __iomem *base; /* virtual */
int irq;
int reg_shift; /* bit shift for I2C register addresses */
struct completion cmd_complete;
+ struct omap_i2c_dma *dma;
struct resource *ioarea;
u32 latency; /* maximum mpu wkup latency */
void (*set_mpu_wkup_lat)(struct device *dev,
@@ -242,6 +277,10 @@ static const u8 reg_map_ip_v2[] = {
[OMAP_I2C_STAT_REG] = 0x28,
[OMAP_I2C_IV_REG] = 0x34,
[OMAP_I2C_WE_REG] = 0x34,
+ [OMAP_I2C_DMARXENABLE_SET] = 0x38,
+ [OMAP_I2C_DMATXENABLE_SET] = 0x3c,
+ [OMAP_I2C_DMARXENABLE_CLR] = 0x40,
+ [OMAP_I2C_DMATXENABLE_CLR] = 0x44,
[OMAP_I2C_SYSS_REG] = 0x90,
[OMAP_I2C_BUF_REG] = 0x94,
[OMAP_I2C_CNT_REG] = 0x98,
@@ -462,10 +501,7 @@ static int omap_i2c_init(struct omap_i2c_dev *omap)
sclh = fclk_rate / (omap->speed * 2) - 7 + psc;
}
- omap->iestate = (OMAP_I2C_IE_XRDY | OMAP_I2C_IE_RRDY |
- OMAP_I2C_IE_ARDY | OMAP_I2C_IE_NACK |
- OMAP_I2C_IE_AL) | ((omap->fifo_size) ?
- (OMAP_I2C_IE_RDR | OMAP_I2C_IE_XDR) : 0);
+ omap->iestate = OMAP_I2C_IE_ARDY | OMAP_I2C_IE_NACK | OMAP_I2C_IE_AL;
omap->pscstate = psc;
omap->scllstate = scll;
@@ -655,6 +691,144 @@ static void omap_i2c_wait(struct omap_i2c_dev *omap)
} while (!(stat & mask) && count < 5);
}
+static void omap_i2c_dma_callback(void *arg)
+{
+ struct omap_i2c_dev *omap = (struct omap_i2c_dev *)arg;
+
+ complete(&omap->dma->complete);
+}
+
+static int omap_i2c_dma_xfer(struct omap_i2c_dev *omap, struct i2c_msg *msg)
+{
+ int ret;
+ struct dma_slave_config dma_sconfig = {0};
+ struct omap_i2c_dma *dma = omap->dma;
+ struct dma_async_tx_descriptor *txdesc;
+ struct device *dev = &omap->adapter.dev;
+
+ dma->curr_msg = msg;
+
+ dma->curr_msg_buf = i2c_get_dma_safe_msg_buf(msg, 1);
+ if (!dma->curr_msg_buf)
+ return -ENOMEM;
+
+ if (omap->receiver) {
+ dma->chan_using = dma->chan_rx;
+
+ dma_sconfig.src_addr = dma->phy_addr +
+ (omap->regs[OMAP_I2C_DATA_REG]
+ << omap->reg_shift);
+ dma_sconfig.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
+ dma_sconfig.src_maxburst = omap->threshold;
+ dma_sconfig.direction = DMA_DEV_TO_MEM;
+ } else {
+ dma->chan_using = dma->chan_tx;
+
+ dma_sconfig.dst_addr = dma->phy_addr +
+ (omap->regs[OMAP_I2C_DATA_REG]
+ << omap->reg_shift);
+ dma_sconfig.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
+ dma_sconfig.dst_maxburst = omap->threshold;
+ dma_sconfig.direction = DMA_MEM_TO_DEV;
+ }
+
+ ret = dmaengine_slave_config(dma->chan_using, &dma_sconfig);
+ if (ret < 0) {
+ dev_err(dev, "DMA channel config failed: %d\n", ret);
+ goto err_map;
+ }
+
+ dma->dma_len = msg->len;
+ dma->dma_data_dir = omap->receiver ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
+
+ dma->dma_dev = dmaengine_get_dma_device(dma->chan_using);
+
+ dma->dma_buf = dma_map_single(dma->dma_dev, dma->curr_msg_buf,
+ dma->dma_len, dma->dma_data_dir);
+ if (dma_mapping_error(dma->dma_dev, dma->dma_buf)) {
+ dev_err(dev, "DMA mapping failed\n");
+ ret = -EINVAL;
+ goto err_map;
+ }
+
+ txdesc = dmaengine_prep_slave_single(dma->chan_using, dma->dma_buf,
+ dma->dma_len,
+ omap->receiver ? DMA_DEV_TO_MEM :
+ DMA_MEM_TO_DEV,
+ DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
+ if (!txdesc) {
+ dev_err(dev, "Not able to get desc for DMA xfer\n");
+ ret = -EINVAL;
+ goto err_desc;
+ }
+
+ reinit_completion(&dma->complete);
+
+ dmaengine_desc_set_callback(txdesc, omap_i2c_dma_callback, NULL, omap);
+ ret = dma_submit_error(dmaengine_submit(txdesc));
+ if (ret < 0) {
+ dev_err(dev, "DMA submit failed\n");
+ goto err_submit;
+ }
+
+ dma_async_issue_pending(dma->chan_using);
+ return 0;
+
+err_submit:
+ dmaengine_terminate_sync(dma->chan_using);
+err_desc:
+ dma_unmap_single(dma->dma_dev, dma->dma_buf, dma->dma_len,
+ dma->dma_data_dir);
+err_map:
+ i2c_put_dma_safe_msg_buf(dma->curr_msg_buf, msg, false);
+ return ret;
+}
+
+static void omap_i2c_dma_cleanup(struct omap_i2c_dev *omap, bool xferred)
+{
+ struct omap_i2c_dma *dma = omap->dma;
+
+ dma_unmap_single(dma->dma_dev, dma->dma_buf, dma->dma_len,
+ dma->dma_data_dir);
+ i2c_put_dma_safe_msg_buf(dma->curr_msg_buf, dma->curr_msg, xferred);
+}
+
+static void omap_i2c_dma_enable_req(struct omap_i2c_dev *omap)
+{
+ u16 w;
+
+ w = omap_i2c_read_reg(omap, OMAP_I2C_BUF_REG);
+ if (omap->receiver) {
+ w |= OMAP_I2C_BUF_RDMA_EN;
+ omap_i2c_write_reg(omap, OMAP_I2C_BUF_REG, w);
+
+ omap_i2c_write_reg(omap, OMAP_I2C_DMARXENABLE_SET, 1);
+ } else {
+ w |= OMAP_I2C_BUF_XDMA_EN;
+ omap_i2c_write_reg(omap, OMAP_I2C_BUF_REG, w);
+
+ omap_i2c_write_reg(omap, OMAP_I2C_DMATXENABLE_SET, 1);
+ }
+}
+
+static void omap_i2c_dma_disable_req(struct omap_i2c_dev *omap)
+{
+ u16 w;
+
+ w = omap_i2c_read_reg(omap, OMAP_I2C_BUF_REG);
+ if (omap->receiver) {
+ w &= ~OMAP_I2C_BUF_RDMA_EN;
+ omap_i2c_write_reg(omap, OMAP_I2C_BUF_REG, w);
+
+ omap_i2c_write_reg(omap, OMAP_I2C_DMARXENABLE_CLR, 1);
+ } else {
+ w &= ~OMAP_I2C_BUF_XDMA_EN;
+ omap_i2c_write_reg(omap, OMAP_I2C_BUF_REG, w);
+
+ omap_i2c_write_reg(omap, OMAP_I2C_DMATXENABLE_CLR, 1);
+ }
+}
+
/*
* Low level master read/write transaction.
*/
@@ -663,8 +837,8 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
{
struct omap_i2c_dev *omap = i2c_get_adapdata(adap);
unsigned long time_left;
- u16 w;
- int ret;
+ u16 w, pio_irq_mask;
+ int ret, use_dma;
dev_dbg(omap->dev, "addr: 0x%04x, len: %d, flags: 0x%x, stop: %d\n",
msg->addr, msg->len, msg->flags, stop);
@@ -672,6 +846,14 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
omap->receiver = !!(msg->flags & I2C_M_RD);
omap_i2c_resize_fifo(omap, msg->len, omap->receiver);
+ /**
+ * REVISIT: If the message size is not a multiple of the threshold,
+ * the draining feature must be used.
+ */
+ use_dma = !polling && omap->dma && msg->len >= OMAP_I2C_DMA_THRESHOLD &&
+ !(omap->flags & OMAP_I2C_FLAG_NO_FIFO) &&
+ msg->len % omap->threshold == 0;
+
omap_i2c_write_reg(omap, OMAP_I2C_SA_REG, msg->addr);
/* REVISIT: Could the STB bit of I2C_CON be used with probing? */
@@ -692,6 +874,27 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
reinit_completion(&omap->cmd_complete);
omap->cmd_err = 0;
+ if (use_dma) {
+ ret = omap_i2c_dma_xfer(omap, msg);
+ if (ret) {
+ omap_i2c_reset(omap);
+ __omap_i2c_init(omap);
+ return ret;
+ }
+
+ omap_i2c_dma_enable_req(omap);
+ } else {
+ pio_irq_mask = OMAP_I2C_IE_XRDY | OMAP_I2C_IE_RRDY |
+ ((omap->fifo_size) ? (OMAP_I2C_IE_RDR |
+ OMAP_I2C_IE_XDR) : 0);
+
+ if (omap->scheme == OMAP_I2C_SCHEME_0)
+ omap_i2c_write_reg(omap, OMAP_I2C_IE_REG,
+ omap->iestate | pio_irq_mask);
+ else
+ omap_i2c_write_reg(omap, OMAP_I2C_IE_REG, pio_irq_mask);
+ }
+
w = OMAP_I2C_CON_EN | OMAP_I2C_CON_MST | OMAP_I2C_CON_STT;
/* High speed configuration */
@@ -727,6 +930,16 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
if (time_after(jiffies, delay)) {
dev_err(omap->dev, "controller timed out "
"waiting for start condition to finish\n");
+
+ if (omap->scheme == OMAP_I2C_SCHEME_0)
+ omap_i2c_write_reg(omap,
+ OMAP_I2C_IE_REG,
+ omap->iestate);
+ else
+ omap_i2c_write_reg(omap,
+ OMAP_I2C_IP_V2_IRQENABLE_CLR,
+ pio_irq_mask);
+
return -ETIMEDOUT;
}
cpu_relax();
@@ -742,8 +955,15 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
* into arbitration and we're currently unable to recover from it.
*/
if (!polling) {
- time_left = wait_for_completion_timeout(&omap->cmd_complete,
- OMAP_I2C_TIMEOUT);
+ time_left = OMAP_I2C_TIMEOUT;
+
+ if (use_dma)
+ time_left = wait_for_completion_timeout(&omap->dma->complete,
+ time_left);
+
+ if (time_left && !omap->cmd_err)
+ time_left = wait_for_completion_timeout(&omap->cmd_complete,
+ time_left);
} else {
do {
omap_i2c_wait(omap);
@@ -753,7 +973,23 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
time_left = !ret;
}
- if (time_left == 0) {
+ if (use_dma) {
+ if (!time_left || omap->cmd_err)
+ dmaengine_terminate_sync(omap->dma->chan_using);
+
+ omap_i2c_dma_cleanup(omap, time_left && !omap->cmd_err);
+
+ omap_i2c_dma_disable_req(omap);
+ } else {
+ if (omap->scheme == OMAP_I2C_SCHEME_0)
+ omap_i2c_write_reg(omap, OMAP_I2C_IE_REG,
+ omap->iestate);
+ else
+ omap_i2c_write_reg(omap, OMAP_I2C_IP_V2_IRQENABLE_CLR,
+ pio_irq_mask);
+ }
+
+ if (!time_left && likely(!omap->cmd_err)) {
omap_i2c_reset(omap);
__omap_i2c_init(omap);
return -ETIMEDOUT;
@@ -1253,16 +1489,6 @@ static const struct of_device_id omap_i2c_of_match[] = {
MODULE_DEVICE_TABLE(of, omap_i2c_of_match);
#endif
-#define OMAP_I2C_SCHEME(rev) ((rev & 0xc000) >> 14)
-
-#define OMAP_I2C_REV_SCHEME_0_MAJOR(rev) (rev >> 4)
-#define OMAP_I2C_REV_SCHEME_0_MINOR(rev) (rev & 0xf)
-
-#define OMAP_I2C_REV_SCHEME_1_MAJOR(rev) ((rev & 0x0700) >> 7)
-#define OMAP_I2C_REV_SCHEME_1_MINOR(rev) (rev & 0x1f)
-#define OMAP_I2C_SCHEME_0 0
-#define OMAP_I2C_SCHEME_1 1
-
static int omap_i2c_get_scl(struct i2c_adapter *adap)
{
struct omap_i2c_dev *dev = i2c_get_adapdata(adap);
@@ -1336,10 +1562,70 @@ static struct i2c_bus_recovery_info omap_i2c_bus_recovery_info = {
.recover_bus = i2c_generic_scl_recovery,
};
+static struct omap_i2c_dma *omap_i2c_dma_init(struct omap_i2c_dev *omap,
+ dma_addr_t phy_addr)
+{
+ struct device *dev = omap->dev;
+ struct omap_i2c_dma *dma;
+ int ret;
+
+ dma = devm_kzalloc(dev, sizeof(*dma), GFP_KERNEL);
+ if (!dma)
+ return ERR_PTR(-ENOMEM);
+
+ dma->phy_addr = phy_addr;
+
+ init_completion(&dma->complete);
+
+ dma->chan_tx = dma_request_chan(dev, "tx");
+ if (IS_ERR(dma->chan_tx)) {
+ ret = PTR_ERR(dma->chan_tx);
+ if (ret != -ENODEV)
+ dev_err_probe(dev, ret,
+ "can't request DMA tx channel\n");
+ goto dma_free;
+ }
+
+ dma->chan_rx = dma_request_chan(dev, "rx");
+ if (IS_ERR(dma->chan_rx)) {
+ ret = PTR_ERR(dma->chan_rx);
+ if (ret != -ENODEV)
+ dev_err_probe(dev, ret,
+ "can't request DMA rx channel\n");
+ goto dma_tx_fail;
+ }
+
+ return dma;
+
+dma_tx_fail:
+ dma_release_channel(dma->chan_tx);
+dma_free:
+ devm_kfree(dev, dma);
+
+ return ERR_PTR(ret);
+}
+
+static void omap_i2c_dma_free(struct omap_i2c_dev *omap)
+{
+ struct omap_i2c_dma *dma = omap->dma;
+
+ dma->dma_buf = 0;
+ dma->dma_len = 0;
+
+ dma_release_channel(dma->chan_tx);
+ dma->chan_tx = NULL;
+
+ dma_release_channel(dma->chan_rx);
+ dma->chan_rx = NULL;
+
+ dma->chan_using = NULL;
+}
+
static int
omap_i2c_probe(struct platform_device *pdev)
{
struct omap_i2c_dev *omap;
+ struct resource *res;
struct i2c_adapter *adap;
const struct omap_i2c_bus_platform_data *pdata =
dev_get_platdata(&pdev->dev);
@@ -1357,7 +1643,7 @@ omap_i2c_probe(struct platform_device *pdev)
if (!omap)
return -ENOMEM;
- omap->base = devm_platform_ioremap_resource(pdev, 0);
+ omap->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
if (IS_ERR(omap->base))
return PTR_ERR(omap->base);
@@ -1476,6 +1762,22 @@ omap_i2c_probe(struct platform_device *pdev)
goto err_unuse_clocks;
}
+ if (omap->scheme != OMAP_I2C_SCHEME_0) {
+ omap->dma = omap_i2c_dma_init(omap, (dma_addr_t)res->start);
+ if (PTR_ERR(omap->dma) == -EPROBE_DEFER) {
+ r = -EPROBE_DEFER;
+ dev_err_probe(&pdev->dev, r,
+ "can't get DMA channels\n");
+ goto err_unuse_clocks;
+ } else if (PTR_ERR(omap->dma) == -ENODEV) {
+ dev_dbg(omap->dev, "DMA setup failed\n");
+ omap->dma = NULL;
+ } else if (IS_ERR(omap->dma)) {
+ r = PTR_ERR(omap->dma);
+ goto err_unuse_clocks;
+ }
+ }
+
adap = &omap->adapter;
i2c_set_adapdata(adap, omap);
adap->owner = THIS_MODULE;
@@ -1491,7 +1793,7 @@ omap_i2c_probe(struct platform_device *pdev)
adap->nr = pdev->id;
r = i2c_add_numbered_adapter(adap);
if (r)
- goto err_unuse_clocks;
+ goto err_dma_free;
dev_info(omap->dev, "bus %d rev%d.%d at %d kHz\n", adap->nr,
major, minor, omap->speed);
@@ -1500,6 +1802,8 @@ omap_i2c_probe(struct platform_device *pdev)
return 0;
+err_dma_free:
+ omap_i2c_dma_free(omap);
err_unuse_clocks:
omap_i2c_write_reg(omap, OMAP_I2C_CON_REG, 0);
err_put_pm:
@@ -1521,6 +1825,9 @@ static void omap_i2c_remove(struct platform_device *pdev)
if (omap->mux_state)
mux_state_deselect(omap->mux_state);
+ if (omap->dma)
+ omap_i2c_dma_free(omap);
+
ret = pm_runtime_get_sync(&pdev->dev);
if (ret < 0)
dev_err(omap->dev, "Failed to resume hardware, skip disable\n");
--
2.56.1
^ permalink raw reply related [flat|nested] 6+ messages in thread