1 // SPDX-License-Identifier: BSD-2-Clause
2 /*
3 * Copyright (c) 2016, Xilinx Inc.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions are met:
8 *
9 * 1. Redistributions of source code must retain the above copyright notice,
10 * this list of conditions and the following disclaimer.
11 *
12 * 2. Redistributions in binary form must reproduce the above copyright notice,
13 * this list of conditions and the following disclaimer in the documentation
14 * and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
20 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 * POSSIBILITY OF SUCH DAMAGE.
27 */
28
29 #include <platform_config.h>
30
31 #include <stdint.h>
32 #include <string.h>
33
34 #include <drivers/gic.h>
35 #include <drivers/cdns_uart.h>
36 #include <drivers/zynqmp_csu.h>
37
38 #include <arm.h>
39 #include <console.h>
40 #include <io.h>
41 #include <kernel/boot.h>
42 #include <kernel/interrupt.h>
43 #include <kernel/misc.h>
44 #include <kernel/tee_common_otp.h>
45 #include <kernel/tee_time.h>
46 #include <mm/core_memprot.h>
47 #include <tee/tee_fs.h>
48 #include <trace.h>
49
50 static struct gic_data gic_data;
51 static struct cdns_uart_data console_data;
52
53 register_phys_mem_pgdir(MEM_AREA_IO_SEC,
54 ROUNDDOWN(CONSOLE_UART_BASE, CORE_MMU_PGDIR_SIZE),
55 CORE_MMU_PGDIR_SIZE);
56
57 register_phys_mem_pgdir(MEM_AREA_IO_SEC,
58 ROUNDDOWN(GIC_BASE, CORE_MMU_PGDIR_SIZE),
59 CORE_MMU_PGDIR_SIZE);
60
61 register_phys_mem_pgdir(MEM_AREA_IO_SEC,
62 ROUNDDOWN(GIC_BASE + GICD_OFFSET, CORE_MMU_PGDIR_SIZE),
63 CORE_MMU_PGDIR_SIZE);
64 #if defined(CFG_ZYNQMP_CSU)
65 register_phys_mem_pgdir(MEM_AREA_IO_SEC, CSU_BASE, CSU_SIZE);
66 #endif
67
68 #if CFG_DDR_SIZE > 0x80000000
69
70 #ifdef CFG_ARM32_core
71 #error DDR size over 2 GiB is not supported in 32 bit ARM mode
72 #endif
73
74 register_ddr(DRAM0_BASE, 0x80000000);
75 register_ddr(DRAM1_BASE, CFG_DDR_SIZE - 0x80000000);
76 #else
77 register_ddr(DRAM0_BASE, CFG_DDR_SIZE);
78 #endif
79
main_init_gic(void)80 void main_init_gic(void)
81 {
82 vaddr_t gicc_base, gicd_base;
83
84 gicc_base = (vaddr_t)phys_to_virt(GIC_BASE + GICC_OFFSET,
85 MEM_AREA_IO_SEC, 1);
86 gicd_base = (vaddr_t)phys_to_virt(GIC_BASE + GICD_OFFSET,
87 MEM_AREA_IO_SEC, 1);
88 /* On ARMv8, GIC configuration is initialized in ARM-TF */
89 gic_init_base_addr(&gic_data, gicc_base, gicd_base);
90 }
91
itr_core_handler(void)92 void itr_core_handler(void)
93 {
94 gic_it_handle(&gic_data);
95 }
96
console_init(void)97 void console_init(void)
98 {
99 cdns_uart_init(&console_data, CONSOLE_UART_BASE,
100 CONSOLE_UART_CLK_IN_HZ, CONSOLE_BAUDRATE);
101 register_serial_console(&console_data.chip);
102 }
103
104 #if defined(CFG_RPMB_FS)
plat_rpmb_key_is_ready(void)105 bool plat_rpmb_key_is_ready(void)
106 {
107 vaddr_t csu = core_mmu_get_va(CSU_BASE, MEM_AREA_IO_SEC, CSU_SIZE);
108 struct tee_hw_unique_key hwkey = { };
109 uint32_t status = 0;
110
111 if (tee_otp_get_hw_unique_key(&hwkey))
112 return false;
113
114 /*
115 * For security reasons, we don't allow writing the RPMB key using the
116 * development HUK even though it is unique.
117 */
118 status = io_read32(csu + ZYNQMP_CSU_STATUS_OFFSET);
119 if (status & ZYNQMP_CSU_STATUS_AUTH)
120 return true;
121
122 return false;
123 }
124 #endif
125