Message ID | 20230418163018.785524-3-quic_bjorande@quicinc.com (mailing list archive) |
---|---|
State | Accepted |
Headers | show |
Series | rpmsg: glink: Fix + cleanup in __qcom_glink_send() | expand |
On 4/18/2023 9:30 AM, Bjorn Andersson wrote: > Rather than duplicating most of the code for constructing the initial > TX_DATA and subsequent TX_DATA_CONT packets, roll them into a single > loop. > > Signed-off-by: Bjorn Andersson <quic_bjorande@quicinc.com> > --- > > Changes since v1: > - Reduced unnecessary complexity in the chunking condition > Reviewed-by: Chris Lew <quic_clew@quicinc.com> > drivers/rpmsg/qcom_glink_native.c | 46 +++++++++---------------------- > 1 file changed, 13 insertions(+), 33 deletions(-) > > diff --git a/drivers/rpmsg/qcom_glink_native.c b/drivers/rpmsg/qcom_glink_native.c > index 62634d020d13..7e6fad4e02f8 100644 > --- a/drivers/rpmsg/qcom_glink_native.c > +++ b/drivers/rpmsg/qcom_glink_native.c > @@ -1309,7 +1309,7 @@ static int __qcom_glink_send(struct glink_channel *channel, > int ret; > unsigned long flags; > int chunk_size = len; > - int left_size = 0; > + size_t offset = 0; > > if (!glink->intentless) { > while (!intent) { > @@ -1343,49 +1343,29 @@ static int __qcom_glink_send(struct glink_channel *channel, > iid = intent->id; > } > > - if (wait && chunk_size > SZ_8K) { > - chunk_size = SZ_8K; > - left_size = len - chunk_size; > - } > - req.msg.cmd = cpu_to_le16(GLINK_CMD_TX_DATA); > - req.msg.param1 = cpu_to_le16(channel->lcid); > - req.msg.param2 = cpu_to_le32(iid); > - req.chunk_size = cpu_to_le32(chunk_size); > - req.left_size = cpu_to_le32(left_size); > - > - ret = qcom_glink_tx(glink, &req, sizeof(req), data, chunk_size, wait); > - > - /* Mark intent available if we failed */ > - if (ret) { > - if (intent) > - intent->in_use = false; > - return ret; > - } > - > - while (left_size > 0) { > - data = (void *)((char *)data + chunk_size); > - chunk_size = left_size; > - if (chunk_size > SZ_8K) > + while (offset < len) { > + chunk_size = len - offset; > + if (chunk_size > SZ_8K && wait) > chunk_size = SZ_8K; > - left_size -= chunk_size; > > - req.msg.cmd = cpu_to_le16(GLINK_CMD_TX_DATA_CONT); > + req.msg.cmd = cpu_to_le16(offset == 0 ? GLINK_CMD_TX_DATA : GLINK_CMD_TX_DATA_CONT); > req.msg.param1 = cpu_to_le16(channel->lcid); > req.msg.param2 = cpu_to_le32(iid); > req.chunk_size = cpu_to_le32(chunk_size); > - req.left_size = cpu_to_le32(left_size); > + req.left_size = cpu_to_le32(len - offset - chunk_size); > > - ret = qcom_glink_tx(glink, &req, sizeof(req), data, > - chunk_size, wait); > - > - /* Mark intent available if we failed */ > + ret = qcom_glink_tx(glink, &req, sizeof(req), data + offset, chunk_size, wait); > if (ret) { > + /* Mark intent available if we failed */ > if (intent) > intent->in_use = false; > - break; > + return ret; > } > + > + offset += chunk_size; > } > - return ret; > + > + return 0; > } > > static int qcom_glink_send(struct rpmsg_endpoint *ept, void *data, int len) >
diff --git a/drivers/rpmsg/qcom_glink_native.c b/drivers/rpmsg/qcom_glink_native.c index 62634d020d13..7e6fad4e02f8 100644 --- a/drivers/rpmsg/qcom_glink_native.c +++ b/drivers/rpmsg/qcom_glink_native.c @@ -1309,7 +1309,7 @@ static int __qcom_glink_send(struct glink_channel *channel, int ret; unsigned long flags; int chunk_size = len; - int left_size = 0; + size_t offset = 0; if (!glink->intentless) { while (!intent) { @@ -1343,49 +1343,29 @@ static int __qcom_glink_send(struct glink_channel *channel, iid = intent->id; } - if (wait && chunk_size > SZ_8K) { - chunk_size = SZ_8K; - left_size = len - chunk_size; - } - req.msg.cmd = cpu_to_le16(GLINK_CMD_TX_DATA); - req.msg.param1 = cpu_to_le16(channel->lcid); - req.msg.param2 = cpu_to_le32(iid); - req.chunk_size = cpu_to_le32(chunk_size); - req.left_size = cpu_to_le32(left_size); - - ret = qcom_glink_tx(glink, &req, sizeof(req), data, chunk_size, wait); - - /* Mark intent available if we failed */ - if (ret) { - if (intent) - intent->in_use = false; - return ret; - } - - while (left_size > 0) { - data = (void *)((char *)data + chunk_size); - chunk_size = left_size; - if (chunk_size > SZ_8K) + while (offset < len) { + chunk_size = len - offset; + if (chunk_size > SZ_8K && wait) chunk_size = SZ_8K; - left_size -= chunk_size; - req.msg.cmd = cpu_to_le16(GLINK_CMD_TX_DATA_CONT); + req.msg.cmd = cpu_to_le16(offset == 0 ? GLINK_CMD_TX_DATA : GLINK_CMD_TX_DATA_CONT); req.msg.param1 = cpu_to_le16(channel->lcid); req.msg.param2 = cpu_to_le32(iid); req.chunk_size = cpu_to_le32(chunk_size); - req.left_size = cpu_to_le32(left_size); + req.left_size = cpu_to_le32(len - offset - chunk_size); - ret = qcom_glink_tx(glink, &req, sizeof(req), data, - chunk_size, wait); - - /* Mark intent available if we failed */ + ret = qcom_glink_tx(glink, &req, sizeof(req), data + offset, chunk_size, wait); if (ret) { + /* Mark intent available if we failed */ if (intent) intent->in_use = false; - break; + return ret; } + + offset += chunk_size; } - return ret; + + return 0; } static int qcom_glink_send(struct rpmsg_endpoint *ept, void *data, int len)
Rather than duplicating most of the code for constructing the initial TX_DATA and subsequent TX_DATA_CONT packets, roll them into a single loop. Signed-off-by: Bjorn Andersson <quic_bjorande@quicinc.com> --- Changes since v1: - Reduced unnecessary complexity in the chunking condition drivers/rpmsg/qcom_glink_native.c | 46 +++++++++---------------------- 1 file changed, 13 insertions(+), 33 deletions(-)