11bb92983SJerome Forissier // SPDX-License-Identifier: BSD-2-Clause
2dc57f5a0SSoren Brinkmann /*
3dc57f5a0SSoren Brinkmann * Copyright (c) 2016, Xilinx Inc.
4dc57f5a0SSoren Brinkmann * All rights reserved.
5dc57f5a0SSoren Brinkmann *
6dc57f5a0SSoren Brinkmann * Redistribution and use in source and binary forms, with or without
7dc57f5a0SSoren Brinkmann * modification, are permitted provided that the following conditions are met:
8dc57f5a0SSoren Brinkmann *
9dc57f5a0SSoren Brinkmann * 1. Redistributions of source code must retain the above copyright notice,
10dc57f5a0SSoren Brinkmann * this list of conditions and the following disclaimer.
11dc57f5a0SSoren Brinkmann *
12dc57f5a0SSoren Brinkmann * 2. Redistributions in binary form must reproduce the above copyright notice,
13dc57f5a0SSoren Brinkmann * this list of conditions and the following disclaimer in the documentation
14dc57f5a0SSoren Brinkmann * and/or other materials provided with the distribution.
15dc57f5a0SSoren Brinkmann *
16dc57f5a0SSoren Brinkmann * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17dc57f5a0SSoren Brinkmann * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18dc57f5a0SSoren Brinkmann * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19dc57f5a0SSoren Brinkmann * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
20dc57f5a0SSoren Brinkmann * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21dc57f5a0SSoren Brinkmann * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22dc57f5a0SSoren Brinkmann * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23dc57f5a0SSoren Brinkmann * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24dc57f5a0SSoren Brinkmann * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25dc57f5a0SSoren Brinkmann * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26dc57f5a0SSoren Brinkmann * POSSIBILITY OF SUCH DAMAGE.
27dc57f5a0SSoren Brinkmann */
28dc57f5a0SSoren Brinkmann
29dc57f5a0SSoren Brinkmann #include <platform_config.h>
30dc57f5a0SSoren Brinkmann
31dc57f5a0SSoren Brinkmann #include <stdint.h>
32dc57f5a0SSoren Brinkmann #include <string.h>
33dc57f5a0SSoren Brinkmann
34dc57f5a0SSoren Brinkmann #include <drivers/gic.h>
35dc57f5a0SSoren Brinkmann #include <drivers/cdns_uart.h>
36f57e4036SJorge Ramirez-Ortiz #include <drivers/zynqmp_csu.h>
37dc57f5a0SSoren Brinkmann
38dc57f5a0SSoren Brinkmann #include <arm.h>
39dc57f5a0SSoren Brinkmann #include <console.h>
40f57e4036SJorge Ramirez-Ortiz #include <io.h>
4165401337SJens Wiklander #include <kernel/boot.h>
42dc57f5a0SSoren Brinkmann #include <kernel/misc.h>
43f57e4036SJorge Ramirez-Ortiz #include <kernel/tee_common_otp.h>
44dc57f5a0SSoren Brinkmann #include <kernel/tee_time.h>
45dc57f5a0SSoren Brinkmann #include <mm/core_memprot.h>
46f57e4036SJorge Ramirez-Ortiz #include <tee/tee_fs.h>
47dc57f5a0SSoren Brinkmann #include <trace.h>
48dc57f5a0SSoren Brinkmann
493c34b07cSMichael Doran static struct cdns_uart_data console_data __nex_bss;
50dc57f5a0SSoren Brinkmann
51a5e82dc7SJerome Forissier register_phys_mem_pgdir(MEM_AREA_IO_SEC,
52a5e82dc7SJerome Forissier ROUNDDOWN(CONSOLE_UART_BASE, CORE_MMU_PGDIR_SIZE),
53a5e82dc7SJerome Forissier CORE_MMU_PGDIR_SIZE);
5459fffc71SEtienne Carriere
55a5e82dc7SJerome Forissier register_phys_mem_pgdir(MEM_AREA_IO_SEC,
56a5e82dc7SJerome Forissier ROUNDDOWN(GIC_BASE, CORE_MMU_PGDIR_SIZE),
57a5e82dc7SJerome Forissier CORE_MMU_PGDIR_SIZE);
5859fffc71SEtienne Carriere
59a5e82dc7SJerome Forissier register_phys_mem_pgdir(MEM_AREA_IO_SEC,
60a5e82dc7SJerome Forissier ROUNDDOWN(GIC_BASE + GICD_OFFSET, CORE_MMU_PGDIR_SIZE),
61a5e82dc7SJerome Forissier CORE_MMU_PGDIR_SIZE);
623e0615deSJorge Ramirez-Ortiz #if defined(CFG_ZYNQMP_CSU)
633e0615deSJorge Ramirez-Ortiz register_phys_mem_pgdir(MEM_AREA_IO_SEC, CSU_BASE, CSU_SIZE);
643e0615deSJorge Ramirez-Ortiz #endif
6559fffc71SEtienne Carriere
66df8976a1SVesa Jääskeläinen #if CFG_DDR_SIZE > 0x80000000
67df8976a1SVesa Jääskeläinen
68df8976a1SVesa Jääskeläinen #ifdef CFG_ARM32_core
69df8976a1SVesa Jääskeläinen #error DDR size over 2 GiB is not supported in 32 bit ARM mode
70df8976a1SVesa Jääskeläinen #endif
71df8976a1SVesa Jääskeläinen
72df8976a1SVesa Jääskeläinen register_ddr(DRAM0_BASE, 0x80000000);
73df8976a1SVesa Jääskeläinen register_ddr(DRAM1_BASE, CFG_DDR_SIZE - 0x80000000);
74df8976a1SVesa Jääskeläinen #else
75df8976a1SVesa Jääskeläinen register_ddr(DRAM0_BASE, CFG_DDR_SIZE);
76a7474d1dSRicardo Salveti #endif
77a7474d1dSRicardo Salveti
boot_primary_init_intc(void)78df913c6dSAlvin Chang void boot_primary_init_intc(void)
79dc57f5a0SSoren Brinkmann {
800ee3f52eSEtienne Carriere gic_init(GIC_BASE + GICC_OFFSET, GIC_BASE + GICD_OFFSET);
81dc57f5a0SSoren Brinkmann }
82dc57f5a0SSoren Brinkmann
plat_console_init(void)83*55ab8f06SAlvin Chang void plat_console_init(void)
84dc57f5a0SSoren Brinkmann {
8562fff454SJerome Forissier cdns_uart_init(&console_data, CONSOLE_UART_BASE,
8662fff454SJerome Forissier CONSOLE_UART_CLK_IN_HZ, CONSOLE_BAUDRATE);
87756aea59SJerome Forissier register_serial_console(&console_data.chip);
88dc57f5a0SSoren Brinkmann }
89f57e4036SJorge Ramirez-Ortiz
90f57e4036SJorge Ramirez-Ortiz #if defined(CFG_RPMB_FS)
plat_rpmb_key_is_ready(void)91f57e4036SJorge Ramirez-Ortiz bool plat_rpmb_key_is_ready(void)
92f57e4036SJorge Ramirez-Ortiz {
93f57e4036SJorge Ramirez-Ortiz vaddr_t csu = core_mmu_get_va(CSU_BASE, MEM_AREA_IO_SEC, CSU_SIZE);
94f57e4036SJorge Ramirez-Ortiz struct tee_hw_unique_key hwkey = { };
95f57e4036SJorge Ramirez-Ortiz uint32_t status = 0;
96f57e4036SJorge Ramirez-Ortiz
97f57e4036SJorge Ramirez-Ortiz if (tee_otp_get_hw_unique_key(&hwkey))
98f57e4036SJorge Ramirez-Ortiz return false;
99f57e4036SJorge Ramirez-Ortiz
100f57e4036SJorge Ramirez-Ortiz /*
101f57e4036SJorge Ramirez-Ortiz * For security reasons, we don't allow writing the RPMB key using the
102f57e4036SJorge Ramirez-Ortiz * development HUK even though it is unique.
103f57e4036SJorge Ramirez-Ortiz */
104f57e4036SJorge Ramirez-Ortiz status = io_read32(csu + ZYNQMP_CSU_STATUS_OFFSET);
105f57e4036SJorge Ramirez-Ortiz if (status & ZYNQMP_CSU_STATUS_AUTH)
106f57e4036SJorge Ramirez-Ortiz return true;
107f57e4036SJorge Ramirez-Ortiz
108f57e4036SJorge Ramirez-Ortiz return false;
109f57e4036SJorge Ramirez-Ortiz }
110f57e4036SJorge Ramirez-Ortiz #endif
111