| Message ID | 20200305201236.152307-15-sean@poorly.run (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | drm/i915: Add support for HDCP 1.4 over MST connectors | expand |
On Thu, 2020-03-05 at 15:12 -0500, Sean Paul wrote: > From: Sean Paul <seanpaul@chromium.org> > > Used to query whether an MST stream is encrypted or not. > > Signed-off-by: Sean Paul <seanpaul@chromium.org> > > Link: > https://patchwork.freedesktop.org/patch/msgid/20200218220242.107265-14-sean@poorly.run > #v4 > > Changes in v4: > -Added to the set > Changes in v5: > -None > --- > drivers/gpu/drm/drm_dp_mst_topology.c | 117 ++++++++++++++++++++++++++ > include/drm/drm_dp_helper.h | 3 + > include/drm/drm_dp_mst_helper.h | 44 ++++++++++ > 3 files changed, 164 insertions(+) > > diff --git a/drivers/gpu/drm/drm_dp_mst_topology.c > b/drivers/gpu/drm/drm_dp_mst_topology.c > index 6c62ad8f44142..5bba5aac86f31 100644 > --- a/drivers/gpu/drm/drm_dp_mst_topology.c > +++ b/drivers/gpu/drm/drm_dp_mst_topology.c > @@ -25,6 +25,7 @@ > #include <linux/i2c.h> > #include <linux/init.h> > #include <linux/kernel.h> > +#include <linux/random.h> > #include <linux/sched.h> > #include <linux/seq_file.h> > > @@ -418,6 +419,22 @@ drm_dp_encode_sideband_req(const struct > drm_dp_sideband_msg_req_body *req, > memcpy(&buf[idx], req->u.i2c_write.bytes, req- > >u.i2c_write.num_bytes); > idx += req->u.i2c_write.num_bytes; > break; > + case DP_QUERY_STREAM_ENC_STATUS: { > + const struct drm_dp_query_stream_enc_status *msg; > + > + msg = &req->u.enc_status; > + buf[idx] = msg->stream_id; > + idx++; > + memcpy(&buf[idx], msg->client_id, sizeof(msg->client_id)); > + idx += sizeof(msg->client_id); > + buf[idx] = 0; > + buf[idx] |= msg->stream_event & GENMASK(1, 0); > + buf[idx] |= msg->valid_stream_event ? BIT(2) : 0; > + buf[idx] |= (msg->stream_behavior & GENMASK(1, 0)) << 3; > + buf[idx] |= msg->valid_stream_behavior ? BIT(5) : 0; > + idx++; > + } > + break; > } > raw->cur_len = idx; > } > @@ -930,6 +947,34 @@ static bool > drm_dp_sideband_parse_power_updown_phy_ack(struct drm_dp_sideband_ms > return true; > } > > +static bool > +drm_dp_sideband_parse_query_stream_enc_status( > + struct drm_dp_sideband_msg_rx *raw, > + struct drm_dp_sideband_msg_reply_body *repmsg) > +{ > + struct drm_dp_query_stream_enc_status_ack_reply *reply; > + > + reply = &repmsg->u.enc_status; > + > + reply->stream_id = raw->msg[3]; > + > + reply->reply_signed = raw->msg[2] & BIT(0); > + > + reply->hdcp_1x_device_present = raw->msg[2] & BIT(3); > + reply->hdcp_2x_device_present = raw->msg[2] & BIT(4); > + > + reply->query_capable_device_present = raw->msg[2] & BIT(5); > + reply->legacy_device_present = raw->msg[2] & BIT(6); > + reply->unauthorizable_device_present = raw->msg[2] & BIT(7); > + > + reply->auth_completed = !!(raw->msg[1] & BIT(3)); > + reply->encryption_enabled = !!(raw->msg[1] & BIT(4)); > + reply->repeater_present = !!(raw->msg[1] & BIT(5)); > + reply->state = (raw->msg[1] & GENMASK(7, 6)) >> 6; > + > + return true; > +} I don't mind terribly either way, but since you're already using the BIT/GENMASK() macros have you considered GET_BITFIELD()? > + > static bool drm_dp_sideband_parse_reply(struct drm_dp_sideband_msg_rx *raw, > struct drm_dp_sideband_msg_reply_body > *msg) > { > @@ -964,6 +1009,8 @@ static bool drm_dp_sideband_parse_reply(struct > drm_dp_sideband_msg_rx *raw, > return drm_dp_sideband_parse_power_updown_phy_ack(raw, msg); > case DP_CLEAR_PAYLOAD_ID_TABLE: > return true; /* since there's nothing to parse */ > + case DP_QUERY_STREAM_ENC_STATUS: > + return drm_dp_sideband_parse_query_stream_enc_status(raw, > msg); > default: > DRM_ERROR("Got unknown reply 0x%02x (%s)\n", msg->req_type, > drm_dp_mst_req_type_str(msg->req_type)); > @@ -1115,6 +1162,25 @@ static void build_power_updown_phy(struct > drm_dp_sideband_msg_tx *msg, > msg->path_msg = true; > } > > +static int > +build_query_stream_enc_status(struct drm_dp_sideband_msg_tx *msg, u8 > stream_id, > + u8 *q_id) > +{ > + struct drm_dp_sideband_msg_req_body req; > + > + req.req_type = DP_QUERY_STREAM_ENC_STATUS; > + req.u.enc_status.stream_id = stream_id; > + memcpy(req.u.enc_status.client_id, q_id, > + sizeof(req.u.enc_status.client_id)); > + req.u.enc_status.stream_event = 0; > + req.u.enc_status.valid_stream_event = false; > + req.u.enc_status.stream_behavior = 0; > + req.u.enc_status.valid_stream_behavior = false; > + > + drm_dp_encode_sideband_req(&req, msg); > + return 0; > +} > + > static int drm_dp_mst_assign_payload_id(struct drm_dp_mst_topology_mgr > *mgr, > struct drm_dp_vcpi *vcpi) > { > @@ -3151,6 +3217,57 @@ int drm_dp_send_power_updown_phy(struct > drm_dp_mst_topology_mgr *mgr, > } > EXPORT_SYMBOL(drm_dp_send_power_updown_phy); > > +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr > *mgr, > + struct drm_dp_mst_port *port, > + struct drm_dp_query_stream_enc_status_ack_reply *status) > +{ > + struct drm_dp_sideband_msg_tx *txmsg; > + u8 nonce[7]; > + int len, ret; > + > + txmsg = kzalloc(sizeof(*txmsg), GFP_KERNEL); > + if (!txmsg) > + return -ENOMEM; > + > + port = drm_dp_mst_topology_get_port_validated(mgr, port); > + if (!port) { > + ret = -EINVAL; > + goto out_get_port; > + } > + > + get_random_bytes(nonce, sizeof(nonce)); > + > + /* > + * "Source device targets the QUERY_STREAM_ENCRYPTION_STATUS message > + * transaction at the MST Branch device directly connected to the > + * Source" > + */ > + txmsg->dst = mgr->mst_primary; > + > + len = build_query_stream_enc_status(txmsg, port->vcpi.vcpi, nonce); > + > + drm_dp_queue_down_tx(mgr, txmsg); > + > + ret = drm_dp_mst_wait_tx_reply(mgr->mst_primary, txmsg); > + if (ret < 0) { > + goto out; > + } else if (txmsg->reply.reply_type == DP_SIDEBAND_REPLY_NAK) { > + DRM_DEBUG_KMS("query encryption status nak received\n"); > + ret = -ENXIO; > + goto out; > + } > + > + ret = 0; > + memcpy(status, &txmsg->reply.u.enc_status, sizeof(*status)); > + > +out: > + drm_dp_mst_topology_put_port(port); > +out_get_port: > + kfree(txmsg); > + return ret; > +} > +EXPORT_SYMBOL(drm_dp_send_query_stream_enc_status); > + > static int drm_dp_create_payload_step1(struct drm_dp_mst_topology_mgr *mgr, > int id, > struct drm_dp_payload *payload) > diff --git a/include/drm/drm_dp_helper.h b/include/drm/drm_dp_helper.h > index c6119e4c169ae..31b6b10b55014 100644 > --- a/include/drm/drm_dp_helper.h > +++ b/include/drm/drm_dp_helper.h > @@ -1099,6 +1099,9 @@ > #define DP_POWER_DOWN_PHY 0x25 > #define DP_SINK_EVENT_NOTIFY 0x30 > #define DP_QUERY_STREAM_ENC_STATUS 0x38 > +#define DP_QUERY_STREAM_ENC_STATUS_STATE_NO_EXIST 0 > +#define DP_QUERY_STREAM_ENC_STATUS_STATE_INACTIVE 1 > +#define DP_QUERY_STREAM_ENC_STATUS_STATE_ACTIVE 2 > > /* DP 1.2 MST sideband reply types */ > #define DP_SIDEBAND_REPLY_ACK 0x00 > diff --git a/include/drm/drm_dp_mst_helper.h > b/include/drm/drm_dp_mst_helper.h > index 5483f888712ad..baf3405df44d8 100644 > --- a/include/drm/drm_dp_mst_helper.h > +++ b/include/drm/drm_dp_mst_helper.h > @@ -305,6 +305,34 @@ struct drm_dp_remote_i2c_write_ack_reply { > u8 port_number; > }; > > +struct drm_dp_query_stream_enc_status_ack_reply { > + /* Bit[23:16]- Stream Id */ > + u8 stream_id; > + > + /* Bit[15]- Signed */ > + bool reply_signed; > + > + /* Bit[10:8]- Stream Output Sink Type */ > + bool unauthorizable_device_present; > + bool legacy_device_present; > + bool query_capable_device_present; > + > + /* Bit[12:11]- Stream Output CP Type */ > + bool hdcp_1x_device_present; > + bool hdcp_2x_device_present; > + > + /* Bit[4]- Stream Authentication */ > + bool auth_completed; > + > + /* Bit[3]- Stream Encryption */ > + bool encryption_enabled; > + > + /* Bit[2]- Stream Repeater Function Present */ > + bool repeater_present; > + > + /* Bit[1:0]- Stream State */ > + u8 state; > +}; I really like your comments :) Anyway-this all looks mostly perfect! The only thing is you forgot to add an encode/decode selftest for this into drivers/gpu/drm/selftests/test- drm_dp_mst_helper.c (we'll eventually use this once we actually have some selftests to test various hub behavior) > > struct drm_dp_sideband_msg_rx { > u8 chunk[48]; > @@ -378,6 +406,15 @@ struct drm_dp_remote_i2c_write { > u8 *bytes; > }; > > +struct drm_dp_query_stream_enc_status { > + u8 stream_id; > + u8 client_id[7]; /* 56-bit nonce */ > + u8 stream_event; > + bool valid_stream_event; > + u8 stream_behavior; > + u8 valid_stream_behavior; > +}; > + > /* this covers ENUM_RESOURCES, POWER_DOWN_PHY, POWER_UP_PHY */ > struct drm_dp_port_number_req { > u8 port_number; > @@ -426,6 +463,8 @@ struct drm_dp_sideband_msg_req_body { > > struct drm_dp_remote_i2c_read i2c_read; > struct drm_dp_remote_i2c_write i2c_write; > + > + struct drm_dp_query_stream_enc_status enc_status; > } u; > }; > > @@ -448,6 +487,8 @@ struct drm_dp_sideband_msg_reply_body { > struct drm_dp_remote_i2c_read_ack_reply remote_i2c_read_ack; > struct drm_dp_remote_i2c_read_nak_reply remote_i2c_read_nack; > struct drm_dp_remote_i2c_write_ack_reply remote_i2c_write_ack; > + > + struct drm_dp_query_stream_enc_status_ack_reply enc_status; > } u; > }; > > @@ -804,6 +845,9 @@ drm_dp_atomic_release_vcpi_slots(struct drm_atomic_state > *state, > struct drm_dp_mst_port *port); > int drm_dp_send_power_updown_phy(struct drm_dp_mst_topology_mgr *mgr, > struct drm_dp_mst_port *port, bool power_up); > +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr > *mgr, > + struct drm_dp_mst_port *port, > + struct drm_dp_query_stream_enc_status_ack_reply *status); > int __must_check drm_dp_mst_atomic_check(struct drm_atomic_state *state); > > void drm_dp_mst_get_port_malloc(struct drm_dp_mst_port *port);
On Thu, 26 Mar 2020, Lyude Paul <lyude@redhat.com> wrote: > On Thu, 2020-03-05 at 15:12 -0500, Sean Paul wrote: >> From: Sean Paul <seanpaul@chromium.org> >> >> Used to query whether an MST stream is encrypted or not. >> >> Signed-off-by: Sean Paul <seanpaul@chromium.org> >> >> Link: >> https://patchwork.freedesktop.org/patch/msgid/20200218220242.107265-14-sean@poorly.run >> #v4 >> >> Changes in v4: >> -Added to the set >> Changes in v5: >> -None >> --- >> drivers/gpu/drm/drm_dp_mst_topology.c | 117 ++++++++++++++++++++++++++ >> include/drm/drm_dp_helper.h | 3 + >> include/drm/drm_dp_mst_helper.h | 44 ++++++++++ >> 3 files changed, 164 insertions(+) >> >> diff --git a/drivers/gpu/drm/drm_dp_mst_topology.c >> b/drivers/gpu/drm/drm_dp_mst_topology.c >> index 6c62ad8f44142..5bba5aac86f31 100644 >> --- a/drivers/gpu/drm/drm_dp_mst_topology.c >> +++ b/drivers/gpu/drm/drm_dp_mst_topology.c >> @@ -25,6 +25,7 @@ >> #include <linux/i2c.h> >> #include <linux/init.h> >> #include <linux/kernel.h> >> +#include <linux/random.h> >> #include <linux/sched.h> >> #include <linux/seq_file.h> >> >> @@ -418,6 +419,22 @@ drm_dp_encode_sideband_req(const struct >> drm_dp_sideband_msg_req_body *req, >> memcpy(&buf[idx], req->u.i2c_write.bytes, req- >> >u.i2c_write.num_bytes); >> idx += req->u.i2c_write.num_bytes; >> break; >> + case DP_QUERY_STREAM_ENC_STATUS: { >> + const struct drm_dp_query_stream_enc_status *msg; >> + >> + msg = &req->u.enc_status; >> + buf[idx] = msg->stream_id; >> + idx++; >> + memcpy(&buf[idx], msg->client_id, sizeof(msg->client_id)); >> + idx += sizeof(msg->client_id); >> + buf[idx] = 0; >> + buf[idx] |= msg->stream_event & GENMASK(1, 0); >> + buf[idx] |= msg->valid_stream_event ? BIT(2) : 0; >> + buf[idx] |= (msg->stream_behavior & GENMASK(1, 0)) << 3; >> + buf[idx] |= msg->valid_stream_behavior ? BIT(5) : 0; >> + idx++; >> + } >> + break; >> } >> raw->cur_len = idx; >> } >> @@ -930,6 +947,34 @@ static bool >> drm_dp_sideband_parse_power_updown_phy_ack(struct drm_dp_sideband_ms >> return true; >> } >> >> +static bool >> +drm_dp_sideband_parse_query_stream_enc_status( >> + struct drm_dp_sideband_msg_rx *raw, >> + struct drm_dp_sideband_msg_reply_body *repmsg) >> +{ >> + struct drm_dp_query_stream_enc_status_ack_reply *reply; >> + >> + reply = &repmsg->u.enc_status; >> + >> + reply->stream_id = raw->msg[3]; >> + >> + reply->reply_signed = raw->msg[2] & BIT(0); >> + >> + reply->hdcp_1x_device_present = raw->msg[2] & BIT(3); >> + reply->hdcp_2x_device_present = raw->msg[2] & BIT(4); >> + >> + reply->query_capable_device_present = raw->msg[2] & BIT(5); >> + reply->legacy_device_present = raw->msg[2] & BIT(6); >> + reply->unauthorizable_device_present = raw->msg[2] & BIT(7); >> + >> + reply->auth_completed = !!(raw->msg[1] & BIT(3)); >> + reply->encryption_enabled = !!(raw->msg[1] & BIT(4)); >> + reply->repeater_present = !!(raw->msg[1] & BIT(5)); >> + reply->state = (raw->msg[1] & GENMASK(7, 6)) >> 6; >> + >> + return true; >> +} > > I don't mind terribly either way, but since you're already using the > BIT/GENMASK() macros have you considered GET_BITFIELD()? ITYM FIELD_PREP() and FIELD_GET(). Side note, for i915 registers we ended up in trouble with the types assumed by the various macros, and ended up with REG_BIT(), REG_GENMASK(), REG_FIELD_PREP(), and REG_FIELD_GET() wrappers for our specifically u32 needs. All in i915_reg.h. BR, Jani. > >> + >> static bool drm_dp_sideband_parse_reply(struct drm_dp_sideband_msg_rx *raw, >> struct drm_dp_sideband_msg_reply_body >> *msg) >> { >> @@ -964,6 +1009,8 @@ static bool drm_dp_sideband_parse_reply(struct >> drm_dp_sideband_msg_rx *raw, >> return drm_dp_sideband_parse_power_updown_phy_ack(raw, msg); >> case DP_CLEAR_PAYLOAD_ID_TABLE: >> return true; /* since there's nothing to parse */ >> + case DP_QUERY_STREAM_ENC_STATUS: >> + return drm_dp_sideband_parse_query_stream_enc_status(raw, >> msg); >> default: >> DRM_ERROR("Got unknown reply 0x%02x (%s)\n", msg->req_type, >> drm_dp_mst_req_type_str(msg->req_type)); >> @@ -1115,6 +1162,25 @@ static void build_power_updown_phy(struct >> drm_dp_sideband_msg_tx *msg, >> msg->path_msg = true; >> } >> >> +static int >> +build_query_stream_enc_status(struct drm_dp_sideband_msg_tx *msg, u8 >> stream_id, >> + u8 *q_id) >> +{ >> + struct drm_dp_sideband_msg_req_body req; >> + >> + req.req_type = DP_QUERY_STREAM_ENC_STATUS; >> + req.u.enc_status.stream_id = stream_id; >> + memcpy(req.u.enc_status.client_id, q_id, >> + sizeof(req.u.enc_status.client_id)); >> + req.u.enc_status.stream_event = 0; >> + req.u.enc_status.valid_stream_event = false; >> + req.u.enc_status.stream_behavior = 0; >> + req.u.enc_status.valid_stream_behavior = false; >> + >> + drm_dp_encode_sideband_req(&req, msg); >> + return 0; >> +} >> + >> static int drm_dp_mst_assign_payload_id(struct drm_dp_mst_topology_mgr >> *mgr, >> struct drm_dp_vcpi *vcpi) >> { >> @@ -3151,6 +3217,57 @@ int drm_dp_send_power_updown_phy(struct >> drm_dp_mst_topology_mgr *mgr, >> } >> EXPORT_SYMBOL(drm_dp_send_power_updown_phy); >> >> +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr >> *mgr, >> + struct drm_dp_mst_port *port, >> + struct drm_dp_query_stream_enc_status_ack_reply *status) >> +{ >> + struct drm_dp_sideband_msg_tx *txmsg; >> + u8 nonce[7]; >> + int len, ret; >> + >> + txmsg = kzalloc(sizeof(*txmsg), GFP_KERNEL); >> + if (!txmsg) >> + return -ENOMEM; >> + >> + port = drm_dp_mst_topology_get_port_validated(mgr, port); >> + if (!port) { >> + ret = -EINVAL; >> + goto out_get_port; >> + } >> + >> + get_random_bytes(nonce, sizeof(nonce)); >> + >> + /* >> + * "Source device targets the QUERY_STREAM_ENCRYPTION_STATUS message >> + * transaction at the MST Branch device directly connected to the >> + * Source" >> + */ >> + txmsg->dst = mgr->mst_primary; >> + >> + len = build_query_stream_enc_status(txmsg, port->vcpi.vcpi, nonce); >> + >> + drm_dp_queue_down_tx(mgr, txmsg); >> + >> + ret = drm_dp_mst_wait_tx_reply(mgr->mst_primary, txmsg); >> + if (ret < 0) { >> + goto out; >> + } else if (txmsg->reply.reply_type == DP_SIDEBAND_REPLY_NAK) { >> + DRM_DEBUG_KMS("query encryption status nak received\n"); >> + ret = -ENXIO; >> + goto out; >> + } >> + >> + ret = 0; >> + memcpy(status, &txmsg->reply.u.enc_status, sizeof(*status)); >> + >> +out: >> + drm_dp_mst_topology_put_port(port); >> +out_get_port: >> + kfree(txmsg); >> + return ret; >> +} >> +EXPORT_SYMBOL(drm_dp_send_query_stream_enc_status); >> + >> static int drm_dp_create_payload_step1(struct drm_dp_mst_topology_mgr *mgr, >> int id, >> struct drm_dp_payload *payload) >> diff --git a/include/drm/drm_dp_helper.h b/include/drm/drm_dp_helper.h >> index c6119e4c169ae..31b6b10b55014 100644 >> --- a/include/drm/drm_dp_helper.h >> +++ b/include/drm/drm_dp_helper.h >> @@ -1099,6 +1099,9 @@ >> #define DP_POWER_DOWN_PHY 0x25 >> #define DP_SINK_EVENT_NOTIFY 0x30 >> #define DP_QUERY_STREAM_ENC_STATUS 0x38 >> +#define DP_QUERY_STREAM_ENC_STATUS_STATE_NO_EXIST 0 >> +#define DP_QUERY_STREAM_ENC_STATUS_STATE_INACTIVE 1 >> +#define DP_QUERY_STREAM_ENC_STATUS_STATE_ACTIVE 2 >> >> /* DP 1.2 MST sideband reply types */ >> #define DP_SIDEBAND_REPLY_ACK 0x00 >> diff --git a/include/drm/drm_dp_mst_helper.h >> b/include/drm/drm_dp_mst_helper.h >> index 5483f888712ad..baf3405df44d8 100644 >> --- a/include/drm/drm_dp_mst_helper.h >> +++ b/include/drm/drm_dp_mst_helper.h >> @@ -305,6 +305,34 @@ struct drm_dp_remote_i2c_write_ack_reply { >> u8 port_number; >> }; >> >> +struct drm_dp_query_stream_enc_status_ack_reply { >> + /* Bit[23:16]- Stream Id */ >> + u8 stream_id; >> + >> + /* Bit[15]- Signed */ >> + bool reply_signed; >> + >> + /* Bit[10:8]- Stream Output Sink Type */ >> + bool unauthorizable_device_present; >> + bool legacy_device_present; >> + bool query_capable_device_present; >> + >> + /* Bit[12:11]- Stream Output CP Type */ >> + bool hdcp_1x_device_present; >> + bool hdcp_2x_device_present; >> + >> + /* Bit[4]- Stream Authentication */ >> + bool auth_completed; >> + >> + /* Bit[3]- Stream Encryption */ >> + bool encryption_enabled; >> + >> + /* Bit[2]- Stream Repeater Function Present */ >> + bool repeater_present; >> + >> + /* Bit[1:0]- Stream State */ >> + u8 state; >> +}; > > I really like your comments :) > > Anyway-this all looks mostly perfect! The only thing is you forgot to add an > encode/decode selftest for this into drivers/gpu/drm/selftests/test- > drm_dp_mst_helper.c (we'll eventually use this once we actually have some > selftests to test various hub behavior) >> >> struct drm_dp_sideband_msg_rx { >> u8 chunk[48]; >> @@ -378,6 +406,15 @@ struct drm_dp_remote_i2c_write { >> u8 *bytes; >> }; >> >> +struct drm_dp_query_stream_enc_status { >> + u8 stream_id; >> + u8 client_id[7]; /* 56-bit nonce */ >> + u8 stream_event; >> + bool valid_stream_event; >> + u8 stream_behavior; >> + u8 valid_stream_behavior; >> +}; >> + >> /* this covers ENUM_RESOURCES, POWER_DOWN_PHY, POWER_UP_PHY */ >> struct drm_dp_port_number_req { >> u8 port_number; >> @@ -426,6 +463,8 @@ struct drm_dp_sideband_msg_req_body { >> >> struct drm_dp_remote_i2c_read i2c_read; >> struct drm_dp_remote_i2c_write i2c_write; >> + >> + struct drm_dp_query_stream_enc_status enc_status; >> } u; >> }; >> >> @@ -448,6 +487,8 @@ struct drm_dp_sideband_msg_reply_body { >> struct drm_dp_remote_i2c_read_ack_reply remote_i2c_read_ack; >> struct drm_dp_remote_i2c_read_nak_reply remote_i2c_read_nack; >> struct drm_dp_remote_i2c_write_ack_reply remote_i2c_write_ack; >> + >> + struct drm_dp_query_stream_enc_status_ack_reply enc_status; >> } u; >> }; >> >> @@ -804,6 +845,9 @@ drm_dp_atomic_release_vcpi_slots(struct drm_atomic_state >> *state, >> struct drm_dp_mst_port *port); >> int drm_dp_send_power_updown_phy(struct drm_dp_mst_topology_mgr *mgr, >> struct drm_dp_mst_port *port, bool power_up); >> +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr >> *mgr, >> + struct drm_dp_mst_port *port, >> + struct drm_dp_query_stream_enc_status_ack_reply *status); >> int __must_check drm_dp_mst_atomic_check(struct drm_atomic_state *state); >> >> void drm_dp_mst_get_port_malloc(struct drm_dp_mst_port *port);
diff --git a/drivers/gpu/drm/drm_dp_mst_topology.c b/drivers/gpu/drm/drm_dp_mst_topology.c index 6c62ad8f44142..5bba5aac86f31 100644 --- a/drivers/gpu/drm/drm_dp_mst_topology.c +++ b/drivers/gpu/drm/drm_dp_mst_topology.c @@ -25,6 +25,7 @@ #include <linux/i2c.h> #include <linux/init.h> #include <linux/kernel.h> +#include <linux/random.h> #include <linux/sched.h> #include <linux/seq_file.h> @@ -418,6 +419,22 @@ drm_dp_encode_sideband_req(const struct drm_dp_sideband_msg_req_body *req, memcpy(&buf[idx], req->u.i2c_write.bytes, req->u.i2c_write.num_bytes); idx += req->u.i2c_write.num_bytes; break; + case DP_QUERY_STREAM_ENC_STATUS: { + const struct drm_dp_query_stream_enc_status *msg; + + msg = &req->u.enc_status; + buf[idx] = msg->stream_id; + idx++; + memcpy(&buf[idx], msg->client_id, sizeof(msg->client_id)); + idx += sizeof(msg->client_id); + buf[idx] = 0; + buf[idx] |= msg->stream_event & GENMASK(1, 0); + buf[idx] |= msg->valid_stream_event ? BIT(2) : 0; + buf[idx] |= (msg->stream_behavior & GENMASK(1, 0)) << 3; + buf[idx] |= msg->valid_stream_behavior ? BIT(5) : 0; + idx++; + } + break; } raw->cur_len = idx; } @@ -930,6 +947,34 @@ static bool drm_dp_sideband_parse_power_updown_phy_ack(struct drm_dp_sideband_ms return true; } +static bool +drm_dp_sideband_parse_query_stream_enc_status( + struct drm_dp_sideband_msg_rx *raw, + struct drm_dp_sideband_msg_reply_body *repmsg) +{ + struct drm_dp_query_stream_enc_status_ack_reply *reply; + + reply = &repmsg->u.enc_status; + + reply->stream_id = raw->msg[3]; + + reply->reply_signed = raw->msg[2] & BIT(0); + + reply->hdcp_1x_device_present = raw->msg[2] & BIT(3); + reply->hdcp_2x_device_present = raw->msg[2] & BIT(4); + + reply->query_capable_device_present = raw->msg[2] & BIT(5); + reply->legacy_device_present = raw->msg[2] & BIT(6); + reply->unauthorizable_device_present = raw->msg[2] & BIT(7); + + reply->auth_completed = !!(raw->msg[1] & BIT(3)); + reply->encryption_enabled = !!(raw->msg[1] & BIT(4)); + reply->repeater_present = !!(raw->msg[1] & BIT(5)); + reply->state = (raw->msg[1] & GENMASK(7, 6)) >> 6; + + return true; +} + static bool drm_dp_sideband_parse_reply(struct drm_dp_sideband_msg_rx *raw, struct drm_dp_sideband_msg_reply_body *msg) { @@ -964,6 +1009,8 @@ static bool drm_dp_sideband_parse_reply(struct drm_dp_sideband_msg_rx *raw, return drm_dp_sideband_parse_power_updown_phy_ack(raw, msg); case DP_CLEAR_PAYLOAD_ID_TABLE: return true; /* since there's nothing to parse */ + case DP_QUERY_STREAM_ENC_STATUS: + return drm_dp_sideband_parse_query_stream_enc_status(raw, msg); default: DRM_ERROR("Got unknown reply 0x%02x (%s)\n", msg->req_type, drm_dp_mst_req_type_str(msg->req_type)); @@ -1115,6 +1162,25 @@ static void build_power_updown_phy(struct drm_dp_sideband_msg_tx *msg, msg->path_msg = true; } +static int +build_query_stream_enc_status(struct drm_dp_sideband_msg_tx *msg, u8 stream_id, + u8 *q_id) +{ + struct drm_dp_sideband_msg_req_body req; + + req.req_type = DP_QUERY_STREAM_ENC_STATUS; + req.u.enc_status.stream_id = stream_id; + memcpy(req.u.enc_status.client_id, q_id, + sizeof(req.u.enc_status.client_id)); + req.u.enc_status.stream_event = 0; + req.u.enc_status.valid_stream_event = false; + req.u.enc_status.stream_behavior = 0; + req.u.enc_status.valid_stream_behavior = false; + + drm_dp_encode_sideband_req(&req, msg); + return 0; +} + static int drm_dp_mst_assign_payload_id(struct drm_dp_mst_topology_mgr *mgr, struct drm_dp_vcpi *vcpi) { @@ -3151,6 +3217,57 @@ int drm_dp_send_power_updown_phy(struct drm_dp_mst_topology_mgr *mgr, } EXPORT_SYMBOL(drm_dp_send_power_updown_phy); +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr *mgr, + struct drm_dp_mst_port *port, + struct drm_dp_query_stream_enc_status_ack_reply *status) +{ + struct drm_dp_sideband_msg_tx *txmsg; + u8 nonce[7]; + int len, ret; + + txmsg = kzalloc(sizeof(*txmsg), GFP_KERNEL); + if (!txmsg) + return -ENOMEM; + + port = drm_dp_mst_topology_get_port_validated(mgr, port); + if (!port) { + ret = -EINVAL; + goto out_get_port; + } + + get_random_bytes(nonce, sizeof(nonce)); + + /* + * "Source device targets the QUERY_STREAM_ENCRYPTION_STATUS message + * transaction at the MST Branch device directly connected to the + * Source" + */ + txmsg->dst = mgr->mst_primary; + + len = build_query_stream_enc_status(txmsg, port->vcpi.vcpi, nonce); + + drm_dp_queue_down_tx(mgr, txmsg); + + ret = drm_dp_mst_wait_tx_reply(mgr->mst_primary, txmsg); + if (ret < 0) { + goto out; + } else if (txmsg->reply.reply_type == DP_SIDEBAND_REPLY_NAK) { + DRM_DEBUG_KMS("query encryption status nak received\n"); + ret = -ENXIO; + goto out; + } + + ret = 0; + memcpy(status, &txmsg->reply.u.enc_status, sizeof(*status)); + +out: + drm_dp_mst_topology_put_port(port); +out_get_port: + kfree(txmsg); + return ret; +} +EXPORT_SYMBOL(drm_dp_send_query_stream_enc_status); + static int drm_dp_create_payload_step1(struct drm_dp_mst_topology_mgr *mgr, int id, struct drm_dp_payload *payload) diff --git a/include/drm/drm_dp_helper.h b/include/drm/drm_dp_helper.h index c6119e4c169ae..31b6b10b55014 100644 --- a/include/drm/drm_dp_helper.h +++ b/include/drm/drm_dp_helper.h @@ -1099,6 +1099,9 @@ #define DP_POWER_DOWN_PHY 0x25 #define DP_SINK_EVENT_NOTIFY 0x30 #define DP_QUERY_STREAM_ENC_STATUS 0x38 +#define DP_QUERY_STREAM_ENC_STATUS_STATE_NO_EXIST 0 +#define DP_QUERY_STREAM_ENC_STATUS_STATE_INACTIVE 1 +#define DP_QUERY_STREAM_ENC_STATUS_STATE_ACTIVE 2 /* DP 1.2 MST sideband reply types */ #define DP_SIDEBAND_REPLY_ACK 0x00 diff --git a/include/drm/drm_dp_mst_helper.h b/include/drm/drm_dp_mst_helper.h index 5483f888712ad..baf3405df44d8 100644 --- a/include/drm/drm_dp_mst_helper.h +++ b/include/drm/drm_dp_mst_helper.h @@ -305,6 +305,34 @@ struct drm_dp_remote_i2c_write_ack_reply { u8 port_number; }; +struct drm_dp_query_stream_enc_status_ack_reply { + /* Bit[23:16]- Stream Id */ + u8 stream_id; + + /* Bit[15]- Signed */ + bool reply_signed; + + /* Bit[10:8]- Stream Output Sink Type */ + bool unauthorizable_device_present; + bool legacy_device_present; + bool query_capable_device_present; + + /* Bit[12:11]- Stream Output CP Type */ + bool hdcp_1x_device_present; + bool hdcp_2x_device_present; + + /* Bit[4]- Stream Authentication */ + bool auth_completed; + + /* Bit[3]- Stream Encryption */ + bool encryption_enabled; + + /* Bit[2]- Stream Repeater Function Present */ + bool repeater_present; + + /* Bit[1:0]- Stream State */ + u8 state; +}; struct drm_dp_sideband_msg_rx { u8 chunk[48]; @@ -378,6 +406,15 @@ struct drm_dp_remote_i2c_write { u8 *bytes; }; +struct drm_dp_query_stream_enc_status { + u8 stream_id; + u8 client_id[7]; /* 56-bit nonce */ + u8 stream_event; + bool valid_stream_event; + u8 stream_behavior; + u8 valid_stream_behavior; +}; + /* this covers ENUM_RESOURCES, POWER_DOWN_PHY, POWER_UP_PHY */ struct drm_dp_port_number_req { u8 port_number; @@ -426,6 +463,8 @@ struct drm_dp_sideband_msg_req_body { struct drm_dp_remote_i2c_read i2c_read; struct drm_dp_remote_i2c_write i2c_write; + + struct drm_dp_query_stream_enc_status enc_status; } u; }; @@ -448,6 +487,8 @@ struct drm_dp_sideband_msg_reply_body { struct drm_dp_remote_i2c_read_ack_reply remote_i2c_read_ack; struct drm_dp_remote_i2c_read_nak_reply remote_i2c_read_nack; struct drm_dp_remote_i2c_write_ack_reply remote_i2c_write_ack; + + struct drm_dp_query_stream_enc_status_ack_reply enc_status; } u; }; @@ -804,6 +845,9 @@ drm_dp_atomic_release_vcpi_slots(struct drm_atomic_state *state, struct drm_dp_mst_port *port); int drm_dp_send_power_updown_phy(struct drm_dp_mst_topology_mgr *mgr, struct drm_dp_mst_port *port, bool power_up); +int drm_dp_send_query_stream_enc_status(struct drm_dp_mst_topology_mgr *mgr, + struct drm_dp_mst_port *port, + struct drm_dp_query_stream_enc_status_ack_reply *status); int __must_check drm_dp_mst_atomic_check(struct drm_atomic_state *state); void drm_dp_mst_get_port_malloc(struct drm_dp_mst_port *port);