1 /*
2  * Copyright 2018 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 #include <linux/delay.h>
27 
28 #include "hdcp.h"
29 
check_receiver_id_list_ready(struct mod_hdcp * hdcp)30 static inline enum mod_hdcp_status check_receiver_id_list_ready(struct mod_hdcp *hdcp)
31 {
32 	uint8_t is_ready = 0;
33 
34 	if (is_dp_hdcp(hdcp))
35 		is_ready = HDCP_2_2_DP_RXSTATUS_READY(hdcp->auth.msg.hdcp2.rxstatus_dp) ? 1 : 0;
36 	else
37 		is_ready = (HDCP_2_2_HDMI_RXSTATUS_READY(hdcp->auth.msg.hdcp2.rxstatus[1]) &&
38 				(HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
39 						hdcp->auth.msg.hdcp2.rxstatus[0])) ? 1 : 0;
40 	return is_ready ? MOD_HDCP_STATUS_SUCCESS :
41 			MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY;
42 }
43 
check_hdcp2_capable(struct mod_hdcp * hdcp)44 static inline enum mod_hdcp_status check_hdcp2_capable(struct mod_hdcp *hdcp)
45 {
46 	enum mod_hdcp_status status;
47 
48 	if (is_dp_hdcp(hdcp))
49 		status = (hdcp->auth.msg.hdcp2.rxcaps_dp[0] == HDCP_2_2_RX_CAPS_VERSION_VAL) &&
50 				HDCP_2_2_DP_HDCP_CAPABLE(hdcp->auth.msg.hdcp2.rxcaps_dp[2]) ?
51 				MOD_HDCP_STATUS_SUCCESS :
52 				MOD_HDCP_STATUS_HDCP2_NOT_CAPABLE;
53 	else
54 		status = (hdcp->auth.msg.hdcp2.hdcp2version_hdmi & HDCP_2_2_HDMI_SUPPORT_MASK) ?
55 				MOD_HDCP_STATUS_SUCCESS :
56 				MOD_HDCP_STATUS_HDCP2_NOT_CAPABLE;
57 	return status;
58 }
59 
check_reauthentication_request(struct mod_hdcp * hdcp)60 static inline enum mod_hdcp_status check_reauthentication_request(
61 		struct mod_hdcp *hdcp)
62 {
63 	uint8_t ret = 0;
64 
65 	if (is_dp_hdcp(hdcp))
66 		ret = HDCP_2_2_DP_RXSTATUS_REAUTH_REQ(hdcp->auth.msg.hdcp2.rxstatus_dp) ?
67 				MOD_HDCP_STATUS_HDCP2_REAUTH_REQUEST :
68 				MOD_HDCP_STATUS_SUCCESS;
69 	else
70 		ret = HDCP_2_2_HDMI_RXSTATUS_REAUTH_REQ(hdcp->auth.msg.hdcp2.rxstatus[1]) ?
71 				MOD_HDCP_STATUS_HDCP2_REAUTH_REQUEST :
72 				MOD_HDCP_STATUS_SUCCESS;
73 	return ret;
74 }
75 
check_link_integrity_failure_dp(struct mod_hdcp * hdcp)76 static inline enum mod_hdcp_status check_link_integrity_failure_dp(
77 		struct mod_hdcp *hdcp)
78 {
79 	return HDCP_2_2_DP_RXSTATUS_LINK_FAILED(hdcp->auth.msg.hdcp2.rxstatus_dp) ?
80 			MOD_HDCP_STATUS_HDCP2_REAUTH_LINK_INTEGRITY_FAILURE :
81 			MOD_HDCP_STATUS_SUCCESS;
82 }
83 
check_ake_cert_available(struct mod_hdcp * hdcp)84 static enum mod_hdcp_status check_ake_cert_available(struct mod_hdcp *hdcp)
85 {
86 	enum mod_hdcp_status status;
87 	uint16_t size;
88 
89 	if (is_dp_hdcp(hdcp)) {
90 		status = MOD_HDCP_STATUS_SUCCESS;
91 	} else {
92 		status = mod_hdcp_read_rxstatus(hdcp);
93 		if (status == MOD_HDCP_STATUS_SUCCESS) {
94 			size = HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
95 			       hdcp->auth.msg.hdcp2.rxstatus[0];
96 			status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_cert)) ?
97 					MOD_HDCP_STATUS_SUCCESS :
98 					MOD_HDCP_STATUS_HDCP2_AKE_CERT_PENDING;
99 		}
100 	}
101 	return status;
102 }
103 
check_h_prime_available(struct mod_hdcp * hdcp)104 static enum mod_hdcp_status check_h_prime_available(struct mod_hdcp *hdcp)
105 {
106 	enum mod_hdcp_status status;
107 	uint8_t size;
108 
109 	status = mod_hdcp_read_rxstatus(hdcp);
110 	if (status != MOD_HDCP_STATUS_SUCCESS)
111 		goto out;
112 
113 	if (is_dp_hdcp(hdcp)) {
114 		status = HDCP_2_2_DP_RXSTATUS_H_PRIME(hdcp->auth.msg.hdcp2.rxstatus_dp) ?
115 				MOD_HDCP_STATUS_SUCCESS :
116 				MOD_HDCP_STATUS_HDCP2_H_PRIME_PENDING;
117 	} else {
118 		size = HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
119 		       hdcp->auth.msg.hdcp2.rxstatus[0];
120 		status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_h_prime)) ?
121 				MOD_HDCP_STATUS_SUCCESS :
122 				MOD_HDCP_STATUS_HDCP2_H_PRIME_PENDING;
123 	}
124 out:
125 	return status;
126 }
127 
check_pairing_info_available(struct mod_hdcp * hdcp)128 static enum mod_hdcp_status check_pairing_info_available(struct mod_hdcp *hdcp)
129 {
130 	enum mod_hdcp_status status;
131 	uint8_t size;
132 
133 	status = mod_hdcp_read_rxstatus(hdcp);
134 	if (status != MOD_HDCP_STATUS_SUCCESS)
135 		goto out;
136 
137 	if (is_dp_hdcp(hdcp)) {
138 		status = HDCP_2_2_DP_RXSTATUS_PAIRING(hdcp->auth.msg.hdcp2.rxstatus_dp) ?
139 				MOD_HDCP_STATUS_SUCCESS :
140 				MOD_HDCP_STATUS_HDCP2_PAIRING_INFO_PENDING;
141 	} else {
142 		size = HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
143 		       hdcp->auth.msg.hdcp2.rxstatus[0];
144 		status = (size == sizeof(hdcp->auth.msg.hdcp2.ake_pairing_info)) ?
145 				MOD_HDCP_STATUS_SUCCESS :
146 				MOD_HDCP_STATUS_HDCP2_PAIRING_INFO_PENDING;
147 	}
148 out:
149 	return status;
150 }
151 
poll_l_prime_available(struct mod_hdcp * hdcp)152 static enum mod_hdcp_status poll_l_prime_available(struct mod_hdcp *hdcp)
153 {
154 	enum mod_hdcp_status status;
155 	uint8_t size;
156 	uint16_t max_wait = 20; // units of ms
157 	uint16_t num_polls = 5;
158 	uint16_t wait_time = max_wait / num_polls;
159 
160 	if (is_dp_hdcp(hdcp))
161 		status = MOD_HDCP_STATUS_INVALID_OPERATION;
162 	else
163 		for (; num_polls; num_polls--) {
164 			msleep(wait_time);
165 
166 			status = mod_hdcp_read_rxstatus(hdcp);
167 			if (status != MOD_HDCP_STATUS_SUCCESS)
168 				break;
169 
170 			size = HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
171 			       hdcp->auth.msg.hdcp2.rxstatus[0];
172 			status = (size == sizeof(hdcp->auth.msg.hdcp2.lc_l_prime)) ?
173 					MOD_HDCP_STATUS_SUCCESS :
174 					MOD_HDCP_STATUS_HDCP2_L_PRIME_PENDING;
175 			if (status == MOD_HDCP_STATUS_SUCCESS)
176 				break;
177 		}
178 	return status;
179 }
180 
check_stream_ready_available(struct mod_hdcp * hdcp)181 static enum mod_hdcp_status check_stream_ready_available(struct mod_hdcp *hdcp)
182 {
183 	enum mod_hdcp_status status;
184 	uint8_t size;
185 
186 	if (is_dp_hdcp(hdcp)) {
187 		status = MOD_HDCP_STATUS_INVALID_OPERATION;
188 	} else {
189 		status = mod_hdcp_read_rxstatus(hdcp);
190 		if (status != MOD_HDCP_STATUS_SUCCESS)
191 			goto out;
192 		size = HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
193 		       hdcp->auth.msg.hdcp2.rxstatus[0];
194 		status = (size == sizeof(hdcp->auth.msg.hdcp2.repeater_auth_stream_ready)) ?
195 				MOD_HDCP_STATUS_SUCCESS :
196 				MOD_HDCP_STATUS_HDCP2_STREAM_READY_PENDING;
197 	}
198 out:
199 	return status;
200 }
201 
get_device_count(struct mod_hdcp * hdcp)202 static inline uint8_t get_device_count(struct mod_hdcp *hdcp)
203 {
204 	return HDCP_2_2_DEV_COUNT_LO(hdcp->auth.msg.hdcp2.rx_id_list[2]) +
205 			(HDCP_2_2_DEV_COUNT_HI(hdcp->auth.msg.hdcp2.rx_id_list[1]) << 4);
206 }
207 
check_device_count(struct mod_hdcp * hdcp)208 static enum mod_hdcp_status check_device_count(struct mod_hdcp *hdcp)
209 {
210 	/* Avoid device count == 0 to do authentication */
211 	if (0 == get_device_count(hdcp)) {
212 		return MOD_HDCP_STATUS_HDCP1_DEVICE_COUNT_MISMATCH_FAILURE;
213 	}
214 
215 	/* Some MST display may choose to report the internal panel as an HDCP RX.   */
216 	/* To update this condition with 1(because the immediate repeater's internal */
217 	/* panel is possibly not included in DEVICE_COUNT) + get_device_count(hdcp). */
218 	/* Device count must be greater than or equal to tracked hdcp displays.      */
219 	return ((1 + get_device_count(hdcp)) < get_active_display_count(hdcp)) ?
220 			MOD_HDCP_STATUS_HDCP2_DEVICE_COUNT_MISMATCH_FAILURE :
221 			MOD_HDCP_STATUS_SUCCESS;
222 }
223 
process_rxstatus(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input,enum mod_hdcp_status * status)224 static uint8_t process_rxstatus(struct mod_hdcp *hdcp,
225 		struct mod_hdcp_event_context *event_ctx,
226 		struct mod_hdcp_transition_input_hdcp2 *input,
227 		enum mod_hdcp_status *status)
228 {
229 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_rxstatus,
230 			&input->rxstatus_read, status,
231 			hdcp, "rxstatus_read"))
232 		goto out;
233 	if (!mod_hdcp_execute_and_set(check_reauthentication_request,
234 			&input->reauth_request_check, status,
235 			hdcp, "reauth_request_check"))
236 		goto out;
237 	if (is_dp_hdcp(hdcp)) {
238 		if (!mod_hdcp_execute_and_set(check_link_integrity_failure_dp,
239 				&input->link_integrity_check_dp, status,
240 				hdcp, "link_integrity_check_dp"))
241 			goto out;
242 	}
243 	if (hdcp->connection.is_repeater)
244 		if (check_receiver_id_list_ready(hdcp) ==
245 				MOD_HDCP_STATUS_SUCCESS) {
246 			HDCP_INPUT_PASS_TRACE(hdcp, "rx_id_list_ready");
247 			event_ctx->rx_id_list_ready = 1;
248 			if (is_dp_hdcp(hdcp))
249 				hdcp->auth.msg.hdcp2.rx_id_list_size =
250 						sizeof(hdcp->auth.msg.hdcp2.rx_id_list);
251 			else
252 				hdcp->auth.msg.hdcp2.rx_id_list_size =
253 					HDCP_2_2_HDMI_RXSTATUS_MSG_SZ_HI(hdcp->auth.msg.hdcp2.rxstatus[1]) << 8 |
254 					hdcp->auth.msg.hdcp2.rxstatus[0];
255 		}
256 out:
257 	return (*status == MOD_HDCP_STATUS_SUCCESS);
258 }
259 
known_hdcp2_capable_rx(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)260 static enum mod_hdcp_status known_hdcp2_capable_rx(struct mod_hdcp *hdcp,
261 		struct mod_hdcp_event_context *event_ctx,
262 		struct mod_hdcp_transition_input_hdcp2 *input)
263 {
264 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
265 
266 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
267 		event_ctx->unexpected_event = 1;
268 		goto out;
269 	}
270 
271 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_hdcp2version,
272 			&input->hdcp2version_read, &status,
273 			hdcp, "hdcp2version_read"))
274 		goto out;
275 	if (!mod_hdcp_execute_and_set(check_hdcp2_capable,
276 			&input->hdcp2_capable_check, &status,
277 			hdcp, "hdcp2_capable"))
278 		goto out;
279 out:
280 	return status;
281 }
282 
send_ake_init(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)283 static enum mod_hdcp_status send_ake_init(struct mod_hdcp *hdcp,
284 		struct mod_hdcp_event_context *event_ctx,
285 		struct mod_hdcp_transition_input_hdcp2 *input)
286 {
287 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
288 
289 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
290 		event_ctx->unexpected_event = 1;
291 		goto out;
292 	}
293 
294 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_create_session,
295 			&input->create_session, &status,
296 			hdcp, "create_session"))
297 		goto out;
298 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_ake_init,
299 			&input->ake_init_prepare, &status,
300 			hdcp, "ake_init_prepare"))
301 		goto out;
302 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_ake_init,
303 			&input->ake_init_write, &status,
304 			hdcp, "ake_init_write"))
305 		goto out;
306 out:
307 	return status;
308 }
309 
validate_ake_cert(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)310 static enum mod_hdcp_status validate_ake_cert(struct mod_hdcp *hdcp,
311 		struct mod_hdcp_event_context *event_ctx,
312 		struct mod_hdcp_transition_input_hdcp2 *input)
313 {
314 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
315 
316 
317 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
318 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
319 		event_ctx->unexpected_event = 1;
320 		goto out;
321 	}
322 
323 	if (is_hdmi_dvi_sl_hdcp(hdcp))
324 		if (!mod_hdcp_execute_and_set(check_ake_cert_available,
325 				&input->ake_cert_available, &status,
326 				hdcp, "ake_cert_available"))
327 			goto out;
328 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_ake_cert,
329 			&input->ake_cert_read, &status,
330 			hdcp, "ake_cert_read"))
331 		goto out;
332 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_ake_cert,
333 			&input->ake_cert_validation, &status,
334 			hdcp, "ake_cert_validation"))
335 		goto out;
336 out:
337 	return status;
338 }
339 
send_no_stored_km(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)340 static enum mod_hdcp_status send_no_stored_km(struct mod_hdcp *hdcp,
341 		struct mod_hdcp_event_context *event_ctx,
342 		struct mod_hdcp_transition_input_hdcp2 *input)
343 {
344 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
345 
346 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
347 		event_ctx->unexpected_event = 1;
348 		goto out;
349 	}
350 
351 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_no_stored_km,
352 			&input->no_stored_km_write, &status,
353 			hdcp, "no_stored_km_write"))
354 		goto out;
355 out:
356 	return status;
357 }
358 
read_h_prime(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)359 static enum mod_hdcp_status read_h_prime(struct mod_hdcp *hdcp,
360 		struct mod_hdcp_event_context *event_ctx,
361 		struct mod_hdcp_transition_input_hdcp2 *input)
362 {
363 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
364 
365 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
366 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
367 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
368 		event_ctx->unexpected_event = 1;
369 		goto out;
370 	}
371 
372 	if (!mod_hdcp_execute_and_set(check_h_prime_available,
373 			&input->h_prime_available, &status,
374 			hdcp, "h_prime_available"))
375 		goto out;
376 
377 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_h_prime,
378 			&input->h_prime_read, &status,
379 			hdcp, "h_prime_read"))
380 		goto out;
381 out:
382 	return status;
383 }
384 
read_pairing_info_and_validate_h_prime(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)385 static enum mod_hdcp_status read_pairing_info_and_validate_h_prime(
386 		struct mod_hdcp *hdcp,
387 		struct mod_hdcp_event_context *event_ctx,
388 		struct mod_hdcp_transition_input_hdcp2 *input)
389 {
390 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
391 
392 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
393 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
394 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
395 		event_ctx->unexpected_event = 1;
396 		goto out;
397 	}
398 
399 	if (!mod_hdcp_execute_and_set(check_pairing_info_available,
400 			&input->pairing_available, &status,
401 			hdcp, "pairing_available"))
402 		goto out;
403 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_pairing_info,
404 			&input->pairing_info_read, &status,
405 			hdcp, "pairing_info_read"))
406 		goto out;
407 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_h_prime,
408 			&input->h_prime_validation, &status,
409 			hdcp, "h_prime_validation"))
410 		goto out;
411 out:
412 	return status;
413 }
414 
send_stored_km(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)415 static enum mod_hdcp_status send_stored_km(struct mod_hdcp *hdcp,
416 		struct mod_hdcp_event_context *event_ctx,
417 		struct mod_hdcp_transition_input_hdcp2 *input)
418 {
419 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
420 
421 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
422 		event_ctx->unexpected_event = 1;
423 		goto out;
424 	}
425 
426 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_stored_km,
427 			&input->stored_km_write, &status,
428 			hdcp, "stored_km_write"))
429 		goto out;
430 out:
431 	return status;
432 }
433 
validate_h_prime(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)434 static enum mod_hdcp_status validate_h_prime(struct mod_hdcp *hdcp,
435 		struct mod_hdcp_event_context *event_ctx,
436 		struct mod_hdcp_transition_input_hdcp2 *input)
437 {
438 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
439 
440 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
441 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
442 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
443 		event_ctx->unexpected_event = 1;
444 		goto out;
445 	}
446 
447 	if (!mod_hdcp_execute_and_set(check_h_prime_available,
448 			&input->h_prime_available, &status,
449 			hdcp, "h_prime_available"))
450 		goto out;
451 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_h_prime,
452 			&input->h_prime_read, &status,
453 			hdcp, "h_prime_read"))
454 		goto out;
455 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_h_prime,
456 			&input->h_prime_validation, &status,
457 			hdcp, "h_prime_validation"))
458 		goto out;
459 out:
460 	return status;
461 }
462 
locality_check(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)463 static enum mod_hdcp_status locality_check(struct mod_hdcp *hdcp,
464 		struct mod_hdcp_event_context *event_ctx,
465 		struct mod_hdcp_transition_input_hdcp2 *input)
466 {
467 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
468 
469 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
470 		event_ctx->unexpected_event = 1;
471 		goto out;
472 	}
473 
474 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_lc_init,
475 			&input->lc_init_prepare, &status,
476 			hdcp, "lc_init_prepare"))
477 		goto out;
478 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_lc_init,
479 			&input->lc_init_write, &status,
480 			 hdcp, "lc_init_write"))
481 		goto out;
482 	if (is_dp_hdcp(hdcp))
483 		msleep(16);
484 	else
485 		if (!mod_hdcp_execute_and_set(poll_l_prime_available,
486 				&input->l_prime_available_poll, &status,
487 				hdcp, "l_prime_available_poll"))
488 			goto out;
489 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_l_prime,
490 			&input->l_prime_read, &status,
491 			hdcp, "l_prime_read"))
492 		goto out;
493 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_l_prime,
494 			&input->l_prime_validation, &status,
495 			hdcp, "l_prime_validation"))
496 		goto out;
497 out:
498 	return status;
499 }
500 
exchange_ks_and_test_for_repeater(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)501 static enum mod_hdcp_status exchange_ks_and_test_for_repeater(struct mod_hdcp *hdcp,
502 		struct mod_hdcp_event_context *event_ctx,
503 		struct mod_hdcp_transition_input_hdcp2 *input)
504 {
505 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
506 
507 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
508 		event_ctx->unexpected_event = 1;
509 		goto out;
510 	}
511 
512 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_eks,
513 			&input->eks_prepare, &status,
514 			hdcp, "eks_prepare"))
515 		goto out;
516 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_eks,
517 			&input->eks_write, &status,
518 			hdcp, "eks_write"))
519 		goto out;
520 out:
521 	return status;
522 }
523 
enable_encryption(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)524 static enum mod_hdcp_status enable_encryption(struct mod_hdcp *hdcp,
525 		struct mod_hdcp_event_context *event_ctx,
526 		struct mod_hdcp_transition_input_hdcp2 *input)
527 {
528 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
529 
530 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
531 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
532 		event_ctx->unexpected_event = 1;
533 		goto out;
534 	}
535 	if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
536 		process_rxstatus(hdcp, event_ctx, input, &status);
537 		goto out;
538 	}
539 
540 	if (is_hdmi_dvi_sl_hdcp(hdcp)) {
541 		if (!process_rxstatus(hdcp, event_ctx, input, &status))
542 			goto out;
543 		if (event_ctx->rx_id_list_ready)
544 			goto out;
545 	}
546 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_enable_encryption,
547 			&input->enable_encryption, &status,
548 			hdcp, "enable_encryption"))
549 		goto out;
550 	if (is_dp_mst_hdcp(hdcp)) {
551 		if (!mod_hdcp_execute_and_set(
552 				mod_hdcp_hdcp2_enable_dp_stream_encryption,
553 				&input->stream_encryption_dp, &status,
554 				hdcp, "stream_encryption_dp"))
555 			goto out;
556 	}
557 out:
558 	return status;
559 }
560 
authenticated(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)561 static enum mod_hdcp_status authenticated(struct mod_hdcp *hdcp,
562 		struct mod_hdcp_event_context *event_ctx,
563 		struct mod_hdcp_transition_input_hdcp2 *input)
564 {
565 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
566 
567 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
568 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
569 		event_ctx->unexpected_event = 1;
570 		goto out;
571 	}
572 
573 	process_rxstatus(hdcp, event_ctx, input, &status);
574 out:
575 	return status;
576 }
577 
wait_for_rx_id_list(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)578 static enum mod_hdcp_status wait_for_rx_id_list(struct mod_hdcp *hdcp,
579 		struct mod_hdcp_event_context *event_ctx,
580 		struct mod_hdcp_transition_input_hdcp2 *input)
581 {
582 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
583 
584 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
585 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
586 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
587 		event_ctx->unexpected_event = 1;
588 		goto out;
589 	}
590 
591 	if (!process_rxstatus(hdcp, event_ctx, input, &status))
592 		goto out;
593 	if (!event_ctx->rx_id_list_ready) {
594 		status = MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY;
595 		goto out;
596 	}
597 out:
598 	return status;
599 }
600 
verify_rx_id_list_and_send_ack(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)601 static enum mod_hdcp_status verify_rx_id_list_and_send_ack(struct mod_hdcp *hdcp,
602 		struct mod_hdcp_event_context *event_ctx,
603 		struct mod_hdcp_transition_input_hdcp2 *input)
604 {
605 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
606 
607 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
608 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
609 		event_ctx->unexpected_event = 1;
610 		goto out;
611 	}
612 	if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
613 		process_rxstatus(hdcp, event_ctx, input, &status);
614 		goto out;
615 	}
616 
617 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_rx_id_list,
618 			&input->rx_id_list_read,
619 			&status, hdcp, "receiver_id_list_read"))
620 		goto out;
621 	if (!mod_hdcp_execute_and_set(check_device_count,
622 			&input->device_count_check,
623 			&status, hdcp, "device_count_check"))
624 		goto out;
625 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_rx_id_list,
626 			&input->rx_id_list_validation,
627 			&status, hdcp, "rx_id_list_validation"))
628 		goto out;
629 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_repeater_auth_ack,
630 			&input->repeater_auth_ack_write,
631 			&status, hdcp, "repeater_auth_ack_write"))
632 		goto out;
633 out:
634 	return status;
635 }
636 
send_stream_management(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)637 static enum mod_hdcp_status send_stream_management(struct mod_hdcp *hdcp,
638 		struct mod_hdcp_event_context *event_ctx,
639 		struct mod_hdcp_transition_input_hdcp2 *input)
640 {
641 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
642 
643 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
644 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
645 		event_ctx->unexpected_event = 1;
646 		goto out;
647 	}
648 	if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
649 		process_rxstatus(hdcp, event_ctx, input, &status);
650 		goto out;
651 	}
652 
653 	if (is_hdmi_dvi_sl_hdcp(hdcp)) {
654 		if (!process_rxstatus(hdcp, event_ctx, input, &status))
655 			goto out;
656 		if (event_ctx->rx_id_list_ready)
657 			goto out;
658 	}
659 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_stream_management,
660 			&input->prepare_stream_manage,
661 			&status, hdcp, "prepare_stream_manage"))
662 		goto out;
663 
664 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_stream_manage,
665 			&input->stream_manage_write,
666 			&status, hdcp, "stream_manage_write"))
667 		goto out;
668 out:
669 	return status;
670 }
671 
validate_stream_ready(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)672 static enum mod_hdcp_status validate_stream_ready(struct mod_hdcp *hdcp,
673 		struct mod_hdcp_event_context *event_ctx,
674 		struct mod_hdcp_transition_input_hdcp2 *input)
675 {
676 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
677 
678 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
679 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ &&
680 			event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) {
681 		event_ctx->unexpected_event = 1;
682 		goto out;
683 	}
684 	if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) {
685 		process_rxstatus(hdcp, event_ctx, input, &status);
686 		goto out;
687 	}
688 
689 	if (is_hdmi_dvi_sl_hdcp(hdcp)) {
690 		if (!process_rxstatus(hdcp, event_ctx, input, &status))
691 			goto out;
692 		if (event_ctx->rx_id_list_ready) {
693 			goto out;
694 		}
695 	}
696 	if (is_hdmi_dvi_sl_hdcp(hdcp))
697 		if (!mod_hdcp_execute_and_set(check_stream_ready_available,
698 				&input->stream_ready_available,
699 				&status, hdcp, "stream_ready_available"))
700 			goto out;
701 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_stream_ready,
702 			&input->stream_ready_read,
703 			&status, hdcp, "stream_ready_read"))
704 		goto out;
705 	if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_stream_ready,
706 			&input->stream_ready_validation,
707 			&status, hdcp, "stream_ready_validation"))
708 		goto out;
709 
710 out:
711 	return status;
712 }
713 
determine_rx_hdcp_capable_dp(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)714 static enum mod_hdcp_status determine_rx_hdcp_capable_dp(struct mod_hdcp *hdcp,
715 		struct mod_hdcp_event_context *event_ctx,
716 		struct mod_hdcp_transition_input_hdcp2 *input)
717 {
718 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
719 
720 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) {
721 		event_ctx->unexpected_event = 1;
722 		goto out;
723 	}
724 
725 	if (!mod_hdcp_execute_and_set(mod_hdcp_read_rxcaps,
726 			&input->rx_caps_read_dp,
727 			&status, hdcp, "rx_caps_read_dp"))
728 		goto out;
729 	if (!mod_hdcp_execute_and_set(check_hdcp2_capable,
730 			&input->hdcp2_capable_check, &status,
731 			hdcp, "hdcp2_capable_check"))
732 		goto out;
733 out:
734 	return status;
735 }
736 
send_content_stream_type_dp(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)737 static enum mod_hdcp_status send_content_stream_type_dp(struct mod_hdcp *hdcp,
738 		struct mod_hdcp_event_context *event_ctx,
739 		struct mod_hdcp_transition_input_hdcp2 *input)
740 {
741 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
742 
743 	if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK &&
744 			event_ctx->event != MOD_HDCP_EVENT_CPIRQ) {
745 		event_ctx->unexpected_event = 1;
746 		goto out;
747 	}
748 
749 	if (!process_rxstatus(hdcp, event_ctx, input, &status))
750 		goto out;
751 	if (!mod_hdcp_execute_and_set(mod_hdcp_write_content_type,
752 			&input->content_stream_type_write, &status,
753 			hdcp, "content_stream_type_write"))
754 		goto out;
755 out:
756 	return status;
757 }
758 
mod_hdcp_hdcp2_execution(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)759 enum mod_hdcp_status mod_hdcp_hdcp2_execution(struct mod_hdcp *hdcp,
760 	struct mod_hdcp_event_context *event_ctx,
761 	struct mod_hdcp_transition_input_hdcp2 *input)
762 {
763 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
764 
765 	switch (current_state(hdcp)) {
766 	case H2_A0_KNOWN_HDCP2_CAPABLE_RX:
767 		status = known_hdcp2_capable_rx(hdcp, event_ctx, input);
768 		break;
769 	case H2_A1_SEND_AKE_INIT:
770 		status = send_ake_init(hdcp, event_ctx, input);
771 		break;
772 	case H2_A1_VALIDATE_AKE_CERT:
773 		status = validate_ake_cert(hdcp, event_ctx, input);
774 		break;
775 	case H2_A1_SEND_NO_STORED_KM:
776 		status = send_no_stored_km(hdcp, event_ctx, input);
777 		break;
778 	case H2_A1_READ_H_PRIME:
779 		status = read_h_prime(hdcp, event_ctx, input);
780 		break;
781 	case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
782 		status = read_pairing_info_and_validate_h_prime(hdcp,
783 				event_ctx, input);
784 		break;
785 	case H2_A1_SEND_STORED_KM:
786 		status = send_stored_km(hdcp, event_ctx, input);
787 		break;
788 	case H2_A1_VALIDATE_H_PRIME:
789 		status = validate_h_prime(hdcp, event_ctx, input);
790 		break;
791 	case H2_A2_LOCALITY_CHECK:
792 		status = locality_check(hdcp, event_ctx, input);
793 		break;
794 	case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
795 		status = exchange_ks_and_test_for_repeater(hdcp, event_ctx, input);
796 		break;
797 	case H2_ENABLE_ENCRYPTION:
798 		status = enable_encryption(hdcp, event_ctx, input);
799 		break;
800 	case H2_A5_AUTHENTICATED:
801 		status = authenticated(hdcp, event_ctx, input);
802 		break;
803 	case H2_A6_WAIT_FOR_RX_ID_LIST:
804 		status = wait_for_rx_id_list(hdcp, event_ctx, input);
805 		break;
806 	case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
807 		status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input);
808 		break;
809 	case H2_A9_SEND_STREAM_MANAGEMENT:
810 		status = send_stream_management(hdcp, event_ctx, input);
811 		break;
812 	case H2_A9_VALIDATE_STREAM_READY:
813 		status = validate_stream_ready(hdcp, event_ctx, input);
814 		break;
815 	default:
816 		status = MOD_HDCP_STATUS_INVALID_STATE;
817 		break;
818 	}
819 
820 	return status;
821 }
822 
mod_hdcp_hdcp2_dp_execution(struct mod_hdcp * hdcp,struct mod_hdcp_event_context * event_ctx,struct mod_hdcp_transition_input_hdcp2 * input)823 enum mod_hdcp_status mod_hdcp_hdcp2_dp_execution(struct mod_hdcp *hdcp,
824 	struct mod_hdcp_event_context *event_ctx,
825 	struct mod_hdcp_transition_input_hdcp2 *input)
826 {
827 	enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS;
828 
829 	switch (current_state(hdcp)) {
830 	case D2_A0_DETERMINE_RX_HDCP_CAPABLE:
831 		status = determine_rx_hdcp_capable_dp(hdcp, event_ctx, input);
832 		break;
833 	case D2_A1_SEND_AKE_INIT:
834 		status = send_ake_init(hdcp, event_ctx, input);
835 		break;
836 	case D2_A1_VALIDATE_AKE_CERT:
837 		status = validate_ake_cert(hdcp, event_ctx, input);
838 		break;
839 	case D2_A1_SEND_NO_STORED_KM:
840 		status = send_no_stored_km(hdcp, event_ctx, input);
841 		break;
842 	case D2_A1_READ_H_PRIME:
843 		status = read_h_prime(hdcp, event_ctx, input);
844 		break;
845 	case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME:
846 		status = read_pairing_info_and_validate_h_prime(hdcp,
847 				event_ctx, input);
848 		break;
849 	case D2_A1_SEND_STORED_KM:
850 		status = send_stored_km(hdcp, event_ctx, input);
851 		break;
852 	case D2_A1_VALIDATE_H_PRIME:
853 		status = validate_h_prime(hdcp, event_ctx, input);
854 		break;
855 	case D2_A2_LOCALITY_CHECK:
856 		status = locality_check(hdcp, event_ctx, input);
857 		break;
858 	case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER:
859 		status = exchange_ks_and_test_for_repeater(hdcp,
860 				event_ctx, input);
861 		break;
862 	case D2_SEND_CONTENT_STREAM_TYPE:
863 		status = send_content_stream_type_dp(hdcp, event_ctx, input);
864 		break;
865 	case D2_ENABLE_ENCRYPTION:
866 		status = enable_encryption(hdcp, event_ctx, input);
867 		break;
868 	case D2_A5_AUTHENTICATED:
869 		status = authenticated(hdcp, event_ctx, input);
870 		break;
871 	case D2_A6_WAIT_FOR_RX_ID_LIST:
872 		status = wait_for_rx_id_list(hdcp, event_ctx, input);
873 		break;
874 	case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK:
875 		status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input);
876 		break;
877 	case D2_A9_SEND_STREAM_MANAGEMENT:
878 		status = send_stream_management(hdcp, event_ctx, input);
879 		break;
880 	case D2_A9_VALIDATE_STREAM_READY:
881 		status = validate_stream_ready(hdcp, event_ctx, input);
882 		break;
883 	default:
884 		status = MOD_HDCP_STATUS_INVALID_STATE;
885 		break;
886 	}
887 
888 	return status;
889 }
890