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
mod_hdcp_dump_binary_message(uint8_t * msg,uint32_t msg_size,uint8_t * buf,uint32_t buf_size)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
mod_hdcp_log_ddc_trace(struct mod_hdcp * hdcp)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;
mod_hdcp_status_to_str(int32_t status)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
mod_hdcp_state_id_to_str(int32_t id)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