Hi Tomi and Sebastian, Thank you for the patch. On Thu, Nov 05, 2020 at 02:02:49PM +0200, Tomi Valkeinen wrote: > From: Sebastian Reichel <sebastian.reichel@xxxxxxxxxxxxx> > > Simplify the DSI encoder by using mipi_dsi_msg for > dsi_vc_send_long and dsi_vc_send_short. Further improvements > require cleaning up the channel allocation code first. > > Signed-off-by: Sebastian Reichel <sebastian.reichel@xxxxxxxxxxxxx> > Signed-off-by: Tomi Valkeinen <tomi.valkeinen@xxxxxx> > --- > drivers/gpu/drm/omapdrm/dss/dsi.c | 89 ++++++++++++++----------------- > 1 file changed, 40 insertions(+), 49 deletions(-) > > diff --git a/drivers/gpu/drm/omapdrm/dss/dsi.c b/drivers/gpu/drm/omapdrm/dss/dsi.c > index bbdc52ee3559..6fa7833e32ad 100644 > --- a/drivers/gpu/drm/omapdrm/dss/dsi.c > +++ b/drivers/gpu/drm/omapdrm/dss/dsi.c > @@ -2599,8 +2599,8 @@ static inline void dsi_vc_write_long_payload(struct dsi_data *dsi, int channel, > dsi_write_reg(dsi, DSI_VC_LONG_PACKET_PAYLOAD(channel), val); > } > > -static int dsi_vc_send_long(struct dsi_data *dsi, int channel, u8 data_type, > - const u8 *data, u16 len, u8 ecc) > +static int dsi_vc_send_long(struct dsi_data *dsi, > + const struct mipi_dsi_msg *msg) > { > /*u32 val; */ > int i; > @@ -2609,20 +2609,20 @@ static int dsi_vc_send_long(struct dsi_data *dsi, int channel, u8 data_type, > u8 b1, b2, b3, b4; > > if (dsi->debug_write) > - DSSDBG("dsi_vc_send_long, %d bytes\n", len); > + DSSDBG("dsi_vc_send_long, %d bytes\n", msg->tx_len); > > /* len + header */ > - if (dsi->vc[channel].tx_fifo_size * 32 * 4 < len + 4) { > + if (dsi->vc[msg->channel].tx_fifo_size * 32 * 4 < msg->tx_len + 4) { > DSSERR("unable to send long packet: packet too long.\n"); > return -EINVAL; > } > > - dsi_vc_config_source(dsi, channel, DSI_VC_SOURCE_L4); > + dsi_vc_config_source(dsi, msg->channel, DSI_VC_SOURCE_L4); > > - dsi_vc_write_long_header(dsi, channel, data_type, len, ecc); > + dsi_vc_write_long_header(dsi, msg->channel, msg->type, msg->tx_len, 0); > > - p = data; > - for (i = 0; i < len >> 2; i++) { > + p = msg->tx_buf; > + for (i = 0; i < msg->tx_len >> 2; i++) { > if (dsi->debug_write) > DSSDBG("\tsending full packet %d\n", i); > > @@ -2631,10 +2631,10 @@ static int dsi_vc_send_long(struct dsi_data *dsi, int channel, u8 data_type, > b3 = *p++; > b4 = *p++; > > - dsi_vc_write_long_payload(dsi, channel, b1, b2, b3, b4); > + dsi_vc_write_long_payload(dsi, msg->channel, b1, b2, b3, b4); > } > > - i = len % 4; > + i = msg->tx_len % 4; > if (i) { > b1 = 0; b2 = 0; b3 = 0; > > @@ -2656,65 +2656,64 @@ static int dsi_vc_send_long(struct dsi_data *dsi, int channel, u8 data_type, > break; > } > > - dsi_vc_write_long_payload(dsi, channel, b1, b2, b3, 0); > + dsi_vc_write_long_payload(dsi, msg->channel, b1, b2, b3, 0); > } > > return r; > } > > -static int dsi_vc_send_short(struct dsi_data *dsi, int channel, u8 data_type, > - u16 data, u8 ecc) > +static int dsi_vc_send_short(struct dsi_data *dsi, > + const struct mipi_dsi_msg *msg) > { > + struct mipi_dsi_packet pkt; > u32 r; > - u8 data_id; > + > + r = mipi_dsi_create_packet(&pkt, msg); > + if (r < 0) > + return r; > > WARN_ON(!dsi_bus_is_locked(dsi)); > > if (dsi->debug_write) > DSSDBG("dsi_vc_send_short(ch%d, dt %#x, b1 %#x, b2 %#x)\n", > - channel, > - data_type, data & 0xff, (data >> 8) & 0xff); > + msg->channel, > + msg->type, pkt.header[1], pkt.header[2]); You could fix the indentation while at it. Reviewed-by: Laurent Pinchart <laurent.pinchart@xxxxxxxxxxxxxxxx> > > - dsi_vc_config_source(dsi, channel, DSI_VC_SOURCE_L4); > + dsi_vc_config_source(dsi, msg->channel, DSI_VC_SOURCE_L4); > > - if (FLD_GET(dsi_read_reg(dsi, DSI_VC_CTRL(channel)), 16, 16)) { > + if (FLD_GET(dsi_read_reg(dsi, DSI_VC_CTRL(msg->channel)), 16, 16)) { > DSSERR("ERROR FIFO FULL, aborting transfer\n"); > return -EINVAL; > } > > - data_id = data_type | channel << 6; > - > - r = (data_id << 0) | (data << 8) | (ecc << 24); > + r = pkt.header[3] << 24 | pkt.header[2] << 16 | pkt.header[1] << 8 | > + pkt.header[0]; > > - dsi_write_reg(dsi, DSI_VC_SHORT_PACKET_HEADER(channel), r); > + dsi_write_reg(dsi, DSI_VC_SHORT_PACKET_HEADER(msg->channel), r); > > return 0; > } > > static int dsi_vc_send_null(struct dsi_data *dsi, int channel) > { > - return dsi_vc_send_long(dsi, channel, MIPI_DSI_NULL_PACKET, NULL, 0, 0); > + const struct mipi_dsi_msg msg = { > + .channel = channel, > + .type = MIPI_DSI_NULL_PACKET, > + }; > + > + return dsi_vc_send_long(dsi, &msg); > } > > static int dsi_vc_write_common(struct omap_dss_device *dssdev, > const struct mipi_dsi_msg *msg) > { > struct dsi_data *dsi = to_dsi_data(dssdev); > - struct mipi_dsi_packet packet; > int r; > > - r = mipi_dsi_create_packet(&packet, msg); > - if (r < 0) > - return r; > - > - if (mipi_dsi_packet_format_is_short(msg->type)) { > - u16 data = packet.header[1] | (packet.header[2] << 8); > - > - r = dsi_vc_send_short(dsi, msg->channel, msg->type, data, 0); > - } else { > - r = dsi_vc_send_long(dsi, msg->channel, msg->type, > - msg->tx_buf, msg->tx_len, 0); > - } > + if (mipi_dsi_packet_format_is_short(msg->type)) > + r = dsi_vc_send_short(dsi, msg); > + else > + r = dsi_vc_send_long(dsi, msg); > > if (r < 0) > return r; > @@ -2854,14 +2853,14 @@ static int dsi_vc_dcs_read(struct omap_dss_device *dssdev, > const struct mipi_dsi_msg *msg) > { > struct dsi_data *dsi = to_dsi_data(dssdev); > - u8 dcs_cmd = ((u8 *)msg->tx_buf)[0]; > + u8 cmd = ((u8 *)msg->tx_buf)[0]; > u8 channel = msg->channel; > int r; > > if (dsi->debug_read) > - DSSDBG("%s(ch %d, cmd %x)\n", __func__, channel, dcs_cmd); > + DSSDBG("%s(ch %d, cmd %x)\n", __func__, channel, cmd); > > - r = dsi_vc_send_short(dsi, channel, MIPI_DSI_DCS_READ, dcs_cmd, 0); > + r = dsi_vc_send_short(dsi, msg); > if (r) > goto err; > > @@ -2881,7 +2880,7 @@ static int dsi_vc_dcs_read(struct omap_dss_device *dssdev, > > return 0; > err: > - DSSERR("%s(ch %d, cmd 0x%02x) failed\n", __func__, msg->channel, dcs_cmd); > + DSSERR("%s(ch %d, cmd 0x%02x) failed\n", __func__, msg->channel, cmd); > return r; > } > > @@ -2889,17 +2888,9 @@ static int dsi_vc_generic_read(struct omap_dss_device *dssdev, > const struct mipi_dsi_msg *msg) > { > struct dsi_data *dsi = to_dsi_data(dssdev); > - struct mipi_dsi_packet packet; > - u16 data; > int r; > > - r = mipi_dsi_create_packet(&packet, msg); > - if (r < 0) > - goto err; > - > - data = packet.header[1] | (packet.header[2] << 8); > - > - r = dsi_vc_send_short(dsi, msg->channel, msg->type, data, 0); > + r = dsi_vc_send_short(dsi, msg); > if (r) > goto err; > -- Regards, Laurent Pinchart