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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 575 if (status != MOD_HDCP_STATUS_SUCCESS) 576 mod_hdcp_save_current_encryption_states(hdcp); 577 out: 578 return status; 579 } 580 581 static enum mod_hdcp_status wait_for_rx_id_list(struct mod_hdcp *hdcp, 582 struct mod_hdcp_event_context *event_ctx, 583 struct mod_hdcp_transition_input_hdcp2 *input) 584 { 585 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 586 587 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 588 event_ctx->event != MOD_HDCP_EVENT_CPIRQ && 589 event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) { 590 event_ctx->unexpected_event = 1; 591 goto out; 592 } 593 594 if (!process_rxstatus(hdcp, event_ctx, input, &status)) 595 goto out; 596 if (!event_ctx->rx_id_list_ready) { 597 status = MOD_HDCP_STATUS_HDCP2_RX_ID_LIST_NOT_READY; 598 goto out; 599 } 600 out: 601 return status; 602 } 603 604 static enum mod_hdcp_status verify_rx_id_list_and_send_ack(struct mod_hdcp *hdcp, 605 struct mod_hdcp_event_context *event_ctx, 606 struct mod_hdcp_transition_input_hdcp2 *input) 607 { 608 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 609 610 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 611 event_ctx->event != MOD_HDCP_EVENT_CPIRQ) { 612 event_ctx->unexpected_event = 1; 613 goto out; 614 } 615 if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) { 616 process_rxstatus(hdcp, event_ctx, input, &status); 617 goto out; 618 } 619 620 if (!mod_hdcp_execute_and_set(mod_hdcp_read_rx_id_list, 621 &input->rx_id_list_read, 622 &status, hdcp, "receiver_id_list_read")) 623 goto out; 624 if (!mod_hdcp_execute_and_set(check_device_count, 625 &input->device_count_check, 626 &status, hdcp, "device_count_check")) 627 goto out; 628 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_rx_id_list, 629 &input->rx_id_list_validation, 630 &status, hdcp, "rx_id_list_validation")) 631 goto out; 632 if (!mod_hdcp_execute_and_set(mod_hdcp_write_repeater_auth_ack, 633 &input->repeater_auth_ack_write, 634 &status, hdcp, "repeater_auth_ack_write")) 635 goto out; 636 out: 637 return status; 638 } 639 640 static enum mod_hdcp_status send_stream_management(struct mod_hdcp *hdcp, 641 struct mod_hdcp_event_context *event_ctx, 642 struct mod_hdcp_transition_input_hdcp2 *input) 643 { 644 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 645 646 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 647 event_ctx->event != MOD_HDCP_EVENT_CPIRQ) { 648 event_ctx->unexpected_event = 1; 649 goto out; 650 } 651 if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) { 652 process_rxstatus(hdcp, event_ctx, input, &status); 653 goto out; 654 } 655 656 if (is_hdmi_dvi_sl_hdcp(hdcp)) { 657 if (!process_rxstatus(hdcp, event_ctx, input, &status)) 658 goto out; 659 if (event_ctx->rx_id_list_ready) 660 goto out; 661 } 662 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_prepare_stream_management, 663 &input->prepare_stream_manage, 664 &status, hdcp, "prepare_stream_manage")) 665 goto out; 666 667 if (!mod_hdcp_execute_and_set(mod_hdcp_write_stream_manage, 668 &input->stream_manage_write, 669 &status, hdcp, "stream_manage_write")) 670 goto out; 671 out: 672 return status; 673 } 674 675 static enum mod_hdcp_status validate_stream_ready(struct mod_hdcp *hdcp, 676 struct mod_hdcp_event_context *event_ctx, 677 struct mod_hdcp_transition_input_hdcp2 *input) 678 { 679 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 680 681 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 682 event_ctx->event != MOD_HDCP_EVENT_CPIRQ && 683 event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) { 684 event_ctx->unexpected_event = 1; 685 goto out; 686 } 687 if (event_ctx->event == MOD_HDCP_EVENT_CPIRQ) { 688 process_rxstatus(hdcp, event_ctx, input, &status); 689 goto out; 690 } 691 692 if (is_hdmi_dvi_sl_hdcp(hdcp)) { 693 if (!process_rxstatus(hdcp, event_ctx, input, &status)) 694 goto out; 695 if (event_ctx->rx_id_list_ready) { 696 goto out; 697 } 698 } 699 if (is_hdmi_dvi_sl_hdcp(hdcp)) 700 if (!mod_hdcp_execute_and_set(check_stream_ready_available, 701 &input->stream_ready_available, 702 &status, hdcp, "stream_ready_available")) 703 goto out; 704 if (!mod_hdcp_execute_and_set(mod_hdcp_read_stream_ready, 705 &input->stream_ready_read, 706 &status, hdcp, "stream_ready_read")) 707 goto out; 708 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp2_validate_stream_ready, 709 &input->stream_ready_validation, 710 &status, hdcp, "stream_ready_validation")) 711 goto out; 712 713 out: 714 return status; 715 } 716 717 static enum mod_hdcp_status determine_rx_hdcp_capable_dp(struct mod_hdcp *hdcp, 718 struct mod_hdcp_event_context *event_ctx, 719 struct mod_hdcp_transition_input_hdcp2 *input) 720 { 721 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 722 723 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 724 event_ctx->unexpected_event = 1; 725 goto out; 726 } 727 728 if (!mod_hdcp_execute_and_set(mod_hdcp_read_rxcaps, 729 &input->rx_caps_read_dp, 730 &status, hdcp, "rx_caps_read_dp")) 731 goto out; 732 if (!mod_hdcp_execute_and_set(check_hdcp2_capable, 733 &input->hdcp2_capable_check, &status, 734 hdcp, "hdcp2_capable_check")) 735 goto out; 736 out: 737 return status; 738 } 739 740 static enum mod_hdcp_status send_content_stream_type_dp(struct mod_hdcp *hdcp, 741 struct mod_hdcp_event_context *event_ctx, 742 struct mod_hdcp_transition_input_hdcp2 *input) 743 { 744 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 745 746 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 747 event_ctx->event != MOD_HDCP_EVENT_CPIRQ) { 748 event_ctx->unexpected_event = 1; 749 goto out; 750 } 751 752 if (!process_rxstatus(hdcp, event_ctx, input, &status)) 753 goto out; 754 if (!mod_hdcp_execute_and_set(mod_hdcp_write_content_type, 755 &input->content_stream_type_write, &status, 756 hdcp, "content_stream_type_write")) 757 goto out; 758 out: 759 return status; 760 } 761 762 enum mod_hdcp_status mod_hdcp_hdcp2_execution(struct mod_hdcp *hdcp, 763 struct mod_hdcp_event_context *event_ctx, 764 struct mod_hdcp_transition_input_hdcp2 *input) 765 { 766 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 767 768 switch (current_state(hdcp)) { 769 case H2_A0_KNOWN_HDCP2_CAPABLE_RX: 770 status = known_hdcp2_capable_rx(hdcp, event_ctx, input); 771 break; 772 case H2_A1_SEND_AKE_INIT: 773 status = send_ake_init(hdcp, event_ctx, input); 774 break; 775 case H2_A1_VALIDATE_AKE_CERT: 776 status = validate_ake_cert(hdcp, event_ctx, input); 777 break; 778 case H2_A1_SEND_NO_STORED_KM: 779 status = send_no_stored_km(hdcp, event_ctx, input); 780 break; 781 case H2_A1_READ_H_PRIME: 782 status = read_h_prime(hdcp, event_ctx, input); 783 break; 784 case H2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 785 status = read_pairing_info_and_validate_h_prime(hdcp, 786 event_ctx, input); 787 break; 788 case H2_A1_SEND_STORED_KM: 789 status = send_stored_km(hdcp, event_ctx, input); 790 break; 791 case H2_A1_VALIDATE_H_PRIME: 792 status = validate_h_prime(hdcp, event_ctx, input); 793 break; 794 case H2_A2_LOCALITY_CHECK: 795 status = locality_check(hdcp, event_ctx, input); 796 break; 797 case H2_A3_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 798 status = exchange_ks_and_test_for_repeater(hdcp, event_ctx, input); 799 break; 800 case H2_ENABLE_ENCRYPTION: 801 status = enable_encryption(hdcp, event_ctx, input); 802 break; 803 case H2_A5_AUTHENTICATED: 804 status = authenticated(hdcp, event_ctx, input); 805 break; 806 case H2_A6_WAIT_FOR_RX_ID_LIST: 807 status = wait_for_rx_id_list(hdcp, event_ctx, input); 808 break; 809 case H2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 810 status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input); 811 break; 812 case H2_A9_SEND_STREAM_MANAGEMENT: 813 status = send_stream_management(hdcp, event_ctx, input); 814 break; 815 case H2_A9_VALIDATE_STREAM_READY: 816 status = validate_stream_ready(hdcp, event_ctx, input); 817 break; 818 default: 819 status = MOD_HDCP_STATUS_INVALID_STATE; 820 break; 821 } 822 823 return status; 824 } 825 826 enum mod_hdcp_status mod_hdcp_hdcp2_dp_execution(struct mod_hdcp *hdcp, 827 struct mod_hdcp_event_context *event_ctx, 828 struct mod_hdcp_transition_input_hdcp2 *input) 829 { 830 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 831 832 switch (current_state(hdcp)) { 833 case D2_A0_DETERMINE_RX_HDCP_CAPABLE: 834 status = determine_rx_hdcp_capable_dp(hdcp, event_ctx, input); 835 break; 836 case D2_A1_SEND_AKE_INIT: 837 status = send_ake_init(hdcp, event_ctx, input); 838 break; 839 case D2_A1_VALIDATE_AKE_CERT: 840 status = validate_ake_cert(hdcp, event_ctx, input); 841 break; 842 case D2_A1_SEND_NO_STORED_KM: 843 status = send_no_stored_km(hdcp, event_ctx, input); 844 break; 845 case D2_A1_READ_H_PRIME: 846 status = read_h_prime(hdcp, event_ctx, input); 847 break; 848 case D2_A1_READ_PAIRING_INFO_AND_VALIDATE_H_PRIME: 849 status = read_pairing_info_and_validate_h_prime(hdcp, 850 event_ctx, input); 851 break; 852 case D2_A1_SEND_STORED_KM: 853 status = send_stored_km(hdcp, event_ctx, input); 854 break; 855 case D2_A1_VALIDATE_H_PRIME: 856 status = validate_h_prime(hdcp, event_ctx, input); 857 break; 858 case D2_A2_LOCALITY_CHECK: 859 status = locality_check(hdcp, event_ctx, input); 860 break; 861 case D2_A34_EXCHANGE_KS_AND_TEST_FOR_REPEATER: 862 status = exchange_ks_and_test_for_repeater(hdcp, 863 event_ctx, input); 864 break; 865 case D2_SEND_CONTENT_STREAM_TYPE: 866 status = send_content_stream_type_dp(hdcp, event_ctx, input); 867 break; 868 case D2_ENABLE_ENCRYPTION: 869 status = enable_encryption(hdcp, event_ctx, input); 870 break; 871 case D2_A5_AUTHENTICATED: 872 status = authenticated(hdcp, event_ctx, input); 873 break; 874 case D2_A6_WAIT_FOR_RX_ID_LIST: 875 status = wait_for_rx_id_list(hdcp, event_ctx, input); 876 break; 877 case D2_A78_VERIFY_RX_ID_LIST_AND_SEND_ACK: 878 status = verify_rx_id_list_and_send_ack(hdcp, event_ctx, input); 879 break; 880 case D2_A9_SEND_STREAM_MANAGEMENT: 881 status = send_stream_management(hdcp, event_ctx, input); 882 break; 883 case D2_A9_VALIDATE_STREAM_READY: 884 status = validate_stream_ready(hdcp, event_ctx, input); 885 break; 886 default: 887 status = MOD_HDCP_STATUS_INVALID_STATE; 888 break; 889 } 890 891 return status; 892 } 893