drm: bridge: anx7625: implement message sending

Swapping the data role requires sending the message to the other USB-C
side. Implement sending these messages through the OCM. The code is
largely based on the anx7411.c USB-C driver.

Reviewed-by: Xin Ji <xji@analogixsemi.com>
Link: https://patch.msgid.link/20260121-anx7625-typec-v2-3-d14f31256a17@oss.qualcomm.com
Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@oss.qualcomm.com>
This commit is contained in:
Dmitry Baryshkov
2026-01-21 12:15:47 +02:00
parent f81455b2d3
commit 8ad0f7d2e6
2 changed files with 80 additions and 0 deletions

View File

@@ -1484,6 +1484,73 @@ static void anx7625_start_dp_work(struct anx7625_data *ctx)
}
#if IS_REACHABLE(CONFIG_TYPEC)
static u8 anx7625_checksum(u8 *buf, u8 len)
{
u8 ret = 0;
u8 i;
for (i = 0; i < len; i++)
ret += buf[i];
return ret;
}
static int anx7625_read_msg_ctrl_status(struct anx7625_data *ctx)
{
return anx7625_reg_read(ctx, ctx->i2c.rx_p0_client, CMD_SEND_BUF);
}
static int anx7625_wait_msg_empty(struct anx7625_data *ctx)
{
int val;
return readx_poll_timeout(anx7625_read_msg_ctrl_status, ctx,
val, (val < 0) || (val == 0),
2000, 2000 * 150);
}
static int anx7625_send_msg(struct anx7625_data *ctx, u8 type, u8 *buf, u8 size)
{
struct fw_msg *msg = &ctx->send_msg;
u8 crc;
int ret;
size = min_t(u8, size, (u8)MAX_BUF_LEN);
memcpy(msg->buf, buf, size);
msg->msg_type = type;
/* msg len equals buffer length + msg_type */
msg->msg_len = size + 1;
crc = anx7625_checksum((u8 *)msg, size + HEADER_LEN);
msg->buf[size] = 0 - crc;
ret = anx7625_wait_msg_empty(ctx);
if (ret)
return ret;
ret = anx7625_reg_block_write(ctx, ctx->i2c.rx_p0_client,
CMD_SEND_BUF + 1, size + HEADER_LEN,
&msg->msg_type);
ret |= anx7625_reg_write(ctx, ctx->i2c.rx_p0_client, CMD_SEND_BUF,
msg->msg_len);
return ret;
}
static int anx7625_typec_dr_set(struct typec_port *port, enum typec_data_role role)
{
struct anx7625_data *ctx = typec_get_drvdata(port);
if (role == ctx->typec_data_role)
return 0;
return anx7625_send_msg(ctx, 0x11, NULL, 0);
}
static const struct typec_operations anx7625_typec_ops = {
.dr_set = anx7625_typec_dr_set,
};
static void anx7625_typec_set_orientation(struct anx7625_data *ctx)
{
u32 val = anx7625_reg_read(ctx, ctx->i2c.rx_p0_client, SYSTEM_STSTUS);
@@ -1542,6 +1609,7 @@ static int anx7625_typec_register(struct anx7625_data *ctx)
typec_cap.orientation_aware = true;
typec_cap.driver_data = ctx;
typec_cap.ops = &anx7625_typec_ops;
ctx->typec_port = typec_register_port(ctx->dev, &typec_cap);
if (IS_ERR(ctx->typec_port))

View File

@@ -67,6 +67,9 @@
#define CC2_RA BIT(5)
#define CC2_RP (BIT(6) | BIT(7))
#define CMD_SEND_BUF 0xC0
#define CMD_RECV_BUF 0xE0
/******** END of I2C Address 0x58 ********/
/***************************************************************/
@@ -462,6 +465,14 @@ struct anx7625_i2c_client {
struct typec_port;
struct usb_role_switch;
#define MAX_BUF_LEN 30
struct fw_msg {
u8 msg_len;
u8 msg_type;
u8 buf[MAX_BUF_LEN];
} __packed;
#define HEADER_LEN 2
struct anx7625_data {
struct anx7625_platform_data pdata;
struct platform_device *audio_pdev;
@@ -497,6 +508,7 @@ struct anx7625_data {
struct drm_connector *connector;
struct mipi_dsi_device *dsi;
struct drm_dp_aux aux;
struct fw_msg send_msg;
};
#endif /* __ANX7625_H__ */