OMAP: DSS2: DSI: add error prints
Add error printing for dsi_vc_dcs_write() and dsi_vc_dcs_read(). Signed-off-by: Tomi Valkeinen <tomi.valkeinen@nokia.com>
This commit is contained in:
parent
6068475400
commit
5d68e0326b
1 changed files with 34 additions and 13 deletions
|
@ -2081,10 +2081,16 @@ int dsi_vc_dcs_write(int channel, u8 *data, int len)
|
||||||
|
|
||||||
r = dsi_vc_dcs_write_nosync(channel, data, len);
|
r = dsi_vc_dcs_write_nosync(channel, data, len);
|
||||||
if (r)
|
if (r)
|
||||||
return r;
|
goto err;
|
||||||
|
|
||||||
r = dsi_vc_send_bta_sync(channel);
|
r = dsi_vc_send_bta_sync(channel);
|
||||||
|
if (r)
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
err:
|
||||||
|
DSSERR("dsi_vc_dcs_write(ch %d, cmd 0x%02x, len %d) failed\n",
|
||||||
|
channel, data[0], len);
|
||||||
return r;
|
return r;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(dsi_vc_dcs_write);
|
EXPORT_SYMBOL(dsi_vc_dcs_write);
|
||||||
|
@ -2115,16 +2121,17 @@ int dsi_vc_dcs_read(int channel, u8 dcs_cmd, u8 *buf, int buflen)
|
||||||
|
|
||||||
r = dsi_vc_send_short(channel, DSI_DT_DCS_READ, dcs_cmd, 0);
|
r = dsi_vc_send_short(channel, DSI_DT_DCS_READ, dcs_cmd, 0);
|
||||||
if (r)
|
if (r)
|
||||||
return r;
|
goto err;
|
||||||
|
|
||||||
r = dsi_vc_send_bta_sync(channel);
|
r = dsi_vc_send_bta_sync(channel);
|
||||||
if (r)
|
if (r)
|
||||||
return r;
|
goto err;
|
||||||
|
|
||||||
/* RX_FIFO_NOT_EMPTY */
|
/* RX_FIFO_NOT_EMPTY */
|
||||||
if (REG_GET(DSI_VC_CTRL(channel), 20, 20) == 0) {
|
if (REG_GET(DSI_VC_CTRL(channel), 20, 20) == 0) {
|
||||||
DSSERR("RX fifo empty when trying to read.\n");
|
DSSERR("RX fifo empty when trying to read.\n");
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
}
|
}
|
||||||
|
|
||||||
val = dsi_read_reg(DSI_VC_SHORT_PACKET_HEADER(channel));
|
val = dsi_read_reg(DSI_VC_SHORT_PACKET_HEADER(channel));
|
||||||
|
@ -2134,15 +2141,18 @@ int dsi_vc_dcs_read(int channel, u8 dcs_cmd, u8 *buf, int buflen)
|
||||||
if (dt == DSI_DT_RX_ACK_WITH_ERR) {
|
if (dt == DSI_DT_RX_ACK_WITH_ERR) {
|
||||||
u16 err = FLD_GET(val, 23, 8);
|
u16 err = FLD_GET(val, 23, 8);
|
||||||
dsi_show_rx_ack_with_err(err);
|
dsi_show_rx_ack_with_err(err);
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
|
|
||||||
} else if (dt == DSI_DT_RX_SHORT_READ_1) {
|
} else if (dt == DSI_DT_RX_SHORT_READ_1) {
|
||||||
u8 data = FLD_GET(val, 15, 8);
|
u8 data = FLD_GET(val, 15, 8);
|
||||||
if (dsi.debug_read)
|
if (dsi.debug_read)
|
||||||
DSSDBG("\tDCS short response, 1 byte: %02x\n", data);
|
DSSDBG("\tDCS short response, 1 byte: %02x\n", data);
|
||||||
|
|
||||||
if (buflen < 1)
|
if (buflen < 1) {
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
|
||||||
buf[0] = data;
|
buf[0] = data;
|
||||||
|
|
||||||
|
@ -2152,8 +2162,10 @@ int dsi_vc_dcs_read(int channel, u8 dcs_cmd, u8 *buf, int buflen)
|
||||||
if (dsi.debug_read)
|
if (dsi.debug_read)
|
||||||
DSSDBG("\tDCS short response, 2 byte: %04x\n", data);
|
DSSDBG("\tDCS short response, 2 byte: %04x\n", data);
|
||||||
|
|
||||||
if (buflen < 2)
|
if (buflen < 2) {
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
|
||||||
buf[0] = data & 0xff;
|
buf[0] = data & 0xff;
|
||||||
buf[1] = (data >> 8) & 0xff;
|
buf[1] = (data >> 8) & 0xff;
|
||||||
|
@ -2165,8 +2177,10 @@ int dsi_vc_dcs_read(int channel, u8 dcs_cmd, u8 *buf, int buflen)
|
||||||
if (dsi.debug_read)
|
if (dsi.debug_read)
|
||||||
DSSDBG("\tDCS long response, len %d\n", len);
|
DSSDBG("\tDCS long response, len %d\n", len);
|
||||||
|
|
||||||
if (len > buflen)
|
if (len > buflen) {
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
|
||||||
/* two byte checksum ends the packet, not included in len */
|
/* two byte checksum ends the packet, not included in len */
|
||||||
for (w = 0; w < len + 2;) {
|
for (w = 0; w < len + 2;) {
|
||||||
|
@ -2188,11 +2202,18 @@ int dsi_vc_dcs_read(int channel, u8 dcs_cmd, u8 *buf, int buflen)
|
||||||
}
|
}
|
||||||
|
|
||||||
return len;
|
return len;
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
DSSERR("\tunknown datatype 0x%02x\n", dt);
|
DSSERR("\tunknown datatype 0x%02x\n", dt);
|
||||||
return -EIO;
|
r = -EIO;
|
||||||
|
goto err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
BUG();
|
||||||
|
err:
|
||||||
|
DSSERR("dsi_vc_dcs_read(ch %d, cmd 0x%02x) failed\n",
|
||||||
|
channel, dcs_cmd);
|
||||||
|
return r;
|
||||||
|
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(dsi_vc_dcs_read);
|
EXPORT_SYMBOL(dsi_vc_dcs_read);
|
||||||
|
|
||||||
|
|
Loading…
Add table
Reference in a new issue