hdcp_log.c

  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
 29void 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
 54void 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;
129char *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
138char *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