i3c: master: svc: return actual transfer data len

I3C allow devices early terminate data transfer. So set "actual_len" to
indicate how much data get by i3c_priv_xfer.

Reviewed-by: Miquel Raynal <miquel.raynal@bootlin.com>
Signed-off-by: Frank Li <Frank.Li@nxp.com>
Link: https://lore.kernel.org/r/20231201222532.2431484-6-Frank.Li@nxp.com
Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com>

diff --git a/drivers/i3c/master/svc-i3c-master.c b/drivers/i3c/master/svc-i3c-master.c
index ad2f486ccf888a903bf0d272eac7150b0e426413..5ee4db68988e2388a56c18d22b1d882b0c13adac 100644 (file)
--- a/drivers/i3c/master/svc-i3c-master.c
+++ b/drivers/i3c/master/svc-i3c-master.c
@@ -138,6 +138,7 @@ struct svc_i3c_cmd {
        const void *out;
        unsigned int len;
        unsigned int actual_len;
+       struct i3c_priv_xfer *xfer;
        bool continued;
 };
 
@@ -1062,6 +1063,7 @@ static int svc_i3c_master_xfer(struct svc_i3c_master *master,
 
        if (readl(master->regs + SVC_I3C_MERRWARN) & SVC_I3C_MERRWARN_NACK) {
                ret = -ENXIO;
+               *actual_len = 0;
                goto emit_stop;
        }
 
@@ -1079,6 +1081,7 @@ static int svc_i3c_master_xfer(struct svc_i3c_master *master,
         */
        if (SVC_I3C_MSTATUS_IBIWON(reg)) {
                ret = -ENXIO;
+               *actual_len = 0;
                goto emit_stop;
        }
 
@@ -1174,6 +1177,10 @@ static void svc_i3c_master_start_xfer_locked(struct svc_i3c_master *master)
                                          cmd->addr, cmd->in, cmd->out,
                                          cmd->len, &cmd->actual_len,
                                          cmd->continued);
+               /* cmd->xfer is NULL if I2C or CCC transfer */
+               if (cmd->xfer)
+                       cmd->xfer->actual_len = cmd->actual_len;
+
                if (ret)
                        break;
        }
@@ -1361,6 +1368,7 @@ static int svc_i3c_master_priv_xfers(struct i3c_dev_desc *dev,
        for (i = 0; i < nxfers; i++) {
                struct svc_i3c_cmd *cmd = &xfer->cmds[i];
 
+               cmd->xfer = &xfers[i];
                cmd->addr = master->addrs[data->index];
                cmd->rnw = xfers[i].rnw;
                cmd->in = xfers[i].rnw ? xfers[i].data.in : NULL;