1 /* 2 * Copyright 2019 Advanced Micro Devices, Inc. 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining a 5 * copy of this software and associated documentation files (the "Software"), 6 * to deal in the Software without restriction, including without limitation 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8 * and/or sell copies of the Software, and to permit persons to whom the 9 * Software is furnished to do so, subject to the following conditions: 10 * 11 * The above copyright notice and this permission notice shall be included in 12 * all copies or substantial portions of the Software. 13 * 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20 * OTHER DEALINGS IN THE SOFTWARE. 21 * 22 * Authors: AMD 23 * 24 */ 25 26 27 #include "hdcp.h" 28 29 void mod_hdcp_dump_binary_message(uint8_t *msg, uint32_t msg_size, 30 uint8_t *buf, uint32_t buf_size) 31 { 32 const uint8_t bytes_per_line = 16, 33 byte_size = 3, 34 newline_size = 1, 35 terminator_size = 1; 36 uint32_t line_count = msg_size / bytes_per_line, 37 trailing_bytes = msg_size % bytes_per_line; 38 uint32_t target_size = (byte_size * bytes_per_line + newline_size) * line_count + 39 byte_size * trailing_bytes + newline_size + terminator_size; 40 uint32_t buf_pos = 0; 41 uint32_t i = 0; 42 43 if (buf_size >= target_size) { 44 for (i = 0; i < msg_size; i++) { 45 if (i % bytes_per_line == 0) 46 buf[buf_pos++] = '\n'; 47 sprintf(&buf[buf_pos], "%02X ", msg[i]); 48 buf_pos += byte_size; 49 } 50 buf[buf_pos++] = '\0'; 51 } 52 } 53 54 void mod_hdcp_log_ddc_trace(struct mod_hdcp *hdcp) 55 { 56 if (is_hdcp1(hdcp)) { 57 HDCP_DDC_READ_TRACE(hdcp, "BKSV", hdcp->auth.msg.hdcp1.bksv, 58 sizeof(hdcp->auth.msg.hdcp1.bksv)); 59 HDCP_DDC_READ_TRACE(hdcp, "BCAPS", &hdcp->auth.msg.hdcp1.bcaps, 60 sizeof(hdcp->auth.msg.hdcp1.bcaps)); 61 HDCP_DDC_READ_TRACE(hdcp, "BSTATUS", 62 (uint8_t *)&hdcp->auth.msg.hdcp1.bstatus, 63 sizeof(hdcp->auth.msg.hdcp1.bstatus)); 64 HDCP_DDC_WRITE_TRACE(hdcp, "AN", hdcp->auth.msg.hdcp1.an, 65 sizeof(hdcp->auth.msg.hdcp1.an)); 66 HDCP_DDC_WRITE_TRACE(hdcp, "AKSV", hdcp->auth.msg.hdcp1.aksv, 67 sizeof(hdcp->auth.msg.hdcp1.aksv)); 68 HDCP_DDC_WRITE_TRACE(hdcp, "AINFO", &hdcp->auth.msg.hdcp1.ainfo, 69 sizeof(hdcp->auth.msg.hdcp1.ainfo)); 70 HDCP_DDC_READ_TRACE(hdcp, "RI' / R0'", 71 (uint8_t *)&hdcp->auth.msg.hdcp1.r0p, 72 sizeof(hdcp->auth.msg.hdcp1.r0p)); 73 HDCP_DDC_READ_TRACE(hdcp, "BINFO", 74 (uint8_t *)&hdcp->auth.msg.hdcp1.binfo_dp, 75 sizeof(hdcp->auth.msg.hdcp1.binfo_dp)); 76 HDCP_DDC_READ_TRACE(hdcp, "KSVLIST", hdcp->auth.msg.hdcp1.ksvlist, 77 hdcp->auth.msg.hdcp1.ksvlist_size); 78 HDCP_DDC_READ_TRACE(hdcp, "V'", hdcp->auth.msg.hdcp1.vp, 79 sizeof(hdcp->auth.msg.hdcp1.vp)); 80 } else if (is_hdcp2(hdcp)) { 81 HDCP_DDC_READ_TRACE(hdcp, "HDCP2Version", 82 &hdcp->auth.msg.hdcp2.hdcp2version_hdmi, 83 sizeof(hdcp->auth.msg.hdcp2.hdcp2version_hdmi)); 84 HDCP_DDC_READ_TRACE(hdcp, "Rx Caps", hdcp->auth.msg.hdcp2.rxcaps_dp, 85 sizeof(hdcp->auth.msg.hdcp2.rxcaps_dp)); 86 HDCP_DDC_WRITE_TRACE(hdcp, "AKE Init", hdcp->auth.msg.hdcp2.ake_init, 87 sizeof(hdcp->auth.msg.hdcp2.ake_init)); 88 HDCP_DDC_READ_TRACE(hdcp, "AKE Cert", hdcp->auth.msg.hdcp2.ake_cert, 89 sizeof(hdcp->auth.msg.hdcp2.ake_cert)); 90 HDCP_DDC_WRITE_TRACE(hdcp, "Stored KM", 91 hdcp->auth.msg.hdcp2.ake_stored_km, 92 sizeof(hdcp->auth.msg.hdcp2.ake_stored_km)); 93 HDCP_DDC_WRITE_TRACE(hdcp, "No Stored KM", 94 hdcp->auth.msg.hdcp2.ake_no_stored_km, 95 sizeof(hdcp->auth.msg.hdcp2.ake_no_stored_km)); 96 HDCP_DDC_READ_TRACE(hdcp, "H'", hdcp->auth.msg.hdcp2.ake_h_prime, 97 sizeof(hdcp->auth.msg.hdcp2.ake_h_prime)); 98 HDCP_DDC_READ_TRACE(hdcp, "Pairing Info", 99 hdcp->auth.msg.hdcp2.ake_pairing_info, 100 sizeof(hdcp->auth.msg.hdcp2.ake_pairing_info)); 101 HDCP_DDC_WRITE_TRACE(hdcp, "LC Init", hdcp->auth.msg.hdcp2.lc_init, 102 sizeof(hdcp->auth.msg.hdcp2.lc_init)); 103 HDCP_DDC_READ_TRACE(hdcp, "L'", hdcp->auth.msg.hdcp2.lc_l_prime, 104 sizeof(hdcp->auth.msg.hdcp2.lc_l_prime)); 105 HDCP_DDC_WRITE_TRACE(hdcp, "Exchange KS", hdcp->auth.msg.hdcp2.ske_eks, 106 sizeof(hdcp->auth.msg.hdcp2.ske_eks)); 107 HDCP_DDC_READ_TRACE(hdcp, "Rx Status", 108 (uint8_t *)&hdcp->auth.msg.hdcp2.rxstatus, 109 sizeof(hdcp->auth.msg.hdcp2.rxstatus)); 110 HDCP_DDC_READ_TRACE(hdcp, "Rx Id List", 111 hdcp->auth.msg.hdcp2.rx_id_list, 112 hdcp->auth.msg.hdcp2.rx_id_list_size); 113 HDCP_DDC_WRITE_TRACE(hdcp, "Rx Id List Ack", 114 hdcp->auth.msg.hdcp2.repeater_auth_ack, 115 sizeof(hdcp->auth.msg.hdcp2.repeater_auth_ack)); 116 HDCP_DDC_WRITE_TRACE(hdcp, "Content Stream Management", 117 hdcp->auth.msg.hdcp2.repeater_auth_stream_manage, 118 hdcp->auth.msg.hdcp2.stream_manage_size); 119 HDCP_DDC_READ_TRACE(hdcp, "Stream Ready", 120 hdcp->auth.msg.hdcp2.repeater_auth_stream_ready, 121 sizeof(hdcp->auth.msg.hdcp2.repeater_auth_stream_ready)); 122 HDCP_DDC_WRITE_TRACE(hdcp, "Content Stream Type", 123 hdcp->auth.msg.hdcp2.content_stream_type_dp, 124 sizeof(hdcp->auth.msg.hdcp2.content_stream_type_dp)); 125 } 126 } 127 128 #define CASE_FORMAT(entry) case entry: return #entry; 129 char *mod_hdcp_status_to_str(int32_t status) 130 { 131 switch (status) { 132 MOD_HDCP_STATUS_LIST(CASE_FORMAT) 133 default: 134 return "MOD_HDCP_STATUS_UNKNOWN"; 135 } 136 } 137 138 char *mod_hdcp_state_id_to_str(int32_t id) 139 { 140 switch (id) { 141 case HDCP_UNINITIALIZED: 142 return "HDCP_UNINITIALIZED"; 143 case HDCP_INITIALIZED: 144 return "HDCP_INITIALIZED"; 145 case HDCP_CP_NOT_DESIRED: 146 return "HDCP_CP_NOT_DESIRED"; 147 case H1_A0_WAIT_FOR_ACTIVE_RX: 148 return "H1_A0_WAIT_FOR_ACTIVE_RX"; 149 case H1_A1_EXCHANGE_KSVS: 150 return "H1_A1_EXCHANGE_KSVS"; 151 case H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER: 152 return "H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER"; 153 case H1_A45_AUTHENTICATED: 154 return "H1_A45_AUTHENTICATED"; 155 case H1_A8_WAIT_FOR_READY: 156 return "H1_A8_WAIT_FOR_READY"; 157 case H1_A9_READ_KSV_LIST: 158 return "H1_A9_READ_KSV_LIST"; 159 case D1_A0_DETERMINE_RX_HDCP_CAPABLE: 160 return "D1_A0_DETERMINE_RX_HDCP_CAPABLE"; 161 case D1_A1_EXCHANGE_KSVS: 162 return "D1_A1_EXCHANGE_KSVS"; 163 case D1_A23_WAIT_FOR_R0_PRIME: 164 return "D1_A23_WAIT_FOR_R0_PRIME"; 165 case D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER: 166 return "D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER"; 167 case D1_A4_AUTHENTICATED: 168 return "D1_A4_AUTHENTICATED"; 169 case D1_A6_WAIT_FOR_READY: 170 return "D1_A6_WAIT_FOR_READY"; 171 case D1_A7_READ_KSV_LIST: 172 return "D1_A7_READ_KSV_LIST"; 173 case H2_A0_KNOWN_HDCP2_CAPABLE_RX: 174 return "H2_A0_KNOWN_HDCP2_CAPABLE_RX"; 175 case H2_A1_SEND_AKE_INIT: 176 return "H2_A1_SEND_AKE_INIT"; 177 case H2_A1_VALIDATE_AKE_CERT: 178 return "H2_A1_VALIDATE_AKE_CERT"; 179 case H2_A1_SEND_NO_STORED_KM: 180 return "H2_A1_SEND_NO_STORED_KM"; 181 case H2_A1_READ_H_PRIME: 182 return "H2_A1_READ_H_PRIME"; 183 case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 184 return "H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 185 case H2_A1_SEND_STORED_KM: 186 return "H2_A1_SEND_STORED_KM"; 187 case H2_A1_VALIDATE_H_PRIME: 188 return "H2_A1_VALIDATE_H_PRIME"; 189 case H2_A2_LOCALITY_CHECK: 190 return "H2_A2_LOCALITY_CHECK"; 191 case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 192 return "H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 193 case H2_ENABLE_ENCRYPTION: 194 return "H2_ENABLE_ENCRYPTION"; 195 case H2_A5_AUTHENTICATED: 196 return "H2_A5_AUTHENTICATED"; 197 case H2_A6_WAIT_FOR_RX_ID_LIST: 198 return "H2_A6_WAIT_FOR_RX_ID_LIST"; 199 case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 200 return "H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 201 case H2_A9_SEND_STREAM_MANAGEMENT: 202 return "H2_A9_SEND_STREAM_MANAGEMENT"; 203 case H2_A9_VALIDATE_STREAM_READY: 204 return "H2_A9_VALIDATE_STREAM_READY"; 205 case D2_A0_DETERMINE_RX_HDCP_CAPABLE: 206 return "D2_A0_DETERMINE_RX_HDCP_CAPABLE"; 207 case D2_A1_SEND_AKE_INIT: 208 return "D2_A1_SEND_AKE_INIT"; 209 case D2_A1_VALIDATE_AKE_CERT: 210 return "D2_A1_VALIDATE_AKE_CERT"; 211 case D2_A1_SEND_NO_STORED_KM: 212 return "D2_A1_SEND_NO_STORED_KM"; 213 case D2_A1_READ_H_PRIME: 214 return "D2_A1_READ_H_PRIME"; 215 case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 216 return "D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 217 case D2_A1_SEND_STORED_KM: 218 return "D2_A1_SEND_STORED_KM"; 219 case D2_A1_VALIDATE_H_PRIME: 220 return "D2_A1_VALIDATE_H_PRIME"; 221 case D2_A2_LOCALITY_CHECK: 222 return "D2_A2_LOCALITY_CHECK"; 223 case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 224 return "D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 225 case D2_SEND_CONTENT_STREAM_TYPE: 226 return "D2_SEND_CONTENT_STREAM_TYPE"; 227 case D2_ENABLE_ENCRYPTION: 228 return "D2_ENABLE_ENCRYPTION"; 229 case D2_A5_AUTHENTICATED: 230 return "D2_A5_AUTHENTICATED"; 231 case D2_A6_WAIT_FOR_RX_ID_LIST: 232 return "D2_A6_WAIT_FOR_RX_ID_LIST"; 233 case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 234 return "D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 235 case D2_A9_SEND_STREAM_MANAGEMENT: 236 return "D2_A9_SEND_STREAM_MANAGEMENT"; 237 case D2_A9_VALIDATE_STREAM_READY: 238 return "D2_A9_VALIDATE_STREAM_READY"; 239 default: 240 return "UNKNOWN_STATE_ID"; 241 } 242 } 243 244