First version
[3rdparty/ote_partner/tlk.git] / platform / tegra / common / memory.c
1 /*
2  * Copyright (c) 2012-2014, NVIDIA CORPORATION. All rights reserved
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining
5  * a copy of this software and associated documentation files
6  * (the "Software"), to deal in the Software without restriction,
7  * including without limitation the rights to use, copy, modify, merge,
8  * publish, distribute, sublicense, and/or sell copies of the Software,
9  * and to permit persons to whom the Software is furnished to do so,
10  * subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice shall be
13  * included in all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
19  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
20  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
21  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22  */
23
24 #include <stdlib.h>
25 #include <err.h>
26 #include <debug.h>
27 #include <platform.h>
28 #include <platform/memmap.h>
29 #include <reg.h>
30 #include <string.h>
31
32 #include <platform/platform_p.h>
33 #include <kernel/boot_params.h>
34
35 /* clock enable for TZRAM */
36 #define CLK_OUT_ENB_V                   0x360
37 #define CLK_OUT_ENB_TZRAM_SHIFT         30
38 #define CLK_OUT_ENB_TZRAM_ENABLE        1
39
40 #define SZ_1MB 0x00100000
41
42 #define MC_VIDEO_PROTECT_BOM            0x648
43 #define MC_VIDEO_PROTECT_SIZE_MB        0x64c
44
45 status_t platform_program_vpr(uint32_t vpr_base, uint32_t vpr_size)
46 {
47         static uint32_t save_vpr_base=0, save_vpr_size=0;
48         uint32_t save_vpr_end, vpr_end;
49
50         if (!save_vpr_base && !save_vpr_size) {
51                 save_vpr_base = *REG32(TEGRA_MC_BASE + MC_VIDEO_PROTECT_BOM);
52                 save_vpr_size = *REG32(TEGRA_MC_BASE + MC_VIDEO_PROTECT_SIZE_MB);
53
54                 /* apply nvtboot WAR as initial carveout may include HIVEC_BASE */
55                 if ((uint64_t)save_vpr_base + (save_vpr_size * SZ_1MB) > NV_ARM_CORE_HIVEC_BASE) {
56                         save_vpr_end = ROUNDDOWN(NV_ARM_CORE_HIVEC_BASE, SZ_1MB);
57                         save_vpr_size = (save_vpr_end - save_vpr_base) / SZ_1MB;
58                 }
59         }
60
61         /* check if vpr_size and vpr_base are MB align */
62         if ((vpr_size & (SZ_1MB-1)) || (vpr_base & (SZ_1MB-1))  ) {
63                 dprintf(CRITICAL, "%s: vpr base/size not MB align\n", __func__);
64                 return ERR_GENERIC;
65         }
66
67         vpr_end = vpr_base + vpr_size;
68         vpr_size = vpr_size / SZ_1MB;
69         save_vpr_end = save_vpr_base + (save_vpr_size * SZ_1MB);
70
71         if (vpr_base > save_vpr_end || save_vpr_base > vpr_end) {
72                 memset((void*)save_vpr_base, 0, (save_vpr_size * SZ_1MB)); //non-overlap
73         } else {
74                 if (save_vpr_base < vpr_base) {
75                         memset((void*)save_vpr_base, 0, vpr_base-save_vpr_base); //shrink/shift at base
76                 }
77                 if (save_vpr_end > vpr_end) {
78                         memset((void*)vpr_end, 0, save_vpr_end-vpr_end); //shrink at end
79                 }
80         }
81
82         *REG32(TEGRA_MC_BASE + MC_VIDEO_PROTECT_BOM) = vpr_base;
83         *REG32(TEGRA_MC_BASE + MC_VIDEO_PROTECT_SIZE_MB) = vpr_size;
84         save_vpr_base = vpr_base;
85         save_vpr_size = vpr_size;
86
87         return NO_ERROR;
88 }
89
90 void platform_setup_keys(void)
91 {
92         boot_params *boot_params_ptr;
93         key_params *keys_ptr;
94         uint32_t reg, offset;
95         extern uint32_t __bootarg_addr;
96
97         /* keys immediately follow the boot params in DRAM */
98         boot_params_ptr = (boot_params *) __bootarg_addr;
99         offset = ROUNDUP(boot_params_ptr->param_string_sz, sizeof(uint32_t));
100
101         /* ensure TZRAM clock is enabled */
102         reg  = readl(TEGRA_CLK_RESET_BASE + CLK_OUT_ENB_V);
103         reg |= (CLK_OUT_ENB_TZRAM_ENABLE << CLK_OUT_ENB_TZRAM_SHIFT);
104         writel(reg, TEGRA_CLK_RESET_BASE + CLK_OUT_ENB_V);
105
106         /* copy keys to TZRAM */
107         keys_ptr = (key_params *)((uintptr_t)boot_params_ptr->param_string + offset);
108         memcpy((void *)TEGRA_TZRAM_BASE,
109                 keys_ptr->encrypted_keys, keys_ptr->encrypted_key_sz);
110 }