plat/rockchip/rk3399/drivers/dp/cdn_dp.c

   1 /*
   2  * Copyright (c) 2017-2018, ARM Limited and Contributors. All rights reserved.
   3  *
   4  * SPDX-License-Identifier: BSD-3-Clause
   5  */
   6
   7 #include <assert.h>
   8 #include <cdefs.h>
   9 #include <stdlib.h>
  10 #include <string.h>
  11
  12 #include <lib/smccc.h>
  13
  14 #include <cdn_dp.h>
  15
  16 __asm__(
  17         ".pushsection .text.hdcp_handler, \"ax\", %progbits\n"
  18         ".global hdcp_handler\n"
  19         ".balign 4\n"
  20         "hdcp_handler:\n"
  21         ".incbin \"" __XSTRING(HDCPFW) "\"\n"
  22         ".type hdcp_handler, %function\n"
  23         ".size hdcp_handler, .- hdcp_handler\n"
  24         ".popsection\n"
  25 );
  26
  27 static uint64_t *hdcp_key_pdata;
  28 static struct cdn_dp_hdcp_key_1x key;
  29
  30 int hdcp_handler(struct cdn_dp_hdcp_key_1x *key);
  31
  32 uint64_t dp_hdcp_ctrl(uint64_t type)
  33 {
  34         switch (type) {
  35         case HDCP_KEY_DATA_START_TRANSFER:
  36                 memset(&key, 0x00, sizeof(key));
  37                 hdcp_key_pdata = (uint64_t *)&key;
  38                 return 0;
  39         case HDCP_KEY_DATA_START_DECRYPT:
  40                 if (hdcp_key_pdata == (uint64_t *)(&key + 1))
  41                         return hdcp_handler(&key);
  42                 else
  43                         return PSCI_E_INVALID_PARAMS;
  44                 assert(0); /* Unreachable */
  45         default:
  46                 return SMC_UNK;
  47         }
  48 }
  49
  50 uint64_t dp_hdcp_store_key(uint64_t x1,
  51                            uint64_t x2,
  52                            uint64_t x3,
  53                            uint64_t x4,
  54                            uint64_t x5,
  55                            uint64_t x6)
  56 {
  57         if (hdcp_key_pdata < (uint64_t *)&key ||
  58                 hdcp_key_pdata + 6 > (uint64_t *)(&key + 1))
  59                 return PSCI_E_INVALID_PARAMS;
  60
  61         hdcp_key_pdata[0] = x1;
  62         hdcp_key_pdata[1] = x2;
  63         hdcp_key_pdata[2] = x3;
  64         hdcp_key_pdata[3] = x4;
  65         hdcp_key_pdata[4] = x5;
  66         hdcp_key_pdata[5] = x6;
  67         hdcp_key_pdata += 6;
  68
  69         return 0;
  70 }