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 #include "hdcp.h" 27 28 static inline enum mod_hdcp_status validate_bksv(struct mod_hdcp *hdcp) 29 { 30 uint64_t n = 0; 31 uint8_t count = 0; 32 33 memcpy(&n, hdcp->auth.msg.hdcp1.bksv, sizeof(uint64_t)); 34 35 while (n) { 36 count++; 37 n &= (n - 1); 38 } 39 return (count == 20) ? MOD_HDCP_STATUS_SUCCESS : 40 MOD_HDCP_STATUS_HDCP1_INVALID_BKSV; 41 } 42 43 static inline enum mod_hdcp_status check_ksv_ready(struct mod_hdcp *hdcp) 44 { 45 if (is_dp_hdcp(hdcp)) 46 return (hdcp->auth.msg.hdcp1.bstatus & DP_BSTATUS_READY) ? 47 MOD_HDCP_STATUS_SUCCESS : 48 MOD_HDCP_STATUS_HDCP1_KSV_LIST_NOT_READY; 49 return (hdcp->auth.msg.hdcp1.bcaps & DRM_HDCP_DDC_BCAPS_KSV_FIFO_READY) ? 50 MOD_HDCP_STATUS_SUCCESS : 51 MOD_HDCP_STATUS_HDCP1_KSV_LIST_NOT_READY; 52 } 53 54 static inline enum mod_hdcp_status check_hdcp_capable_dp(struct mod_hdcp *hdcp) 55 { 56 return (hdcp->auth.msg.hdcp1.bcaps & DP_BCAPS_HDCP_CAPABLE) ? 57 MOD_HDCP_STATUS_SUCCESS : 58 MOD_HDCP_STATUS_HDCP1_NOT_CAPABLE; 59 } 60 61 static inline enum mod_hdcp_status check_r0p_available_dp(struct mod_hdcp *hdcp) 62 { 63 enum mod_hdcp_status status; 64 if (is_dp_hdcp(hdcp)) { 65 status = (hdcp->auth.msg.hdcp1.bstatus & 66 DP_BSTATUS_R0_PRIME_READY) ? 67 MOD_HDCP_STATUS_SUCCESS : 68 MOD_HDCP_STATUS_HDCP1_R0_PRIME_PENDING; 69 } else { 70 status = MOD_HDCP_STATUS_INVALID_OPERATION; 71 } 72 return status; 73 } 74 75 static inline enum mod_hdcp_status check_link_integrity_dp( 76 struct mod_hdcp *hdcp) 77 { 78 return (hdcp->auth.msg.hdcp1.bstatus & 79 DP_BSTATUS_LINK_FAILURE) ? 80 MOD_HDCP_STATUS_HDCP1_LINK_INTEGRITY_FAILURE : 81 MOD_HDCP_STATUS_SUCCESS; 82 } 83 84 static inline enum mod_hdcp_status check_no_reauthentication_request_dp( 85 struct mod_hdcp *hdcp) 86 { 87 return (hdcp->auth.msg.hdcp1.bstatus & DP_BSTATUS_REAUTH_REQ) ? 88 MOD_HDCP_STATUS_HDCP1_REAUTH_REQUEST_ISSUED : 89 MOD_HDCP_STATUS_SUCCESS; 90 } 91 92 static inline enum mod_hdcp_status check_no_max_cascade(struct mod_hdcp *hdcp) 93 { 94 enum mod_hdcp_status status; 95 96 if (is_dp_hdcp(hdcp)) 97 status = DRM_HDCP_MAX_CASCADE_EXCEEDED(hdcp->auth.msg.hdcp1.binfo_dp >> 8) 98 ? MOD_HDCP_STATUS_HDCP1_MAX_CASCADE_EXCEEDED_FAILURE 99 : MOD_HDCP_STATUS_SUCCESS; 100 else 101 status = DRM_HDCP_MAX_CASCADE_EXCEEDED(hdcp->auth.msg.hdcp1.bstatus >> 8) 102 ? MOD_HDCP_STATUS_HDCP1_MAX_CASCADE_EXCEEDED_FAILURE 103 : MOD_HDCP_STATUS_SUCCESS; 104 return status; 105 } 106 107 static inline enum mod_hdcp_status check_no_max_devs(struct mod_hdcp *hdcp) 108 { 109 enum mod_hdcp_status status; 110 111 if (is_dp_hdcp(hdcp)) 112 status = DRM_HDCP_MAX_DEVICE_EXCEEDED(hdcp->auth.msg.hdcp1.binfo_dp) ? 113 MOD_HDCP_STATUS_HDCP1_MAX_DEVS_EXCEEDED_FAILURE : 114 MOD_HDCP_STATUS_SUCCESS; 115 else 116 status = DRM_HDCP_MAX_DEVICE_EXCEEDED(hdcp->auth.msg.hdcp1.bstatus) ? 117 MOD_HDCP_STATUS_HDCP1_MAX_DEVS_EXCEEDED_FAILURE : 118 MOD_HDCP_STATUS_SUCCESS; 119 return status; 120 } 121 122 static inline uint8_t get_device_count(struct mod_hdcp *hdcp) 123 { 124 return is_dp_hdcp(hdcp) ? 125 DRM_HDCP_NUM_DOWNSTREAM(hdcp->auth.msg.hdcp1.binfo_dp) : 126 DRM_HDCP_NUM_DOWNSTREAM(hdcp->auth.msg.hdcp1.bstatus); 127 } 128 129 static inline enum mod_hdcp_status check_device_count(struct mod_hdcp *hdcp) 130 { 131 /* device count must be greater than or equal to tracked hdcp displays */ 132 return (get_device_count(hdcp) < get_added_display_count(hdcp)) ? 133 MOD_HDCP_STATUS_HDCP1_DEVICE_COUNT_MISMATCH_FAILURE : 134 MOD_HDCP_STATUS_SUCCESS; 135 } 136 137 static enum mod_hdcp_status wait_for_active_rx(struct mod_hdcp *hdcp, 138 struct mod_hdcp_event_context *event_ctx, 139 struct mod_hdcp_transition_input_hdcp1 *input) 140 { 141 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 142 143 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 144 event_ctx->unexpected_event = 1; 145 goto out; 146 } 147 148 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bksv, 149 &input->bksv_read, &status, 150 hdcp, "bksv_read")) 151 goto out; 152 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bcaps, 153 &input->bcaps_read, &status, 154 hdcp, "bcaps_read")) 155 goto out; 156 out: 157 return status; 158 } 159 160 static enum mod_hdcp_status exchange_ksvs(struct mod_hdcp *hdcp, 161 struct mod_hdcp_event_context *event_ctx, 162 struct mod_hdcp_transition_input_hdcp1 *input) 163 { 164 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 165 166 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 167 event_ctx->unexpected_event = 1; 168 goto out; 169 } 170 171 if (!mod_hdcp_execute_and_set(mod_hdcp_add_display_topology, 172 &input->add_topology, &status, 173 hdcp, "add_topology")) 174 goto out; 175 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_create_session, 176 &input->create_session, &status, 177 hdcp, "create_session")) 178 goto out; 179 if (!mod_hdcp_execute_and_set(mod_hdcp_write_an, 180 &input->an_write, &status, 181 hdcp, "an_write")) 182 goto out; 183 if (!mod_hdcp_execute_and_set(mod_hdcp_write_aksv, 184 &input->aksv_write, &status, 185 hdcp, "aksv_write")) 186 goto out; 187 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bksv, 188 &input->bksv_read, &status, 189 hdcp, "bksv_read")) 190 goto out; 191 if (!mod_hdcp_execute_and_set(validate_bksv, 192 &input->bksv_validation, &status, 193 hdcp, "bksv_validation")) 194 goto out; 195 if (hdcp->auth.msg.hdcp1.ainfo) { 196 if (!mod_hdcp_execute_and_set(mod_hdcp_write_ainfo, 197 &input->ainfo_write, &status, 198 hdcp, "ainfo_write")) 199 goto out; 200 } 201 out: 202 return status; 203 } 204 205 static enum mod_hdcp_status computations_validate_rx_test_for_repeater( 206 struct mod_hdcp *hdcp, 207 struct mod_hdcp_event_context *event_ctx, 208 struct mod_hdcp_transition_input_hdcp1 *input) 209 { 210 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 211 212 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 213 event_ctx->unexpected_event = 1; 214 goto out; 215 } 216 217 if (!mod_hdcp_execute_and_set(mod_hdcp_read_r0p, 218 &input->r0p_read, &status, 219 hdcp, "r0p_read")) 220 goto out; 221 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_validate_rx, 222 &input->rx_validation, &status, 223 hdcp, "rx_validation")) 224 goto out; 225 if (hdcp->connection.is_repeater) { 226 if (!hdcp->connection.link.adjust.hdcp1.postpone_encryption) 227 if (!mod_hdcp_execute_and_set( 228 mod_hdcp_hdcp1_enable_encryption, 229 &input->encryption, &status, 230 hdcp, "encryption")) 231 goto out; 232 } else { 233 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_enable_encryption, 234 &input->encryption, &status, 235 hdcp, "encryption")) 236 goto out; 237 if (is_dp_mst_hdcp(hdcp)) 238 if (!mod_hdcp_execute_and_set( 239 mod_hdcp_hdcp1_enable_dp_stream_encryption, 240 &input->stream_encryption_dp, &status, 241 hdcp, "stream_encryption_dp")) 242 goto out; 243 } 244 out: 245 return status; 246 } 247 248 static enum mod_hdcp_status authenticated(struct mod_hdcp *hdcp, 249 struct mod_hdcp_event_context *event_ctx, 250 struct mod_hdcp_transition_input_hdcp1 *input) 251 { 252 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 253 254 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 255 event_ctx->unexpected_event = 1; 256 goto out; 257 } 258 259 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_link_maintenance, 260 &input->link_maintenance, &status, 261 hdcp, "link_maintenance")) 262 goto out; 263 out: 264 return status; 265 } 266 267 static enum mod_hdcp_status wait_for_ready(struct mod_hdcp *hdcp, 268 struct mod_hdcp_event_context *event_ctx, 269 struct mod_hdcp_transition_input_hdcp1 *input) 270 { 271 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 272 273 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK && 274 event_ctx->event != MOD_HDCP_EVENT_CPIRQ && 275 event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) { 276 event_ctx->unexpected_event = 1; 277 goto out; 278 } 279 280 if (is_dp_hdcp(hdcp)) { 281 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bstatus, 282 &input->bstatus_read, &status, 283 hdcp, "bstatus_read")) 284 goto out; 285 if (!mod_hdcp_execute_and_set(check_link_integrity_dp, 286 &input->link_integiry_check, &status, 287 hdcp, "link_integiry_check")) 288 goto out; 289 if (!mod_hdcp_execute_and_set(check_no_reauthentication_request_dp, 290 &input->reauth_request_check, &status, 291 hdcp, "reauth_request_check")) 292 goto out; 293 } else { 294 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bcaps, 295 &input->bcaps_read, &status, 296 hdcp, "bcaps_read")) 297 goto out; 298 } 299 if (!mod_hdcp_execute_and_set(check_ksv_ready, 300 &input->ready_check, &status, 301 hdcp, "ready_check")) 302 goto out; 303 out: 304 return status; 305 } 306 307 static enum mod_hdcp_status read_ksv_list(struct mod_hdcp *hdcp, 308 struct mod_hdcp_event_context *event_ctx, 309 struct mod_hdcp_transition_input_hdcp1 *input) 310 { 311 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 312 uint8_t device_count; 313 314 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 315 event_ctx->unexpected_event = 1; 316 goto out; 317 } 318 319 if (is_dp_hdcp(hdcp)) { 320 if (!mod_hdcp_execute_and_set(mod_hdcp_read_binfo, 321 &input->binfo_read_dp, &status, 322 hdcp, "binfo_read_dp")) 323 goto out; 324 } else { 325 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bstatus, 326 &input->bstatus_read, &status, 327 hdcp, "bstatus_read")) 328 goto out; 329 } 330 if (!mod_hdcp_execute_and_set(check_no_max_cascade, 331 &input->max_cascade_check, &status, 332 hdcp, "max_cascade_check")) 333 goto out; 334 if (!mod_hdcp_execute_and_set(check_no_max_devs, 335 &input->max_devs_check, &status, 336 hdcp, "max_devs_check")) 337 goto out; 338 if (!mod_hdcp_execute_and_set(check_device_count, 339 &input->device_count_check, &status, 340 hdcp, "device_count_check")) 341 goto out; 342 device_count = get_device_count(hdcp); 343 hdcp->auth.msg.hdcp1.ksvlist_size = device_count*5; 344 if (!mod_hdcp_execute_and_set(mod_hdcp_read_ksvlist, 345 &input->ksvlist_read, &status, 346 hdcp, "ksvlist_read")) 347 goto out; 348 if (!mod_hdcp_execute_and_set(mod_hdcp_read_vp, 349 &input->vp_read, &status, 350 hdcp, "vp_read")) 351 goto out; 352 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_validate_ksvlist_vp, 353 &input->ksvlist_vp_validation, &status, 354 hdcp, "ksvlist_vp_validation")) 355 goto out; 356 if (input->encryption != PASS) 357 if (!mod_hdcp_execute_and_set(mod_hdcp_hdcp1_enable_encryption, 358 &input->encryption, &status, 359 hdcp, "encryption")) 360 goto out; 361 if (is_dp_mst_hdcp(hdcp)) 362 if (!mod_hdcp_execute_and_set( 363 mod_hdcp_hdcp1_enable_dp_stream_encryption, 364 &input->stream_encryption_dp, &status, 365 hdcp, "stream_encryption_dp")) 366 goto out; 367 out: 368 return status; 369 } 370 371 static enum mod_hdcp_status determine_rx_hdcp_capable_dp(struct mod_hdcp *hdcp, 372 struct mod_hdcp_event_context *event_ctx, 373 struct mod_hdcp_transition_input_hdcp1 *input) 374 { 375 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 376 377 if (event_ctx->event != MOD_HDCP_EVENT_CALLBACK) { 378 event_ctx->unexpected_event = 1; 379 goto out; 380 } 381 382 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bcaps, 383 &input->bcaps_read, &status, 384 hdcp, "bcaps_read")) 385 goto out; 386 if (!mod_hdcp_execute_and_set(check_hdcp_capable_dp, 387 &input->hdcp_capable_dp, &status, 388 hdcp, "hdcp_capable_dp")) 389 goto out; 390 out: 391 return status; 392 } 393 394 static enum mod_hdcp_status wait_for_r0_prime_dp(struct mod_hdcp *hdcp, 395 struct mod_hdcp_event_context *event_ctx, 396 struct mod_hdcp_transition_input_hdcp1 *input) 397 { 398 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 399 400 if (event_ctx->event != MOD_HDCP_EVENT_CPIRQ && 401 event_ctx->event != MOD_HDCP_EVENT_WATCHDOG_TIMEOUT) { 402 event_ctx->unexpected_event = 1; 403 goto out; 404 } 405 406 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bstatus, 407 &input->bstatus_read, &status, 408 hdcp, "bstatus_read")) 409 goto out; 410 if (!mod_hdcp_execute_and_set(check_r0p_available_dp, 411 &input->r0p_available_dp, &status, 412 hdcp, "r0p_available_dp")) 413 goto out; 414 out: 415 return status; 416 } 417 418 static enum mod_hdcp_status authenticated_dp(struct mod_hdcp *hdcp, 419 struct mod_hdcp_event_context *event_ctx, 420 struct mod_hdcp_transition_input_hdcp1 *input) 421 { 422 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 423 424 if (event_ctx->event != MOD_HDCP_EVENT_CPIRQ) { 425 event_ctx->unexpected_event = 1; 426 goto out; 427 } 428 429 if (!mod_hdcp_execute_and_set(mod_hdcp_read_bstatus, 430 &input->bstatus_read, &status, 431 hdcp, "bstatus_read")) 432 goto out; 433 if (!mod_hdcp_execute_and_set(check_link_integrity_dp, 434 &input->link_integiry_check, &status, 435 hdcp, "link_integiry_check")) 436 goto out; 437 if (!mod_hdcp_execute_and_set(check_no_reauthentication_request_dp, 438 &input->reauth_request_check, &status, 439 hdcp, "reauth_request_check")) 440 goto out; 441 out: 442 return status; 443 } 444 445 uint8_t mod_hdcp_execute_and_set( 446 mod_hdcp_action func, uint8_t *flag, 447 enum mod_hdcp_status *status, struct mod_hdcp *hdcp, char *str) 448 { 449 *status = func(hdcp); 450 if (*status == MOD_HDCP_STATUS_SUCCESS && *flag != PASS) { 451 HDCP_INPUT_PASS_TRACE(hdcp, str); 452 *flag = PASS; 453 } else if (*status != MOD_HDCP_STATUS_SUCCESS && *flag != FAIL) { 454 HDCP_INPUT_FAIL_TRACE(hdcp, str); 455 *flag = FAIL; 456 } 457 return (*status == MOD_HDCP_STATUS_SUCCESS); 458 } 459 460 enum mod_hdcp_status mod_hdcp_hdcp1_execution(struct mod_hdcp *hdcp, 461 struct mod_hdcp_event_context *event_ctx, 462 struct mod_hdcp_transition_input_hdcp1 *input) 463 { 464 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 465 466 switch (current_state(hdcp)) { 467 case H1_A0_WAIT_FOR_ACTIVE_RX: 468 status = wait_for_active_rx(hdcp, event_ctx, input); 469 break; 470 case H1_A1_EXCHANGE_KSVS: 471 status = exchange_ksvs(hdcp, event_ctx, input); 472 break; 473 case H1_A2_COMPUTATIONS_A3_VALIDATE_RX_A6_TEST_FOR_REPEATER: 474 status = computations_validate_rx_test_for_repeater(hdcp, 475 event_ctx, input); 476 break; 477 case H1_A45_AUTHENTICATED: 478 status = authenticated(hdcp, event_ctx, input); 479 break; 480 case H1_A8_WAIT_FOR_READY: 481 status = wait_for_ready(hdcp, event_ctx, input); 482 break; 483 case H1_A9_READ_KSV_LIST: 484 status = read_ksv_list(hdcp, event_ctx, input); 485 break; 486 default: 487 status = MOD_HDCP_STATUS_INVALID_STATE; 488 break; 489 } 490 491 return status; 492 } 493 494 extern enum mod_hdcp_status mod_hdcp_hdcp1_dp_execution(struct mod_hdcp *hdcp, 495 struct mod_hdcp_event_context *event_ctx, 496 struct mod_hdcp_transition_input_hdcp1 *input) 497 { 498 enum mod_hdcp_status status = MOD_HDCP_STATUS_SUCCESS; 499 500 switch (current_state(hdcp)) { 501 case D1_A0_DETERMINE_RX_HDCP_CAPABLE: 502 status = determine_rx_hdcp_capable_dp(hdcp, event_ctx, input); 503 break; 504 case D1_A1_EXCHANGE_KSVS: 505 status = exchange_ksvs(hdcp, event_ctx, input); 506 break; 507 case D1_A23_WAIT_FOR_R0_PRIME: 508 status = wait_for_r0_prime_dp(hdcp, event_ctx, input); 509 break; 510 case D1_A2_COMPUTATIONS_A3_VALIDATE_RX_A5_TEST_FOR_REPEATER: 511 status = computations_validate_rx_test_for_repeater( 512 hdcp, event_ctx, input); 513 break; 514 case D1_A4_AUTHENTICATED: 515 status = authenticated_dp(hdcp, event_ctx, input); 516 break; 517 case D1_A6_WAIT_FOR_READY: 518 status = wait_for_ready(hdcp, event_ctx, input); 519 break; 520 case D1_A7_READ_KSV_LIST: 521 status = read_ksv_list(hdcp, event_ctx, input); 522 break; 523 default: 524 status = MOD_HDCP_STATUS_INVALID_STATE; 525 break; 526 } 527 528 return status; 529 } 530