Use common inline i3c_writel_fifo()/i3c_readl_fifo() methods to
simplify code since the FIFO of controller is a 32bit width.
Signed-off-by: Jorge Marques <jorge.marques@analog.com>
---
drivers/i3c/master/i3c-master-cdns.c | 25 +++++--------------------
1 file changed, 5 insertions(+), 20 deletions(-)
diff --git a/drivers/i3c/master/i3c-master-cdns.c b/drivers/i3c/master/i3c-master-cdns.c
index fd3752cea654954ed1e37337754e45fddbbbf68e..321c04d2109ec1951f2b07a9d1b88c6aaf055c95 100644
--- a/drivers/i3c/master/i3c-master-cdns.c
+++ b/drivers/i3c/master/i3c-master-cdns.c
@@ -23,6 +23,8 @@
#include <linux/spinlock.h>
#include <linux/workqueue.h>
+#include "../internals.h"
+
#define DEV_ID 0x0
#define DEV_ID_I3C_MASTER 0x5034
@@ -427,25 +429,13 @@ to_cdns_i3c_master(struct i3c_master_controller *master)
static void cdns_i3c_master_wr_to_tx_fifo(struct cdns_i3c_master *master,
const u8 *bytes, int nbytes)
{
- writesl(master->regs + TX_FIFO, bytes, nbytes / 4);
- if (nbytes & 3) {
- u32 tmp = 0;
-
- memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3);
- writesl(master->regs + TX_FIFO, &tmp, 1);
- }
+ i3c_writel_fifo(master->regs + TX_FIFO, bytes, nbytes);
}
static void cdns_i3c_master_rd_from_rx_fifo(struct cdns_i3c_master *master,
u8 *bytes, int nbytes)
{
- readsl(master->regs + RX_FIFO, bytes, nbytes / 4);
- if (nbytes & 3) {
- u32 tmp;
-
- readsl(master->regs + RX_FIFO, &tmp, 1);
- memcpy(bytes + (nbytes & ~3), &tmp, nbytes & 3);
- }
+ i3c_readl_fifo(master->regs + RX_FIFO, bytes, nbytes);
}
static bool cdns_i3c_master_supports_ccc_cmd(struct i3c_master_controller *m,
@@ -1330,12 +1320,7 @@ static void cdns_i3c_master_handle_ibi(struct cdns_i3c_master *master,
buf = slot->data;
nbytes = IBIR_XFER_BYTES(ibir);
- readsl(master->regs + IBI_DATA_FIFO, buf, nbytes / 4);
- if (nbytes % 3) {
- u32 tmp = __raw_readl(master->regs + IBI_DATA_FIFO);
-
- memcpy(buf + (nbytes & ~3), &tmp, nbytes & 3);
- }
+ i3c_readl_fifo(master->regs + IBI_DATA_FIFO, buf, nbytes);
slot->len = min_t(unsigned int, IBIR_XFER_BYTES(ibir),
dev->ibi->max_payload_len);
--
2.49.0
> static void cdns_i3c_master_wr_to_tx_fifo(struct cdns_i3c_master *master, > const u8 *bytes, int nbytes) > { > - writesl(master->regs + TX_FIFO, bytes, nbytes / 4); > - if (nbytes & 3) { > - u32 tmp = 0; > - > - memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3); > - writesl(master->regs + TX_FIFO, &tmp, 1); > - } > + i3c_writel_fifo(master->regs + TX_FIFO, bytes, nbytes); > } What about getting rid of the surrounding function and use the helper directly?
On Tue, Jun 24, 2025 at 11:06:05AM +0200, Jorge Marques wrote: > Use common inline i3c_writel_fifo()/i3c_readl_fifo() methods to > simplify code since the FIFO of controller is a 32bit width. > > Signed-off-by: Jorge Marques <jorge.marques@analog.com> Reviewed-by: Frank Li <Frank.Li@nxp.com> > --- > drivers/i3c/master/i3c-master-cdns.c | 25 +++++-------------------- > 1 file changed, 5 insertions(+), 20 deletions(-) > > diff --git a/drivers/i3c/master/i3c-master-cdns.c b/drivers/i3c/master/i3c-master-cdns.c > index fd3752cea654954ed1e37337754e45fddbbbf68e..321c04d2109ec1951f2b07a9d1b88c6aaf055c95 100644 > --- a/drivers/i3c/master/i3c-master-cdns.c > +++ b/drivers/i3c/master/i3c-master-cdns.c > @@ -23,6 +23,8 @@ > #include <linux/spinlock.h> > #include <linux/workqueue.h> > > +#include "../internals.h" > + > #define DEV_ID 0x0 > #define DEV_ID_I3C_MASTER 0x5034 > > @@ -427,25 +429,13 @@ to_cdns_i3c_master(struct i3c_master_controller *master) > static void cdns_i3c_master_wr_to_tx_fifo(struct cdns_i3c_master *master, > const u8 *bytes, int nbytes) > { > - writesl(master->regs + TX_FIFO, bytes, nbytes / 4); > - if (nbytes & 3) { > - u32 tmp = 0; > - > - memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3); > - writesl(master->regs + TX_FIFO, &tmp, 1); > - } > + i3c_writel_fifo(master->regs + TX_FIFO, bytes, nbytes); > } > > static void cdns_i3c_master_rd_from_rx_fifo(struct cdns_i3c_master *master, > u8 *bytes, int nbytes) > { > - readsl(master->regs + RX_FIFO, bytes, nbytes / 4); > - if (nbytes & 3) { > - u32 tmp; > - > - readsl(master->regs + RX_FIFO, &tmp, 1); > - memcpy(bytes + (nbytes & ~3), &tmp, nbytes & 3); > - } > + i3c_readl_fifo(master->regs + RX_FIFO, bytes, nbytes); > } > > static bool cdns_i3c_master_supports_ccc_cmd(struct i3c_master_controller *m, > @@ -1330,12 +1320,7 @@ static void cdns_i3c_master_handle_ibi(struct cdns_i3c_master *master, > buf = slot->data; > > nbytes = IBIR_XFER_BYTES(ibir); > - readsl(master->regs + IBI_DATA_FIFO, buf, nbytes / 4); > - if (nbytes % 3) { > - u32 tmp = __raw_readl(master->regs + IBI_DATA_FIFO); > - > - memcpy(buf + (nbytes & ~3), &tmp, nbytes & 3); > - } > + i3c_readl_fifo(master->regs + IBI_DATA_FIFO, buf, nbytes); > > slot->len = min_t(unsigned int, IBIR_XFER_BYTES(ibir), > dev->ibi->max_payload_len); > > -- > 2.49.0 > > > -- > linux-i3c mailing list > linux-i3c@lists.infradead.org > http://lists.infradead.org/mailman/listinfo/linux-i3c
© 2016 - 2025 Red Hat, Inc.