aboutsummaryrefslogtreecommitdiffstats
path: root/meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch
diff options
context:
space:
mode:
Diffstat (limited to 'meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch')
-rw-r--r--meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch1992
1 files changed, 1992 insertions, 0 deletions
diff --git a/meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch b/meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch
new file mode 100644
index 00000000..66d7df04
--- /dev/null
+++ b/meta-amd-bsp/recipes-kernel/linux/linux-yocto-4.19.8/4502-drm-amd-display-Add-execution-and-transition-states-.patch
@@ -0,0 +1,1992 @@
+From d3cc90c80f602b70998a55f10658fc714d481f96 Mon Sep 17 00:00:00 2001
+From: Bhawanpreet Lakha <Bhawanpreet.Lakha@amd.com>
+Date: Wed, 18 Sep 2019 11:18:15 -0400
+Subject: [PATCH 4502/4736] drm/amd/display: Add execution and transition
+ states for HDCP2.2
+
+The module works like a state machine
+
+ +-------------+
+ ------> | Execution.c | ------
+ | +-------------+ |
+ | V
+ +----+ +--------+ +--------------+
+ | DM | -----> | Hdcp.c | <------------ | Transition.c |
+ +----+ <----- +--------+ +--------------+
+
+This patch adds the execution and transition files for 2.2
+
+Extension to "40a702d427 drm/amd/display: Add HDCP module" for 2.2
+
+Signed-off-by: Bhawanpreet Lakha <Bhawanpreet.Lakha@amd.com>
+Reviewed-by: Harry Wentland <harry.wentland@amd.com>
+---
+ .../gpu/drm/amd/display/modules/hdcp/Makefile | 3 +-
+ .../gpu/drm/amd/display/modules/hdcp/hdcp.c | 86 +-
+ .../gpu/drm/amd/display/modules/hdcp/hdcp.h | 127 +++
+ .../display/modules/hdcp/hdcp2_execution.c | 881 ++++++++++++++++++
+ .../display/modules/hdcp/hdcp2_transition.c | 674 ++++++++++++++
+ .../drm/amd/display/modules/inc/mod_hdcp.h | 2 +
+ 6 files changed, 1764 insertions(+), 9 deletions(-)
+ create mode 100644 drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_execution.c
+ create mode 100644 drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_transition.c
+
+diff --git a/drivers/gpu/drm/amd/display/modules/hdcp/Makefile b/drivers/gpu/drm/amd/display/modules/hdcp/Makefile
+index 1c3c6d47973a..904424da01b5 100644
+--- a/drivers/gpu/drm/amd/display/modules/hdcp/Makefile
++++ b/drivers/gpu/drm/amd/display/modules/hdcp/Makefile
+@@ -24,7 +24,8 @@
+ #
+
+ HDCP = hdcp_ddc.o hdcp_log.o hdcp_psp.o hdcp.o \
+- hdcp1_execution.o hdcp1_transition.o
++ hdcp1_execution.o hdcp1_transition.o \
++ hdcp2_execution.o hdcp2_transition.o
+
+ AMD_DAL_HDCP = $(addprefix $(AMDDALPATH)/modules/hdcp/,$(HDCP))
+ #$(info ************ DAL-HDCP_MAKEFILE ************)
+diff --git a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.c b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.c
+index d7ac445dec6f..a74812977963 100644
+--- a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.c
++++ b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.c
+@@ -37,24 +37,52 @@ static void push_error_status(struct mod_hdcp *hdcp,
+ HDCP_ERROR_TRACE(hdcp, status);
+ }
+
+- hdcp->connection.hdcp1_retry_count++;
++ if (is_hdcp1(hdcp)) {
++ hdcp->connection.hdcp1_retry_count++;
++ } else if (is_hdcp2(hdcp)) {
++ hdcp->connection.hdcp2_retry_count++;
++ }
+ }
+
+ static uint8_t is_cp_desired_hdcp1(struct mod_hdcp *hdcp)
+ {
+- int i, display_enabled = 0;
++ int i, is_auth_needed = 0;
+
+- /* if all displays on the link are disabled, hdcp is not desired */
++ /* if all displays on the link don't need authentication,
++ * hdcp is not desired
++ */
+ for (i = 0; i < MAX_NUM_OF_DISPLAYS; i++) {
+ if (hdcp->connection.displays[i].state != MOD_HDCP_DISPLAY_INACTIVE &&
+ !hdcp->connection.displays[i].adjust.disable) {
+- display_enabled = 1;
++ is_auth_needed = 1;
+ break;
+ }
+ }
+
+ return (hdcp->connection.hdcp1_retry_count < MAX_NUM_OF_ATTEMPTS) &&
+- display_enabled && !hdcp->connection.link.adjust.hdcp1.disable;
++ is_auth_needed &&
++ !hdcp->connection.link.adjust.hdcp1.disable;
++}
++
++static uint8_t is_cp_desired_hdcp2(struct mod_hdcp *hdcp)
++{
++ int i, is_auth_needed = 0;
++
++ /* if all displays on the link don't need authentication,
++ * hdcp is not desired
++ */
++ for (i = 0; i < MAX_NUM_OF_DISPLAYS; i++) {
++ if (hdcp->connection.displays[i].state != MOD_HDCP_DISPLAY_INACTIVE &&
++ !hdcp->connection.displays[i].adjust.disable) {
++ is_auth_needed = 1;
++ break;
++ }
++ }
++
++ return (hdcp->connection.hdcp2_retry_count < MAX_NUM_OF_ATTEMPTS) &&
++ is_auth_needed &&
++ !hdcp->connection.link.adjust.hdcp2.disable &&
++ !hdcp->connection.is_hdcp2_revoked;
+ }
+
+ static enum mod_hdcp_status execution(struct mod_hdcp *hdcp,
+@@ -82,6 +110,11 @@ static enum mod_hdcp_status execution(struct mod_hdcp *hdcp,
+ } else if (is_in_hdcp1_dp_states(hdcp)) {
+ status = mod_hdcp_hdcp1_dp_execution(hdcp,
+ event_ctx, &input->hdcp1);
++ } else if (is_in_hdcp2_states(hdcp)) {
++ status = mod_hdcp_hdcp2_execution(hdcp, event_ctx, &input->hdcp2);
++ } else if (is_in_hdcp2_dp_states(hdcp)) {
++ status = mod_hdcp_hdcp2_dp_execution(hdcp,
++ event_ctx, &input->hdcp2);
+ }
+ out:
+ return status;
+@@ -99,7 +132,10 @@ static enum mod_hdcp_status transition(struct mod_hdcp *hdcp,
+
+ if (is_in_initialized_state(hdcp)) {
+ if (is_dp_hdcp(hdcp))
+- if (is_cp_desired_hdcp1(hdcp)) {
++ if (is_cp_desired_hdcp2(hdcp)) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A0_DETERMINE_RX_HDCP_CAPABLE);
++ } else if (is_cp_desired_hdcp1(hdcp)) {
+ callback_in_ms(0, output);
+ set_state_id(hdcp, output, D1_A0_DETERMINE_RX_HDCP_CAPABLE);
+ } else {
+@@ -107,7 +143,10 @@ static enum mod_hdcp_status transition(struct mod_hdcp *hdcp,
+ set_state_id(hdcp, output, HDCP_CP_NOT_DESIRED);
+ }
+ else if (is_hdmi_dvi_sl_hdcp(hdcp))
+- if (is_cp_desired_hdcp1(hdcp)) {
++ if (is_cp_desired_hdcp2(hdcp)) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A0_KNOWN_HDCP2_CAPABLE_RX);
++ } else if (is_cp_desired_hdcp1(hdcp)) {
+ callback_in_ms(0, output);
+ set_state_id(hdcp, output, H1_A0_WAIT_FOR_ACTIVE_RX);
+ } else {
+@@ -126,6 +165,12 @@ static enum mod_hdcp_status transition(struct mod_hdcp *hdcp,
+ } else if (is_in_hdcp1_dp_states(hdcp)) {
+ status = mod_hdcp_hdcp1_dp_transition(hdcp,
+ event_ctx, &input->hdcp1, output);
++ } else if (is_in_hdcp2_states(hdcp)) {
++ status = mod_hdcp_hdcp2_transition(hdcp,
++ event_ctx, &input->hdcp2, output);
++ } else if (is_in_hdcp2_dp_states(hdcp)) {
++ status = mod_hdcp_hdcp2_dp_transition(hdcp,
++ event_ctx, &input->hdcp2, output);
+ } else {
+ status = MOD_HDCP_STATUS_INVALID_STATE;
+ }
+@@ -139,9 +184,13 @@ static enum mod_hdcp_status reset_authentication(struct mod_hdcp *hdcp,
+ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
+
+ if (is_hdcp1(hdcp)) {
+- if (hdcp->auth.trans_input.hdcp1.create_session != UNKNOWN)
++ if (hdcp->auth.trans_input.hdcp1.create_session != UNKNOWN) {
++ /* TODO - update psp to unify create session failure
++ * recovery between hdcp1 and 2.
++ */
+ mod_hdcp_hdcp1_destroy_session(hdcp);
+
++ }
+ if (hdcp->auth.trans_input.hdcp1.add_topology == PASS) {
+ status = mod_hdcp_remove_display_topology(hdcp);
+ if (status != MOD_HDCP_STATUS_SUCCESS) {
+@@ -154,6 +203,27 @@ static enum mod_hdcp_status reset_authentication(struct mod_hdcp *hdcp,
+ memset(&hdcp->auth, 0, sizeof(struct mod_hdcp_authentication));
+ memset(&hdcp->state, 0, sizeof(struct mod_hdcp_state));
+ set_state_id(hdcp, output, HDCP_INITIALIZED);
++ } else if (is_hdcp2(hdcp)) {
++ if (hdcp->auth.trans_input.hdcp2.create_session == PASS) {
++ status = mod_hdcp_hdcp2_destroy_session(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS) {
++ output->callback_needed = 0;
++ output->watchdog_timer_needed = 0;
++ goto out;
++ }
++ }
++ if (hdcp->auth.trans_input.hdcp2.add_topology == PASS) {
++ status = mod_hdcp_remove_display_topology(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS) {
++ output->callback_needed = 0;
++ output->watchdog_timer_needed = 0;
++ goto out;
++ }
++ }
++ HDCP_TOP_RESET_AUTH_TRACE(hdcp);
++ memset(&hdcp->auth, 0, sizeof(struct mod_hdcp_authentication));
++ memset(&hdcp->state, 0, sizeof(struct mod_hdcp_state));
++ set_state_id(hdcp, output, HDCP_INITIALIZED);
+ } else if (is_in_cp_not_desired_state(hdcp)) {
+ status = mod_hdcp_remove_display_topology(hdcp);
+ if (status != MOD_HDCP_STATUS_SUCCESS) {
+diff --git a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.h b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.h
+index d83f0ab1cadb..9887c5ea6d5f 100644
+--- a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.h
++++ b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp.h
+@@ -44,11 +44,13 @@
+ #define BINFO_MAX_DEVS_EXCEEDED_MASK_DP 0x0080
+ #define BINFO_MAX_CASCADE_EXCEEDED_MASK_DP 0x0800
+
++#define VERSION_HDCP2_MASK 0x04
+ #define RXSTATUS_MSG_SIZE_MASK 0x03FF
+ #define RXSTATUS_READY_MASK 0x0400
+ #define RXSTATUS_REAUTH_REQUEST_MASK 0x0800
+ #define RXIDLIST_DEVICE_COUNT_LOWER_MASK 0xf0
+ #define RXIDLIST_DEVICE_COUNT_UPPER_MASK 0x01
++#define RXCAPS_BYTE2_HDCP2_VERSION_DP 0x02
+ #define RXCAPS_BYTE0_HDCP_CAPABLE_MASK_DP 0x02
+ #define RXSTATUS_READY_MASK_DP 0x0001
+ #define RXSTATUS_H_P_AVAILABLE_MASK_DP 0x0002
+@@ -92,8 +94,52 @@ struct mod_hdcp_transition_input_hdcp1 {
+ uint8_t stream_encryption_dp;
+ };
+
++struct mod_hdcp_transition_input_hdcp2 {
++ uint8_t hdcp2version_read;
++ uint8_t hdcp2_capable_check;
++ uint8_t add_topology;
++ uint8_t create_session;
++ uint8_t ake_init_prepare;
++ uint8_t ake_init_write;
++ uint8_t rxstatus_read;
++ uint8_t ake_cert_available;
++ uint8_t ake_cert_read;
++ uint8_t ake_cert_validation;
++ uint8_t stored_km_write;
++ uint8_t no_stored_km_write;
++ uint8_t h_prime_available;
++ uint8_t h_prime_read;
++ uint8_t pairing_available;
++ uint8_t pairing_info_read;
++ uint8_t h_prime_validation;
++ uint8_t lc_init_prepare;
++ uint8_t lc_init_write;
++ uint8_t l_prime_available_poll;
++ uint8_t l_prime_read;
++ uint8_t l_prime_validation;
++ uint8_t eks_prepare;
++ uint8_t eks_write;
++ uint8_t enable_encryption;
++ uint8_t reauth_request_check;
++ uint8_t rx_id_list_read;
++ uint8_t device_count_check;
++ uint8_t rx_id_list_validation;
++ uint8_t repeater_auth_ack_write;
++ uint8_t prepare_stream_manage;
++ uint8_t stream_manage_write;
++ uint8_t stream_ready_available;
++ uint8_t stream_ready_read;
++ uint8_t stream_ready_validation;
++
++ uint8_t rx_caps_read_dp;
++ uint8_t content_stream_type_write;
++ uint8_t link_integrity_check_dp;
++ uint8_t stream_encryption_dp;
++};
++
+ union mod_hdcp_transition_input {
+ struct mod_hdcp_transition_input_hdcp1 hdcp1;
++ struct mod_hdcp_transition_input_hdcp2 hdcp2;
+ };
+
+ struct mod_hdcp_message_hdcp1 {
+@@ -150,8 +196,10 @@ struct mod_hdcp_connection {
+ struct mod_hdcp_display displays[MAX_NUM_OF_DISPLAYS];
+ uint8_t is_repeater;
+ uint8_t is_km_stored;
++ uint8_t is_hdcp2_revoked;
+ struct mod_hdcp_trace trace;
+ uint8_t hdcp1_retry_count;
++ uint8_t hdcp2_retry_count;
+ };
+
+ /* contains values per authentication cycle */
+@@ -219,6 +267,50 @@ enum mod_hdcp_hdcp1_dp_state_id {
+ HDCP1_DP_STATE_END = D1_A7_READ_KSV_LIST,
+ };
+
++enum mod_hdcp_hdcp2_state_id {
++ HDCP2_STATE_START = HDCP1_DP_STATE_END,
++ H2_A0_KNOWN_HDCP2_CAPABLE_RX,
++ H2_A1_SEND_AKE_INIT,
++ H2_A1_VALIDATE_AKE_CERT,
++ H2_A1_SEND_NO_STORED_KM,
++ H2_A1_READ_H_PRIME,
++ H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME,
++ H2_A1_SEND_STORED_KM,
++ H2_A1_VALIDATE_H_PRIME,
++ H2_A2_LOCALITY_CHECK,
++ H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER,
++ H2_ENABLE_ENCRYPTION,
++ H2_A5_AUTHENTICATED,
++ H2_A6_WAIT_FOR_RX_ID_LIST,
++ H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK,
++ H2_A9_SEND_STREAM_MANAGEMENT,
++ H2_A9_VALIDATE_STREAM_READY,
++ HDCP2_STATE_END = H2_A9_VALIDATE_STREAM_READY,
++};
++
++enum mod_hdcp_hdcp2_dp_state_id {
++ HDCP2_DP_STATE_START = HDCP2_STATE_END,
++ D2_A0_DETERMINE_RX_HDCP_CAPABLE,
++ D2_A1_SEND_AKE_INIT,
++ D2_A1_VALIDATE_AKE_CERT,
++ D2_A1_SEND_NO_STORED_KM,
++ D2_A1_READ_H_PRIME,
++ D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME,
++ D2_A1_SEND_STORED_KM,
++ D2_A1_VALIDATE_H_PRIME,
++ D2_A2_LOCALITY_CHECK,
++ D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER,
++ D2_SEND_CONTENT_STREAM_TYPE,
++ D2_ENABLE_ENCRYPTION,
++ D2_A5_AUTHENTICATED,
++ D2_A6_WAIT_FOR_RX_ID_LIST,
++ D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK,
++ D2_A9_SEND_STREAM_MANAGEMENT,
++ D2_A9_VALIDATE_STREAM_READY,
++ HDCP2_DP_STATE_END = D2_A9_VALIDATE_STREAM_READY,
++ HDCP_STATE_END = HDCP2_DP_STATE_END,
++};
++
+ /* hdcp1 executions and transitions */
+ typedef enum mod_hdcp_status (*mod_hdcp_action)(struct mod_hdcp *hdcp);
+ uint8_t mod_hdcp_execute_and_set(
+@@ -239,6 +331,22 @@ enum mod_hdcp_status mod_hdcp_hdcp1_dp_transition(struct mod_hdcp *hdcp,
+ struct mod_hdcp_transition_input_hdcp1 *input,
+ struct mod_hdcp_output *output);
+
++/* hdcp2 executions and transitions */
++enum mod_hdcp_status mod_hdcp_hdcp2_execution(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input);
++enum mod_hdcp_status mod_hdcp_hdcp2_dp_execution(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input);
++enum mod_hdcp_status mod_hdcp_hdcp2_transition(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input,
++ struct mod_hdcp_output *output);
++enum mod_hdcp_status mod_hdcp_hdcp2_dp_transition(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input,
++ struct mod_hdcp_output *output);
++
+ /* log functions */
+ void mod_hdcp_dump_binary_message(uint8_t *msg, uint32_t msg_size,
+ uint8_t *buf, uint32_t buf_size);
+@@ -289,6 +397,7 @@ enum mod_hdcp_status mod_hdcp_read_binfo(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_write_aksv(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_write_ainfo(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_write_an(struct mod_hdcp *hdcp);
++enum mod_hdcp_status mod_hdcp_read_hdcp2version(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_read_rxcaps(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_read_rxstatus(struct mod_hdcp *hdcp);
+ enum mod_hdcp_status mod_hdcp_read_ake_cert(struct mod_hdcp *hdcp);
+@@ -352,11 +461,28 @@ static inline uint8_t is_in_hdcp1_dp_states(struct mod_hdcp *hdcp)
+ current_state(hdcp) <= HDCP1_DP_STATE_END);
+ }
+
++static inline uint8_t is_in_hdcp2_states(struct mod_hdcp *hdcp)
++{
++ return (current_state(hdcp) > HDCP2_STATE_START &&
++ current_state(hdcp) <= HDCP2_STATE_END);
++}
++
++static inline uint8_t is_in_hdcp2_dp_states(struct mod_hdcp *hdcp)
++{
++ return (current_state(hdcp) > HDCP2_DP_STATE_START &&
++ current_state(hdcp) <= HDCP2_DP_STATE_END);
++}
++
+ static inline uint8_t is_hdcp1(struct mod_hdcp *hdcp)
+ {
+ return (is_in_hdcp1_states(hdcp) || is_in_hdcp1_dp_states(hdcp));
+ }
+
++static inline uint8_t is_hdcp2(struct mod_hdcp *hdcp)
++{
++ return (is_in_hdcp2_states(hdcp) || is_in_hdcp2_dp_states(hdcp));
++}
++
+ static inline uint8_t is_in_cp_not_desired_state(struct mod_hdcp *hdcp)
+ {
+ return current_state(hdcp) == HDCP_CP_NOT_DESIRED;
+@@ -481,6 +607,7 @@ static inline struct mod_hdcp_display *get_empty_display_container(
+ static inline void reset_retry_counts(struct mod_hdcp *hdcp)
+ {
+ hdcp->connection.hdcp1_retry_count = 0;
++ hdcp->connection.hdcp2_retry_count = 0;
+ }
+
+ #endif /* HDCP_H_ */
+diff --git a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_execution.c b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_execution.c
+new file mode 100644
+index 000000000000..c93c8098d972
+--- /dev/null
++++ b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_execution.c
+@@ -0,0 +1,881 @@
++/*
++ * Copyright 2018 Advanced Micro Devices, Inc.
++ *
++ * Permission is hereby granted, free of charge, to any person obtaining a
++ * copy of this software and associated documentation files (the "Software"),
++ * to deal in the Software without restriction, including without limitation
++ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
++ * and/or sell copies of the Software, and to permit persons to whom the
++ * Software is furnished to do so, subject to the following conditions:
++ *
++ * The above copyright notice and this permission notice shall be included in
++ * all copies or substantial portions of the Software.
++ *
++ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
++ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
++ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
++ * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
++ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
++ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
++ * OTHER DEALINGS IN THE SOFTWARE.
++ *
++ * Authors: AMD
++ *
++ */
++
++#include "hdcp.h"
++
++static inline enum mod_hdcp_status check_receiver_id_list_ready(struct mod_hdcp *hdcp)
++{
++ uint8_t is_ready = 0;
++
++ if (is_dp_hdcp(hdcp))
++ is_ready = (hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_READY_MASK_DP) ? 1 : 0;
++ else
++ is_ready = ((hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_READY_MASK) &&
++ (hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK)) ? 1 : 0;
++ return is_ready ? MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY;
++}
++
++static inline enum mod_hdcp_status check_hdcp2_capable(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++
++ if (is_dp_hdcp(hdcp))
++ status = ((hdcp->auth.msg.hdcp2.rxcaps_dp[2] &
++ RXCAPS_BYTE0_HDCP_CAPABLE_MASK_DP) &&
++ (hdcp->auth.msg.hdcp2.rxcaps_dp[0] ==
++ RXCAPS_BYTE2_HDCP2_VERSION_DP)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_NOT_CAPABLE;
++ else
++ status = (hdcp->auth.msg.hdcp2.hdcp2version_hdmi & VERSION_HDCP2_MASK) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_NOT_CAPABLE;
++ return status;
++}
++
++static inline enum mod_hdcp_status check_reauthentication_request(
++ struct mod_hdcp *hdcp)
++{
++ uint8_t ret = 0;
++
++ if (is_dp_hdcp(hdcp))
++ ret = (hdcp->auth.msg.hdcp2.rxstatus &
++ RXSTATUS_REAUTH_REQUEST_MASK_DP) ?
++ MOD_HDCP_STATUS_HDCP2_REAUTH_REQUEST :
++ MOD_HDCP_STATUS_SUCCESS;
++ else
++ ret = (hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_REAUTH_REQUEST_MASK) ?
++ MOD_HDCP_STATUS_HDCP2_REAUTH_REQUEST :
++ MOD_HDCP_STATUS_SUCCESS;
++ return ret;
++}
++
++static inline enum mod_hdcp_status check_link_integrity_failure_dp(
++ struct mod_hdcp *hdcp)
++{
++ return (hdcp->auth.msg.hdcp2.rxstatus &
++ RXSTATUS_LINK_INTEGRITY_FAILURE_MASK_DP) ?
++ MOD_HDCP_STATUS_HDCP2_REAUTH_LINK_INTEGRITY_FAILURE :
++ MOD_HDCP_STATUS_SUCCESS;
++}
++
++static enum mod_hdcp_status check_ake_cert_available(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++ uint16_t size;
++
++ if (is_dp_hdcp(hdcp)) {
++ status = MOD_HDCP_STATUS_SUCCESS;
++ } else {
++ status = mod_hdcp_read_rxstatus(hdcp);
++ if (status == MOD_HDCP_STATUS_SUCCESS) {
++ size = hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK;
++ status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_cert)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_AKE_CERT_PENDING;
++ }
++ }
++ return status;
++}
++
++static enum mod_hdcp_status check_h_prime_available(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++ uint8_t size;
++
++ status = mod_hdcp_read_rxstatus(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS)
++ goto out;
++
++ if (is_dp_hdcp(hdcp)) {
++ status = (hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_H_P_AVAILABLE_MASK_DP) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_H_PRIME_PENDING;
++ } else {
++ size = hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK;
++ status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_h_prime)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_H_PRIME_PENDING;
++ }
++out:
++ return status;
++}
++
++static enum mod_hdcp_status check_pairing_info_available(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++ uint8_t size;
++
++ status = mod_hdcp_read_rxstatus(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS)
++ goto out;
++
++ if (is_dp_hdcp(hdcp)) {
++ status = (hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_PAIRING_AVAILABLE_MASK_DP) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_PAIRING_INFO_PENDING;
++ } else {
++ size = hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK;
++ status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_pairing_info)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_PAIRING_INFO_PENDING;
++ }
++out:
++ return status;
++}
++
++static enum mod_hdcp_status poll_l_prime_available(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++ uint8_t size;
++ uint16_t max_wait = 20000; // units of us
++ uint16_t num_polls = 5;
++ uint16_t wait_time = max_wait / num_polls;
++
++ if (is_dp_hdcp(hdcp))
++ status = MOD_HDCP_STATUS_INVALID_OPERATION;
++ else
++ for (; num_polls; num_polls--) {
++ udelay(wait_time);
++
++ status = mod_hdcp_read_rxstatus(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS)
++ break;
++
++ size = hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK;
++ status = (size == sizeof(hdcp->auth.msg.hdcp2.lc_l_prime)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_L_PRIME_PENDING;
++ if (status == MOD_HDCP_STATUS_SUCCESS)
++ break;
++ }
++ return status;
++}
++
++static enum mod_hdcp_status check_stream_ready_available(struct mod_hdcp *hdcp)
++{
++ enum mod_hdcp_status status;
++ uint8_t size;
++
++ if (is_dp_hdcp(hdcp)) {
++ status = MOD_HDCP_STATUS_INVALID_OPERATION;
++ } else {
++ status = mod_hdcp_read_rxstatus(hdcp);
++ if (status != MOD_HDCP_STATUS_SUCCESS)
++ goto out;
++ size = hdcp->auth.msg.hdcp2.rxstatus & RXSTATUS_MSG_SIZE_MASK;
++ status = (size == sizeof(hdcp->auth.msg.hdcp2.repeater_auth_stream_ready)) ?
++ MOD_HDCP_STATUS_SUCCESS :
++ MOD_HDCP_STATUS_HDCP2_STREAM_READY_PENDING;
++ }
++out:
++ return status;
++}
++
++static inline uint8_t get_device_count(struct mod_hdcp *hdcp)
++{
++ return ((hdcp->auth.msg.hdcp2.rx_id_list[2] & RXIDLIST_DEVICE_COUNT_LOWER_MASK) >> 4) +
++ ((hdcp->auth.msg.hdcp2.rx_id_list[1] & RXIDLIST_DEVICE_COUNT_UPPER_MASK) << 4);
++}
++
++static enum mod_hdcp_status check_device_count(struct mod_hdcp *hdcp)
++{
++ /* device count must be greater than or equal to tracked hdcp displays */
++ return (get_device_count(hdcp) < get_added_display_count(hdcp)) ?
++ MOD_HDCP_STATUS_HDCP2_DEVICE_COUNT_MISMATCH_FAILURE :
++ MOD_HDCP_STATUS_SUCCESS;
++}
++
++static uint8_t process_rxstatus(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input,
++ enum mod_hdcp_status *status)
++{
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_rxstatus,
++ &input->rxstatus_read, status,
++ hdcp, "rxstatus_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(check_reauthentication_request,
++ &input->reauth_request_check, status,
++ hdcp, "reauth_request_check"))
++ goto out;
++ if (is_dp_hdcp(hdcp)) {
++ if (!mod_hdcp_execute_and_set(check_link_integrity_failure_dp,
++ &input->link_integrity_check_dp, status,
++ hdcp, "link_integrity_check_dp"))
++ goto out;
++ }
++ if (hdcp->connection.is_repeater)
++ if (check_receiver_id_list_ready(hdcp) ==
++ MOD_HDCP_STATUS_SUCCESS) {
++ HDCP_INPUT_PASS_TRACE(hdcp, "rx_id_list_ready");
++ event_ctx->rx_id_list_ready = 1;
++ if (is_dp_hdcp(hdcp))
++ hdcp->auth.msg.hdcp2.rx_id_list_size =
++ sizeof(hdcp->auth.msg.hdcp2.rx_id_list);
++ else
++ hdcp->auth.msg.hdcp2.rx_id_list_size =
++ hdcp->auth.msg.hdcp2.rxstatus & 0x3FF;
++ }
++out:
++ return (*status == MOD_HDCP_STATUS_SUCCESS);
++}
++
++static enum mod_hdcp_status known_hdcp2_capable_rx(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_hdcp2version,
++ &input->hdcp2version_read, &status,
++ hdcp, "hdcp2version_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(check_hdcp2_capable,
++ &input->hdcp2_capable_check, &status,
++ hdcp, "hdcp2_capable"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status send_ake_init(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (!mod_hdcp_execute_and_set(mod_hdcp_add_display_topology,
++ &input->add_topology, &status,
++ hdcp, "add_topology"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_create_session,
++ &input->create_session, &status,
++ hdcp, "create_session"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_ake_init,
++ &input->ake_init_prepare, &status,
++ hdcp, "ake_init_prepare"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_ake_init,
++ &input->ake_init_write, &status,
++ hdcp, "ake_init_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status validate_ake_cert(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (is_hdmi_dvi_sl_hdcp(hdcp))
++ if (!mod_hdcp_execute_and_set(check_ake_cert_available,
++ &input->ake_cert_available, &status,
++ hdcp, "ake_cert_available"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_ake_cert,
++ &input->ake_cert_read, &status,
++ hdcp, "ake_cert_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_ake_cert,
++ &input->ake_cert_validation, &status,
++ hdcp, "ake_cert_validation"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status send_no_stored_km(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_no_stored_km,
++ &input->no_stored_km_write, &status,
++ hdcp, "no_stored_km_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status read_h_prime(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(check_h_prime_available,
++ &input->h_prime_available, &status,
++ hdcp, "h_prime_available"))
++ goto out;
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_h_prime,
++ &input->h_prime_read, &status,
++ hdcp, "h_prime_read"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status read_pairing_info_and_validate_h_prime(
++ struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(check_pairing_info_available,
++ &input->pairing_available, &status,
++ hdcp, "pairing_available"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_pairing_info,
++ &input->pairing_info_read, &status,
++ hdcp, "pairing_info_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_h_prime,
++ &input->h_prime_validation, &status,
++ hdcp, "h_prime_validation"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status send_stored_km(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_stored_km,
++ &input->stored_km_write, &status,
++ hdcp, "stored_km_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status validate_h_prime(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(check_h_prime_available,
++ &input->h_prime_available, &status,
++ hdcp, "h_prime_available"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_h_prime,
++ &input->h_prime_read, &status,
++ hdcp, "h_prime_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_h_prime,
++ &input->h_prime_validation, &status,
++ hdcp, "h_prime_validation"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status locality_check(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_lc_init,
++ &input->lc_init_prepare, &status,
++ hdcp, "lc_init_prepare"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_lc_init,
++ &input->lc_init_write, &status,
++ hdcp, "lc_init_write"))
++ goto out;
++ if (is_dp_hdcp(hdcp))
++ udelay(16000);
++ else
++ if (!mod_hdcp_execute_and_set(poll_l_prime_available,
++ &input->l_prime_available_poll, &status,
++ hdcp, "l_prime_available_poll"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_l_prime,
++ &input->l_prime_read, &status,
++ hdcp, "l_prime_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_l_prime,
++ &input->l_prime_validation, &status,
++ hdcp, "l_prime_validation"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status exchange_ks_and_test_for_repeater(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_eks,
++ &input->eks_prepare, &status,
++ hdcp, "eks_prepare"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_eks,
++ &input->eks_write, &status,
++ hdcp, "eks_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status enable_encryption(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
++ process_rxstatus(hdcp, event_ctx, input, &status);
++ goto out;
++ }
++
++ if (is_hdmi_dvi_sl_hdcp(hdcp)) {
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (event_ctx->rx_id_list_ready)
++ goto out;
++ }
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_enable_encryption,
++ &input->enable_encryption, &status,
++ hdcp, "enable_encryption"))
++ goto out;
++ if (is_dp_mst_hdcp(hdcp)) {
++ if (!mod_hdcp_execute_and_set(
++ mod_hdcp_hdcp2_enable_dp_stream_encryption,
++ &input->stream_encryption_dp, &status,
++ hdcp, "stream_encryption_dp"))
++ goto out;
++ }
++out:
++ return status;
++}
++
++static enum mod_hdcp_status authenticated(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (event_ctx->rx_id_list_ready)
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status wait_for_rx_id_list(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (!event_ctx->rx_id_list_ready) {
++ status = MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY;
++ goto out;
++ }
++out:
++ return status;
++}
++
++static enum mod_hdcp_status verify_rx_id_list_and_send_ack(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
++ process_rxstatus(hdcp, event_ctx, input, &status);
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_rx_id_list,
++ &input->rx_id_list_read,
++ &status, hdcp, "receiver_id_list_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(check_device_count,
++ &input->device_count_check,
++ &status, hdcp, "device_count_check"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_rx_id_list,
++ &input->rx_id_list_validation,
++ &status, hdcp, "rx_id_list_validation"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_repeater_auth_ack,
++ &input->repeater_auth_ack_write,
++ &status, hdcp, "repeater_auth_ack_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status send_stream_management(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
++ process_rxstatus(hdcp, event_ctx, input, &status);
++ goto out;
++ }
++
++ if (is_hdmi_dvi_sl_hdcp(hdcp)) {
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (event_ctx->rx_id_list_ready)
++ goto out;
++ }
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_stream_management,
++ &input->prepare_stream_manage,
++ &status, hdcp, "prepare_stream_manage"))
++ goto out;
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_stream_manage,
++ &input->stream_manage_write,
++ &status, hdcp, "stream_manage_write"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status validate_stream_ready(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
++ event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++ if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
++ process_rxstatus(hdcp, event_ctx, input, &status);
++ goto out;
++ }
++
++ if (is_hdmi_dvi_sl_hdcp(hdcp)) {
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (event_ctx->rx_id_list_ready) {
++ goto out;
++ }
++ }
++ if (is_hdmi_dvi_sl_hdcp(hdcp))
++ if (!mod_hdcp_execute_and_set(check_stream_ready_available,
++ &input->stream_ready_available,
++ &status, hdcp, "stream_ready_available"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_stream_ready,
++ &input->stream_ready_read,
++ &status, hdcp, "stream_ready_read"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_stream_ready,
++ &input->stream_ready_validation,
++ &status, hdcp, "stream_ready_validation"))
++ goto out;
++
++out:
++ return status;
++}
++
++static enum mod_hdcp_status determine_rx_hdcp_capable_dp(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!mod_hdcp_execute_and_set(mod_hdcp_read_rxcaps,
++ &input->rx_caps_read_dp,
++ &status, hdcp, "rx_caps_read_dp"))
++ goto out;
++ if (!mod_hdcp_execute_and_set(check_hdcp2_capable,
++ &input->hdcp2_capable_check, &status,
++ hdcp, "hdcp2_capable_check"))
++ goto out;
++out:
++ return status;
++}
++
++static enum mod_hdcp_status send_content_stream_type_dp(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
++ event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
++ event_ctx->unexpected_event = 1;
++ goto out;
++ }
++
++ if (!process_rxstatus(hdcp, event_ctx, input, &status))
++ goto out;
++ if (!mod_hdcp_execute_and_set(mod_hdcp_write_content_type,
++ &input->content_stream_type_write, &status,
++ hdcp, "content_stream_type_write"))
++ goto out;
++out:
++ return status;
++}
++
++enum mod_hdcp_status mod_hdcp_hdcp2_execution(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ switch (current_state(hdcp)) {
++ case H2_A0_KNOWN_HDCP2_CAPABLE_RX:
++ status = known_hdcp2_capable_rx(hdcp, event_ctx, input);
++ break;
++ case H2_A1_SEND_AKE_INIT:
++ status = send_ake_init(hdcp, event_ctx, input);
++ break;
++ case H2_A1_VALIDATE_AKE_CERT:
++ status = validate_ake_cert(hdcp, event_ctx, input);
++ break;
++ case H2_A1_SEND_NO_STORED_KM:
++ status = send_no_stored_km(hdcp, event_ctx, input);
++ break;
++ case H2_A1_READ_H_PRIME:
++ status = read_h_prime(hdcp, event_ctx, input);
++ break;
++ case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
++ status = read_pairing_info_and_validate_h_prime(hdcp,
++ event_ctx, input);
++ break;
++ case H2_A1_SEND_STORED_KM:
++ status = send_stored_km(hdcp, event_ctx, input);
++ break;
++ case H2_A1_VALIDATE_H_PRIME:
++ status = validate_h_prime(hdcp, event_ctx, input);
++ break;
++ case H2_A2_LOCALITY_CHECK:
++ status = locality_check(hdcp, event_ctx, input);
++ break;
++ case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
++ status = exchange_ks_and_test_for_repeater(hdcp, event_ctx, input);
++ break;
++ case H2_ENABLE_ENCRYPTION:
++ status = enable_encryption(hdcp, event_ctx, input);
++ break;
++ case H2_A5_AUTHENTICATED:
++ status = authenticated(hdcp, event_ctx, input);
++ break;
++ case H2_A6_WAIT_FOR_RX_ID_LIST:
++ status = wait_for_rx_id_list(hdcp, event_ctx, input);
++ break;
++ case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
++ status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input);
++ break;
++ case H2_A9_SEND_STREAM_MANAGEMENT:
++ status = send_stream_management(hdcp, event_ctx, input);
++ break;
++ case H2_A9_VALIDATE_STREAM_READY:
++ status = validate_stream_ready(hdcp, event_ctx, input);
++ break;
++ default:
++ status = MOD_HDCP_STATUS_INVALID_STATE;
++ break;
++ }
++
++ return status;
++}
++
++enum mod_hdcp_status mod_hdcp_hdcp2_dp_execution(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++
++ switch (current_state(hdcp)) {
++ case D2_A0_DETERMINE_RX_HDCP_CAPABLE:
++ status = determine_rx_hdcp_capable_dp(hdcp, event_ctx, input);
++ break;
++ case D2_A1_SEND_AKE_INIT:
++ status = send_ake_init(hdcp, event_ctx, input);
++ break;
++ case D2_A1_VALIDATE_AKE_CERT:
++ status = validate_ake_cert(hdcp, event_ctx, input);
++ break;
++ case D2_A1_SEND_NO_STORED_KM:
++ status = send_no_stored_km(hdcp, event_ctx, input);
++ break;
++ case D2_A1_READ_H_PRIME:
++ status = read_h_prime(hdcp, event_ctx, input);
++ break;
++ case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
++ status = read_pairing_info_and_validate_h_prime(hdcp,
++ event_ctx, input);
++ break;
++ case D2_A1_SEND_STORED_KM:
++ status = send_stored_km(hdcp, event_ctx, input);
++ break;
++ case D2_A1_VALIDATE_H_PRIME:
++ status = validate_h_prime(hdcp, event_ctx, input);
++ break;
++ case D2_A2_LOCALITY_CHECK:
++ status = locality_check(hdcp, event_ctx, input);
++ break;
++ case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
++ status = exchange_ks_and_test_for_repeater(hdcp,
++ event_ctx, input);
++ break;
++ case D2_SEND_CONTENT_STREAM_TYPE:
++ status = send_content_stream_type_dp(hdcp, event_ctx, input);
++ break;
++ case D2_ENABLE_ENCRYPTION:
++ status = enable_encryption(hdcp, event_ctx, input);
++ break;
++ case D2_A5_AUTHENTICATED:
++ status = authenticated(hdcp, event_ctx, input);
++ break;
++ case D2_A6_WAIT_FOR_RX_ID_LIST:
++ status = wait_for_rx_id_list(hdcp, event_ctx, input);
++ break;
++ case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
++ status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input);
++ break;
++ case D2_A9_SEND_STREAM_MANAGEMENT:
++ status = send_stream_management(hdcp, event_ctx, input);
++ break;
++ case D2_A9_VALIDATE_STREAM_READY:
++ status = validate_stream_ready(hdcp, event_ctx, input);
++ break;
++ default:
++ status = MOD_HDCP_STATUS_INVALID_STATE;
++ break;
++ }
++
++ return status;
++}
+diff --git a/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_transition.c b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_transition.c
+new file mode 100644
+index 000000000000..94a0e5fa931b
+--- /dev/null
++++ b/drivers/gpu/drm/amd/display/modules/hdcp/hdcp2_transition.c
+@@ -0,0 +1,674 @@
++/*
++ * Copyright 2018 Advanced Micro Devices, Inc.
++ *
++ * Permission is hereby granted, free of charge, to any person obtaining a
++ * copy of this software and associated documentation files (the "Software"),
++ * to deal in the Software without restriction, including without limitation
++ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
++ * and/or sell copies of the Software, and to permit persons to whom the
++ * Software is furnished to do so, subject to the following conditions:
++ *
++ * The above copyright notice and this permission notice shall be included in
++ * all copies or substantial portions of the Software.
++ *
++ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
++ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
++ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
++ * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
++ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
++ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
++ * OTHER DEALINGS IN THE SOFTWARE.
++ *
++ * Authors: AMD
++ *
++ */
++
++#include "hdcp.h"
++
++enum mod_hdcp_status mod_hdcp_hdcp2_transition(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input,
++ struct mod_hdcp_output *output)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++ struct mod_hdcp_connection *conn = &hdcp->connection;
++ struct mod_hdcp_link_adjustment *adjust = &hdcp->connection.link.adjust;
++
++ switch (current_state(hdcp)) {
++ case H2_A0_KNOWN_HDCP2_CAPABLE_RX:
++ if (input->hdcp2version_read != PASS ||
++ input->hdcp2_capable_check != PASS) {
++ adjust->hdcp2.disable = 1;
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, HDCP_INITIALIZED);
++ } else {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_SEND_AKE_INIT);
++ }
++ break;
++ case H2_A1_SEND_AKE_INIT:
++ if (input->add_topology != PASS ||
++ input->create_session != PASS ||
++ input->ake_init_prepare != PASS) {
++ /* out of sync with psp state */
++ adjust->hdcp2.disable = 1;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->ake_init_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 100, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_VALIDATE_AKE_CERT);
++ break;
++ case H2_A1_VALIDATE_AKE_CERT:
++ if (input->ake_cert_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1A-08: consider ake timeout a failure */
++ /* some hdmi receivers are not ready for HDCP
++ * immediately after video becomes active,
++ * delay 1s before retry on first HDCP message
++ * timeout.
++ */
++ fail_and_restart_in_ms(1000, &status, output);
++ } else {
++ /* continue ake cert polling*/
++ callback_in_ms(10, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ } else if (input->ake_cert_read != PASS ||
++ input->ake_cert_validation != PASS) {
++ /*
++ * 1A-09: consider invalid ake cert a failure
++ * 1A-10: consider receiver id listed in SRM a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (conn->is_km_stored &&
++ !adjust->hdcp2.force_no_stored_km) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_SEND_STORED_KM);
++ } else {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_SEND_NO_STORED_KM);
++ }
++ break;
++ case H2_A1_SEND_NO_STORED_KM:
++ if (input->no_stored_km_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (adjust->hdcp2.increase_h_prime_timeout)
++ set_watchdog_in_ms(hdcp, 2000, output);
++ else
++ set_watchdog_in_ms(hdcp, 1000, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_READ_H_PRIME);
++ break;
++ case H2_A1_READ_H_PRIME:
++ if (input->h_prime_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1A-11-3: consider h' timeout a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ } else {
++ /* continue h' polling */
++ callback_in_ms(100, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ } else if (input->h_prime_read != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 200, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME);
++ break;
++ case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
++ if (input->pairing_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1A-12: consider pairing info timeout
++ * a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ } else {
++ /* continue pairing info polling */
++ callback_in_ms(20, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ } else if (input->pairing_info_read != PASS ||
++ input->h_prime_validation != PASS) {
++ /* 1A-11-1: consider invalid h' a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A2_LOCALITY_CHECK);
++ break;
++ case H2_A1_SEND_STORED_KM:
++ if (input->stored_km_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 200, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A1_VALIDATE_H_PRIME);
++ break;
++ case H2_A1_VALIDATE_H_PRIME:
++ if (input->h_prime_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1A-11-2: consider h' timeout a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ } else {
++ /* continue h' polling */
++ callback_in_ms(20, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ } else if (input->h_prime_read != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->h_prime_validation != PASS) {
++ /* 1A-11-1: consider invalid h' a failure */
++ adjust->hdcp2.force_no_stored_km = 1;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A2_LOCALITY_CHECK);
++ break;
++ case H2_A2_LOCALITY_CHECK:
++ if (hdcp->state.stay_count > 10 ||
++ input->lc_init_prepare != PASS ||
++ input->lc_init_write != PASS ||
++ input->l_prime_available_poll != PASS ||
++ input->l_prime_read != PASS) {
++ /*
++ * 1A-05: consider disconnection after LC init a failure
++ * 1A-13-1: consider invalid l' a failure
++ * 1A-13-2: consider l' timeout a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->l_prime_validation != PASS) {
++ callback_in_ms(0, output);
++ increment_stay_counter(hdcp);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER);
++ break;
++ case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
++ if (input->eks_prepare != PASS ||
++ input->eks_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (conn->is_repeater) {
++ set_watchdog_in_ms(hdcp, 3000, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A6_WAIT_FOR_RX_ID_LIST);
++ } else {
++ /* some CTS equipment requires a delay GREATER than
++ * 200 ms, so delay 210 ms instead of 200 ms
++ */
++ callback_in_ms(210, output);
++ set_state_id(hdcp, output, H2_ENABLE_ENCRYPTION);
++ }
++ break;
++ case H2_ENABLE_ENCRYPTION:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ /*
++ * 1A-07: restart hdcp on REAUTH_REQ
++ * 1B-08: restart hdcp on REAUTH_REQ
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->enable_encryption != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A5_AUTHENTICATED);
++ HDCP_FULL_DDC_TRACE(hdcp);
++ break;
++ case H2_A5_AUTHENTICATED:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ }
++ callback_in_ms(500, output);
++ increment_stay_counter(hdcp);
++ break;
++ case H2_A6_WAIT_FOR_RX_ID_LIST:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (!event_ctx->rx_id_list_ready) {
++ if (event_ctx->event == MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1B-02: consider rx id list timeout a failure */
++ /* some CTS equipment's actual timeout
++ * measurement is slightly greater than 3000 ms.
++ * Delay 100 ms to ensure it is fully timeout
++ * before re-authentication.
++ */
++ fail_and_restart_in_ms(100, &status, output);
++ } else {
++ callback_in_ms(300, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->rx_id_list_read != PASS ||
++ input->device_count_check != PASS ||
++ input->rx_id_list_validation != PASS ||
++ input->repeater_auth_ack_write != PASS) {
++ /* 1B-03: consider invalid v' a failure
++ * 1B-04: consider MAX_DEVS_EXCEEDED a failure
++ * 1B-05: consider MAX_CASCADE_EXCEEDED a failure
++ * 1B-06: consider invalid seq_num_V a failure
++ * 1B-09: consider seq_num_V rollover a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A9_SEND_STREAM_MANAGEMENT);
++ break;
++ case H2_A9_SEND_STREAM_MANAGEMENT:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->prepare_stream_manage != PASS ||
++ input->stream_manage_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 100, output);
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A9_VALIDATE_STREAM_READY);
++ break;
++ case H2_A9_VALIDATE_STREAM_READY:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->stream_ready_available != PASS) {
++ if (event_ctx->event == MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
++ /* 1B-10-2: restart content stream management on
++ * stream ready timeout
++ */
++ hdcp->auth.count.stream_management_retry_count++;
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A9_SEND_STREAM_MANAGEMENT);
++ } else {
++ callback_in_ms(10, output);
++ increment_stay_counter(hdcp);
++ }
++ break;
++ } else if (input->stream_ready_read != PASS ||
++ input->stream_ready_validation != PASS) {
++ /*
++ * 1B-10-1: restart content stream management
++ * on invalid M'
++ */
++ if (hdcp->auth.count.stream_management_retry_count > 10) {
++ fail_and_restart_in_ms(0, &status, output);
++ } else {
++ hdcp->auth.count.stream_management_retry_count++;
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, H2_A9_SEND_STREAM_MANAGEMENT);
++ }
++ break;
++ }
++ callback_in_ms(200, output);
++ set_state_id(hdcp, output, H2_ENABLE_ENCRYPTION);
++ break;
++ default:
++ status = MOD_HDCP_STATUS_INVALID_STATE;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++
++ return status;
++}
++
++enum mod_hdcp_status mod_hdcp_hdcp2_dp_transition(struct mod_hdcp *hdcp,
++ struct mod_hdcp_event_context *event_ctx,
++ struct mod_hdcp_transition_input_hdcp2 *input,
++ struct mod_hdcp_output *output)
++{
++ enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
++ struct mod_hdcp_connection *conn = &hdcp->connection;
++ struct mod_hdcp_link_adjustment *adjust = &hdcp->connection.link.adjust;
++
++ switch (current_state(hdcp)) {
++ case D2_A0_DETERMINE_RX_HDCP_CAPABLE:
++ if (input->rx_caps_read_dp != PASS ||
++ input->hdcp2_capable_check != PASS) {
++ adjust->hdcp2.disable = 1;
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, HDCP_INITIALIZED);
++ } else {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A1_SEND_AKE_INIT);
++ }
++ break;
++ case D2_A1_SEND_AKE_INIT:
++ if (input->add_topology != PASS ||
++ input->create_session != PASS ||
++ input->ake_init_prepare != PASS) {
++ /* out of sync with psp state */
++ adjust->hdcp2.disable = 1;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->ake_init_write != PASS) {
++ /* possibly display not ready */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(100, output);
++ set_state_id(hdcp, output, D2_A1_VALIDATE_AKE_CERT);
++ break;
++ case D2_A1_VALIDATE_AKE_CERT:
++ if (input->ake_cert_read != PASS ||
++ input->ake_cert_validation != PASS) {
++ /*
++ * 1A-08: consider invalid ake cert a failure
++ * 1A-09: consider receiver id listed in SRM a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (conn->is_km_stored &&
++ !adjust->hdcp2.force_no_stored_km) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A1_SEND_STORED_KM);
++ } else {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A1_SEND_NO_STORED_KM);
++ }
++ break;
++ case D2_A1_SEND_NO_STORED_KM:
++ if (input->no_stored_km_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (adjust->hdcp2.increase_h_prime_timeout)
++ set_watchdog_in_ms(hdcp, 2000, output);
++ else
++ set_watchdog_in_ms(hdcp, 1000, output);
++ set_state_id(hdcp, output, D2_A1_READ_H_PRIME);
++ break;
++ case D2_A1_READ_H_PRIME:
++ if (input->h_prime_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT)
++ /* 1A-10-3: consider h' timeout a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ else
++ increment_stay_counter(hdcp);
++ break;
++ } else if (input->h_prime_read != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 200, output);
++ set_state_id(hdcp, output, D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME);
++ break;
++ case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
++ if (input->pairing_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT)
++ /*
++ * 1A-11: consider pairing info timeout
++ * a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ else
++ increment_stay_counter(hdcp);
++ break;
++ } else if (input->pairing_info_read != PASS ||
++ input->h_prime_validation != PASS) {
++ /* 1A-10-1: consider invalid h' a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A2_LOCALITY_CHECK);
++ break;
++ case D2_A1_SEND_STORED_KM:
++ if (input->stored_km_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_watchdog_in_ms(hdcp, 200, output);
++ set_state_id(hdcp, output, D2_A1_VALIDATE_H_PRIME);
++ break;
++ case D2_A1_VALIDATE_H_PRIME:
++ if (input->h_prime_available != PASS) {
++ if (event_ctx->event ==
++ MOD_HDCP_EVENT_WATCHDOG_TIMEOUT)
++ /* 1A-10-2: consider h' timeout a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ else
++ increment_stay_counter(hdcp);
++ break;
++ } else if (input->h_prime_read != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->h_prime_validation != PASS) {
++ /* 1A-10-1: consider invalid h' a failure */
++ adjust->hdcp2.force_no_stored_km = 1;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A2_LOCALITY_CHECK);
++ break;
++ case D2_A2_LOCALITY_CHECK:
++ if (hdcp->state.stay_count > 10 ||
++ input->lc_init_prepare != PASS ||
++ input->lc_init_write != PASS ||
++ input->l_prime_read != PASS) {
++ /* 1A-12: consider invalid l' a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->l_prime_validation != PASS) {
++ callback_in_ms(0, output);
++ increment_stay_counter(hdcp);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER);
++ break;
++ case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
++ if (input->eks_prepare != PASS ||
++ input->eks_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ if (conn->is_repeater) {
++ set_watchdog_in_ms(hdcp, 3000, output);
++ set_state_id(hdcp, output, D2_A6_WAIT_FOR_RX_ID_LIST);
++ } else {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_SEND_CONTENT_STREAM_TYPE);
++ }
++ break;
++ case D2_SEND_CONTENT_STREAM_TYPE:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS ||
++ input->content_stream_type_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(210, output);
++ set_state_id(hdcp, output, D2_ENABLE_ENCRYPTION);
++ break;
++ case D2_ENABLE_ENCRYPTION:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS) {
++ /*
++ * 1A-07: restart hdcp on REAUTH_REQ
++ * 1B-08: restart hdcp on REAUTH_REQ
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->enable_encryption != PASS ||
++ (is_dp_mst_hdcp(hdcp) && input->stream_encryption_dp != PASS)) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ set_state_id(hdcp, output, D2_A5_AUTHENTICATED);
++ HDCP_FULL_DDC_TRACE(hdcp);
++ break;
++ case D2_A5_AUTHENTICATED:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (input->link_integrity_check_dp != PASS) {
++ if (hdcp->connection.hdcp2_retry_count >= 1)
++ adjust->hdcp2.disable_type1 = 1;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready && conn->is_repeater) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ }
++ increment_stay_counter(hdcp);
++ break;
++ case D2_A6_WAIT_FOR_RX_ID_LIST:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (!event_ctx->rx_id_list_ready) {
++ if (event_ctx->event == MOD_HDCP_EVENT_WATCHDOG_TIMEOUT)
++ /* 1B-02: consider rx id list timeout a failure */
++ fail_and_restart_in_ms(0, &status, output);
++ else
++ increment_stay_counter(hdcp);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS ||
++ input->rx_id_list_read != PASS ||
++ input->device_count_check != PASS ||
++ input->rx_id_list_validation != PASS ||
++ input->repeater_auth_ack_write != PASS) {
++ /*
++ * 1B-03: consider invalid v' a failure
++ * 1B-04: consider MAX_DEVS_EXCEEDED a failure
++ * 1B-05: consider MAX_CASCADE_EXCEEDED a failure
++ * 1B-06: consider invalid seq_num_V a failure
++ * 1B-09: consider seq_num_V rollover a failure
++ */
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A9_SEND_STREAM_MANAGEMENT);
++ break;
++ case D2_A9_SEND_STREAM_MANAGEMENT:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->prepare_stream_manage != PASS ||
++ input->stream_manage_write != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ callback_in_ms(100, output);
++ set_state_id(hdcp, output, D2_A9_VALIDATE_STREAM_READY);
++ break;
++ case D2_A9_VALIDATE_STREAM_READY:
++ if (input->rxstatus_read != PASS ||
++ input->reauth_request_check != PASS ||
++ input->link_integrity_check_dp != PASS) {
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ } else if (event_ctx->rx_id_list_ready) {
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK);
++ break;
++ } else if (input->stream_ready_read != PASS ||
++ input->stream_ready_validation != PASS) {
++ /*
++ * 1B-10-1: restart content stream management
++ * on invalid M'
++ * 1B-10-2: consider stream ready timeout a failure
++ */
++ if (hdcp->auth.count.stream_management_retry_count > 10) {
++ fail_and_restart_in_ms(0, &status, output);
++ } else {
++ hdcp->auth.count.stream_management_retry_count++;
++ callback_in_ms(0, output);
++ set_state_id(hdcp, output, D2_A9_SEND_STREAM_MANAGEMENT);
++ }
++ break;
++ }
++ callback_in_ms(200, output);
++ set_state_id(hdcp, output, D2_ENABLE_ENCRYPTION);
++ break;
++ default:
++ status = MOD_HDCP_STATUS_INVALID_STATE;
++ fail_and_restart_in_ms(0, &status, output);
++ break;
++ }
++ return status;
++}
+diff --git a/drivers/gpu/drm/amd/display/modules/inc/mod_hdcp.h b/drivers/gpu/drm/amd/display/modules/inc/mod_hdcp.h
+index dea21702edff..97ecbf5bfec1 100644
+--- a/drivers/gpu/drm/amd/display/modules/inc/mod_hdcp.h
++++ b/drivers/gpu/drm/amd/display/modules/inc/mod_hdcp.h
+@@ -77,6 +77,7 @@ enum mod_hdcp_status {
+ MOD_HDCP_STATUS_HDCP2_H_PRIME_PENDING,
+ MOD_HDCP_STATUS_HDCP2_PAIRING_INFO_PENDING,
+ MOD_HDCP_STATUS_HDCP2_VALIDATE_AKE_CERT_FAILURE,
++ MOD_HDCP_STATUS_HDCP2_AKE_CERT_REVOKED,
+ MOD_HDCP_STATUS_HDCP2_VALIDATE_H_PRIME_FAILURE,
+ MOD_HDCP_STATUS_HDCP2_VALIDATE_PAIRING_INFO_FAILURE,
+ MOD_HDCP_STATUS_HDCP2_PREP_LC_INIT_FAILURE,
+@@ -86,6 +87,7 @@ enum mod_hdcp_status {
+ MOD_HDCP_STATUS_HDCP2_ENABLE_ENCRYPTION_FAILURE,
+ MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY,
+ MOD_HDCP_STATUS_HDCP2_VALIDATE_RX_ID_LIST_FAILURE,
++ MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_REVOKED,
+ MOD_HDCP_STATUS_HDCP2_ENABLE_STREAM_ENCRYPTION,
+ MOD_HDCP_STATUS_HDCP2_STREAM_READY_PENDING,
+ MOD_HDCP_STATUS_HDCP2_VALIDATE_STREAM_READY_FAILURE,
+--
+2.17.1
+