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 130 char *mod_hdcp_status_to_str(int32_t status) 131 { 132 switch (status) { 133 MOD_HDCP_STATUS_LIST(CASE_FORMAT) 134 default: 135 return "MOD_HDCP_STATUS_UNKNOWN"; 136 } 137 } 138 139 char *mod_hdcp_state_id_to_str(int32_t id) 140 { 141 switch (id) { 142 case HDCP_UNINITIALIZED: 143 return "HDCP_UNINITIALIZED"; 144 case HDCP_INITIALIZED: 145 return "HDCP_INITIALIZED"; 146 case HDCP_CP_NOT_DESIRED: 147 return "HDCP_CP_NOT_DESIRED"; 148 case H1_A0_WAIT_FOR_ACTIVE_RX: 149 return "H1_A0_WAIT_FOR_ACTIVE_RX"; 150 case H1_A1_EXCHANGE_KSVS: 151 return "H1_A1_EXCHANGE_KSVS"; 152 case H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER: 153 return "H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER"; 154 case H1_A45_AUTHENTICATED: 155 return "H1_A45_AUTHENTICATED"; 156 case H1_A8_WAIT_FOR_READY: 157 return "H1_A8_WAIT_FOR_READY"; 158 case H1_A9_READ_KSV_LIST: 159 return "H1_A9_READ_KSV_LIST"; 160 case D1_A0_DETERMINE_RX_HDCP_CAPABLE: 161 return "D1_A0_DETERMINE_RX_HDCP_CAPABLE"; 162 case D1_A1_EXCHANGE_KSVS: 163 return "D1_A1_EXCHANGE_KSVS"; 164 case D1_A23_WAIT_FOR_R0_PRIME: 165 return "D1_A23_WAIT_FOR_R0_PRIME"; 166 case D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER: 167 return "D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER"; 168 case D1_A4_AUTHENTICATED: 169 return "D1_A4_AUTHENTICATED"; 170 case D1_A6_WAIT_FOR_READY: 171 return "D1_A6_WAIT_FOR_READY"; 172 case D1_A7_READ_KSV_LIST: 173 return "D1_A7_READ_KSV_LIST"; 174 case H2_A0_KNOWN_HDCP2_CAPABLE_RX: 175 return "H2_A0_KNOWN_HDCP2_CAPABLE_RX"; 176 case H2_A1_SEND_AKE_INIT: 177 return "H2_A1_SEND_AKE_INIT"; 178 case H2_A1_VALIDATE_AKE_CERT: 179 return "H2_A1_VALIDATE_AKE_CERT"; 180 case H2_A1_SEND_NO_STORED_KM: 181 return "H2_A1_SEND_NO_STORED_KM"; 182 case H2_A1_READ_H_PRIME: 183 return "H2_A1_READ_H_PRIME"; 184 case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 185 return "H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 186 case H2_A1_SEND_STORED_KM: 187 return "H2_A1_SEND_STORED_KM"; 188 case H2_A1_VALIDATE_H_PRIME: 189 return "H2_A1_VALIDATE_H_PRIME"; 190 case H2_A2_LOCALITY_CHECK: 191 return "H2_A2_LOCALITY_CHECK"; 192 case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 193 return "H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 194 case H2_ENABLE_ENCRYPTION: 195 return "H2_ENABLE_ENCRYPTION"; 196 case H2_A5_AUTHENTICATED: 197 return "H2_A5_AUTHENTICATED"; 198 case H2_A6_WAIT_FOR_RX_ID_LIST: 199 return "H2_A6_WAIT_FOR_RX_ID_LIST"; 200 case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 201 return "H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 202 case H2_A9_SEND_STREAM_MANAGEMENT: 203 return "H2_A9_SEND_STREAM_MANAGEMENT"; 204 case H2_A9_VALIDATE_STREAM_READY: 205 return "H2_A9_VALIDATE_STREAM_READY"; 206 case D2_A0_DETERMINE_RX_HDCP_CAPABLE: 207 return "D2_A0_DETERMINE_RX_HDCP_CAPABLE"; 208 case D2_A1_SEND_AKE_INIT: 209 return "D2_A1_SEND_AKE_INIT"; 210 case D2_A1_VALIDATE_AKE_CERT: 211 return "D2_A1_VALIDATE_AKE_CERT"; 212 case D2_A1_SEND_NO_STORED_KM: 213 return "D2_A1_SEND_NO_STORED_KM"; 214 case D2_A1_READ_H_PRIME: 215 return "D2_A1_READ_H_PRIME"; 216 case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 217 return "D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 218 case D2_A1_SEND_STORED_KM: 219 return "D2_A1_SEND_STORED_KM"; 220 case D2_A1_VALIDATE_H_PRIME: 221 return "D2_A1_VALIDATE_H_PRIME"; 222 case D2_A2_LOCALITY_CHECK: 223 return "D2_A2_LOCALITY_CHECK"; 224 case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 225 return "D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 226 case D2_SEND_CONTENT_STREAM_TYPE: 227 return "D2_SEND_CONTENT_STREAM_TYPE"; 228 case D2_ENABLE_ENCRYPTION: 229 return "D2_ENABLE_ENCRYPTION"; 230 case D2_A5_AUTHENTICATED: 231 return "D2_A5_AUTHENTICATED"; 232 case D2_A6_WAIT_FOR_RX_ID_LIST: 233 return "D2_A6_WAIT_FOR_RX_ID_LIST"; 234 case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 235 return "D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 236 case D2_A9_SEND_STREAM_MANAGEMENT: 237 return "D2_A9_SEND_STREAM_MANAGEMENT"; 238 case D2_A9_VALIDATE_STREAM_READY: 239 return "D2_A9_VALIDATE_STREAM_READY"; 240 default: 241 return "UNKNOWN_STATE_ID"; 242 } 243 } 244 245