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 buf_pos = 0; 37 uint32_t i = 0; 38 39 /* Need room for at least the terminator. */ 40 if (buf_size < terminator_size) 41 return; 42 43 for (i = 0; i < msg_size; i++) { 44 uint32_t needed = byte_size + terminator_size; 45 46 if (i % bytes_per_line == 0) 47 needed += newline_size; 48 49 if (buf_pos + needed > buf_size) 50 break; 51 52 if (i % bytes_per_line == 0) 53 buf[buf_pos++] = '\n'; 54 sprintf((char *)&buf[buf_pos], "%02X ", msg[i]); 55 buf_pos += byte_size; 56 } 57 buf[buf_pos++] = '\0'; 58 } 59 60 void mod_hdcp_log_ddc_trace(struct mod_hdcp *hdcp) 61 { 62 if (is_hdcp1(hdcp)) { 63 HDCP_DDC_READ_TRACE(hdcp, "BKSV", hdcp->auth.msg.hdcp1.bksv, 64 sizeof(hdcp->auth.msg.hdcp1.bksv)); 65 HDCP_DDC_READ_TRACE(hdcp, "BCAPS", &hdcp->auth.msg.hdcp1.bcaps, 66 sizeof(hdcp->auth.msg.hdcp1.bcaps)); 67 HDCP_DDC_READ_TRACE(hdcp, "BSTATUS", 68 (uint8_t *)&hdcp->auth.msg.hdcp1.bstatus, 69 sizeof(hdcp->auth.msg.hdcp1.bstatus)); 70 HDCP_DDC_WRITE_TRACE(hdcp, "AN", hdcp->auth.msg.hdcp1.an, 71 sizeof(hdcp->auth.msg.hdcp1.an)); 72 HDCP_DDC_WRITE_TRACE(hdcp, "AKSV", hdcp->auth.msg.hdcp1.aksv, 73 sizeof(hdcp->auth.msg.hdcp1.aksv)); 74 HDCP_DDC_WRITE_TRACE(hdcp, "AINFO", &hdcp->auth.msg.hdcp1.ainfo, 75 sizeof(hdcp->auth.msg.hdcp1.ainfo)); 76 HDCP_DDC_READ_TRACE(hdcp, "RI' / R0'", 77 (uint8_t *)&hdcp->auth.msg.hdcp1.r0p, 78 sizeof(hdcp->auth.msg.hdcp1.r0p)); 79 HDCP_DDC_READ_TRACE(hdcp, "BINFO", 80 (uint8_t *)&hdcp->auth.msg.hdcp1.binfo_dp, 81 sizeof(hdcp->auth.msg.hdcp1.binfo_dp)); 82 HDCP_DDC_READ_TRACE(hdcp, "KSVLIST", hdcp->auth.msg.hdcp1.ksvlist, 83 hdcp->auth.msg.hdcp1.ksvlist_size); 84 HDCP_DDC_READ_TRACE(hdcp, "V'", hdcp->auth.msg.hdcp1.vp, 85 sizeof(hdcp->auth.msg.hdcp1.vp)); 86 } else if (is_hdcp2(hdcp)) { 87 HDCP_DDC_READ_TRACE(hdcp, "HDCP2Version", 88 &hdcp->auth.msg.hdcp2.hdcp2version_hdmi, 89 sizeof(hdcp->auth.msg.hdcp2.hdcp2version_hdmi)); 90 HDCP_DDC_READ_TRACE(hdcp, "Rx Caps", hdcp->auth.msg.hdcp2.rxcaps_dp, 91 sizeof(hdcp->auth.msg.hdcp2.rxcaps_dp)); 92 HDCP_DDC_WRITE_TRACE(hdcp, "AKE Init", hdcp->auth.msg.hdcp2.ake_init, 93 sizeof(hdcp->auth.msg.hdcp2.ake_init)); 94 HDCP_DDC_READ_TRACE(hdcp, "AKE Cert", hdcp->auth.msg.hdcp2.ake_cert, 95 sizeof(hdcp->auth.msg.hdcp2.ake_cert)); 96 HDCP_DDC_WRITE_TRACE(hdcp, "Stored KM", 97 hdcp->auth.msg.hdcp2.ake_stored_km, 98 sizeof(hdcp->auth.msg.hdcp2.ake_stored_km)); 99 HDCP_DDC_WRITE_TRACE(hdcp, "No Stored KM", 100 hdcp->auth.msg.hdcp2.ake_no_stored_km, 101 sizeof(hdcp->auth.msg.hdcp2.ake_no_stored_km)); 102 HDCP_DDC_READ_TRACE(hdcp, "H'", hdcp->auth.msg.hdcp2.ake_h_prime, 103 sizeof(hdcp->auth.msg.hdcp2.ake_h_prime)); 104 HDCP_DDC_READ_TRACE(hdcp, "Pairing Info", 105 hdcp->auth.msg.hdcp2.ake_pairing_info, 106 sizeof(hdcp->auth.msg.hdcp2.ake_pairing_info)); 107 HDCP_DDC_WRITE_TRACE(hdcp, "LC Init", hdcp->auth.msg.hdcp2.lc_init, 108 sizeof(hdcp->auth.msg.hdcp2.lc_init)); 109 HDCP_DDC_READ_TRACE(hdcp, "L'", hdcp->auth.msg.hdcp2.lc_l_prime, 110 sizeof(hdcp->auth.msg.hdcp2.lc_l_prime)); 111 HDCP_DDC_WRITE_TRACE(hdcp, "Exchange KS", hdcp->auth.msg.hdcp2.ske_eks, 112 sizeof(hdcp->auth.msg.hdcp2.ske_eks)); 113 HDCP_DDC_READ_TRACE(hdcp, "Rx Status", 114 (uint8_t *)&hdcp->auth.msg.hdcp2.rxstatus, 115 sizeof(hdcp->auth.msg.hdcp2.rxstatus)); 116 HDCP_DDC_READ_TRACE(hdcp, "Rx Id List", 117 hdcp->auth.msg.hdcp2.rx_id_list, 118 hdcp->auth.msg.hdcp2.rx_id_list_size); 119 HDCP_DDC_WRITE_TRACE(hdcp, "Rx Id List Ack", 120 hdcp->auth.msg.hdcp2.repeater_auth_ack, 121 sizeof(hdcp->auth.msg.hdcp2.repeater_auth_ack)); 122 HDCP_DDC_WRITE_TRACE(hdcp, "Content Stream Management", 123 hdcp->auth.msg.hdcp2.repeater_auth_stream_manage, 124 hdcp->auth.msg.hdcp2.stream_manage_size); 125 HDCP_DDC_READ_TRACE(hdcp, "Stream Ready", 126 hdcp->auth.msg.hdcp2.repeater_auth_stream_ready, 127 sizeof(hdcp->auth.msg.hdcp2.repeater_auth_stream_ready)); 128 HDCP_DDC_WRITE_TRACE(hdcp, "Content Stream Type", 129 hdcp->auth.msg.hdcp2.content_stream_type_dp, 130 sizeof(hdcp->auth.msg.hdcp2.content_stream_type_dp)); 131 } 132 } 133 134 #define CASE_FORMAT(entry) case entry: return #entry; 135 char *mod_hdcp_status_to_str(int32_t status) 136 { 137 switch (status) { 138 MOD_HDCP_STATUS_LIST(CASE_FORMAT) 139 default: 140 return "MOD_HDCP_STATUS_UNKNOWN"; 141 } 142 } 143 144 char *mod_hdcp_state_id_to_str(int32_t id) 145 { 146 switch (id) { 147 case HDCP_UNINITIALIZED: 148 return "HDCP_UNINITIALIZED"; 149 case HDCP_INITIALIZED: 150 return "HDCP_INITIALIZED"; 151 case HDCP_CP_NOT_DESIRED: 152 return "HDCP_CP_NOT_DESIRED"; 153 case H1_A0_WAIT_FOR_ACTIVE_RX: 154 return "H1_A0_WAIT_FOR_ACTIVE_RX"; 155 case H1_A1_EXCHANGE_KSVS: 156 return "H1_A1_EXCHANGE_KSVS"; 157 case H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER: 158 return "H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER"; 159 case H1_A45_AUTHENTICATED: 160 return "H1_A45_AUTHENTICATED"; 161 case H1_A8_WAIT_FOR_READY: 162 return "H1_A8_WAIT_FOR_READY"; 163 case H1_A9_READ_KSV_LIST: 164 return "H1_A9_READ_KSV_LIST"; 165 case D1_A0_DETERMINE_RX_HDCP_CAPABLE: 166 return "D1_A0_DETERMINE_RX_HDCP_CAPABLE"; 167 case D1_A1_EXCHANGE_KSVS: 168 return "D1_A1_EXCHANGE_KSVS"; 169 case D1_A23_WAIT_FOR_R0_PRIME: 170 return "D1_A23_WAIT_FOR_R0_PRIME"; 171 case D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER: 172 return "D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER"; 173 case D1_A4_AUTHENTICATED: 174 return "D1_A4_AUTHENTICATED"; 175 case D1_A6_WAIT_FOR_READY: 176 return "D1_A6_WAIT_FOR_READY"; 177 case D1_A7_READ_KSV_LIST: 178 return "D1_A7_READ_KSV_LIST"; 179 case H2_A0_KNOWN_HDCP2_CAPABLE_RX: 180 return "H2_A0_KNOWN_HDCP2_CAPABLE_RX"; 181 case H2_A1_SEND_AKE_INIT: 182 return "H2_A1_SEND_AKE_INIT"; 183 case H2_A1_VALIDATE_AKE_CERT: 184 return "H2_A1_VALIDATE_AKE_CERT"; 185 case H2_A1_SEND_NO_STORED_KM: 186 return "H2_A1_SEND_NO_STORED_KM"; 187 case H2_A1_READ_H_PRIME: 188 return "H2_A1_READ_H_PRIME"; 189 case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 190 return "H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 191 case H2_A1_SEND_STORED_KM: 192 return "H2_A1_SEND_STORED_KM"; 193 case H2_A1_VALIDATE_H_PRIME: 194 return "H2_A1_VALIDATE_H_PRIME"; 195 case H2_A2_LOCALITY_CHECK: 196 return "H2_A2_LOCALITY_CHECK"; 197 case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 198 return "H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 199 case H2_ENABLE_ENCRYPTION: 200 return "H2_ENABLE_ENCRYPTION"; 201 case H2_A5_AUTHENTICATED: 202 return "H2_A5_AUTHENTICATED"; 203 case H2_A6_WAIT_FOR_RX_ID_LIST: 204 return "H2_A6_WAIT_FOR_RX_ID_LIST"; 205 case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 206 return "H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 207 case H2_A9_SEND_STREAM_MANAGEMENT: 208 return "H2_A9_SEND_STREAM_MANAGEMENT"; 209 case H2_A9_VALIDATE_STREAM_READY: 210 return "H2_A9_VALIDATE_STREAM_READY"; 211 case D2_A0_DETERMINE_RX_HDCP_CAPABLE: 212 return "D2_A0_DETERMINE_RX_HDCP_CAPABLE"; 213 case D2_A1_SEND_AKE_INIT: 214 return "D2_A1_SEND_AKE_INIT"; 215 case D2_A1_VALIDATE_AKE_CERT: 216 return "D2_A1_VALIDATE_AKE_CERT"; 217 case D2_A1_SEND_NO_STORED_KM: 218 return "D2_A1_SEND_NO_STORED_KM"; 219 case D2_A1_READ_H_PRIME: 220 return "D2_A1_READ_H_PRIME"; 221 case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 222 return "D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME"; 223 case D2_A1_SEND_STORED_KM: 224 return "D2_A1_SEND_STORED_KM"; 225 case D2_A1_VALIDATE_H_PRIME: 226 return "D2_A1_VALIDATE_H_PRIME"; 227 case D2_A2_LOCALITY_CHECK: 228 return "D2_A2_LOCALITY_CHECK"; 229 case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 230 return "D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER"; 231 case D2_SEND_CONTENT_STREAM_TYPE: 232 return "D2_SEND_CONTENT_STREAM_TYPE"; 233 case D2_ENABLE_ENCRYPTION: 234 return "D2_ENABLE_ENCRYPTION"; 235 case D2_A5_AUTHENTICATED: 236 return "D2_A5_AUTHENTICATED"; 237 case D2_A6_WAIT_FOR_RX_ID_LIST: 238 return "D2_A6_WAIT_FOR_RX_ID_LIST"; 239 case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 240 return "D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK"; 241 case D2_A9_SEND_STREAM_MANAGEMENT: 242 return "D2_A9_SEND_STREAM_MANAGEMENT"; 243 case D2_A9_VALIDATE_STREAM_READY: 244 return "D2_A9_VALIDATE_STREAM_READY"; 245 default: 246 return "UNKNOWN_STATE_ID"; 247 } 248 } 249 250