2 * (C) Copyright 2014 - 2015 Xilinx, Inc.
3 * Michal Simek <michal.simek@xilinx.com>
5 * SPDX-License-Identifier: GPL-2.0+
9 #include <asm/arch/hardware.h>
10 #include <asm/arch/sys_proto.h>
11 #include <asm/armv8/mmu.h>
14 #define ZYNQ_SILICON_VER_MASK 0xF000
15 #define ZYNQ_SILICON_VER_SHIFT 12
17 DECLARE_GLOBAL_DATA_PTR;
19 static struct mm_region zynqmp_mem_map[] = {
20 #if !defined(CONFIG_ZYNQMP_NO_DDR)
25 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
33 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
35 PTE_BLOCK_PXN | PTE_BLOCK_UXN
41 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
43 PTE_BLOCK_PXN | PTE_BLOCK_UXN
45 #if defined(CONFIG_DEFINE_TCM_OCM_MMAP)
49 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
53 .virt = 0x400000000UL,
54 .phys = 0x400000000UL,
55 .size = 0x400000000UL,
56 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
58 PTE_BLOCK_PXN | PTE_BLOCK_UXN
60 #if !defined(CONFIG_ZYNQMP_NO_DDR)
62 .virt = 0x800000000UL,
63 .phys = 0x800000000UL,
64 .size = 0x800000000UL,
65 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
70 .virt = 0x1000000000UL,
71 .phys = 0x1000000000UL,
72 .size = 0xf000000000UL,
73 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
75 PTE_BLOCK_PXN | PTE_BLOCK_UXN
81 struct mm_region *mem_map = zynqmp_mem_map;
83 u64 get_page_table_size(void)
88 #ifdef CONFIG_SYS_MEM_RSVD_FOR_MMU
91 initialize_tcm(TCM_LOCK);
92 memset((void *)ZYNQMP_TCM_BASE_ADDR, 0, ZYNQMP_TCM_SIZE);
93 gd->arch.tlb_size = PGTABLE_SIZE;
94 gd->arch.tlb_addr = ZYNQMP_TCM_BASE_ADDR;
100 static unsigned int zynqmp_get_silicon_version_secure(void)
104 ver = readl(&csu_base->version);
105 ver &= ZYNQMP_SILICON_VER_MASK;
106 ver >>= ZYNQMP_SILICON_VER_SHIFT;
111 unsigned int zynqmp_get_silicon_version(void)
113 if (current_el() == 3)
114 return zynqmp_get_silicon_version_secure();
116 gd->cpu_clk = get_tbclk();
118 switch (gd->cpu_clk) {
120 return ZYNQMP_CSU_VERSION_VELOCE;
122 return ZYNQMP_CSU_VERSION_QEMU;
124 return ZYNQMP_CSU_VERSION_EP108;
127 return ZYNQMP_CSU_VERSION_SILICON;
130 #define ZYNQMP_MMIO_READ 0xC2000014
131 #define ZYNQMP_MMIO_WRITE 0xC2000013
133 int __maybe_unused invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2,
134 u32 arg3, u32 *ret_payload)
137 * Added SIP service call Function Identifier
138 * Make sure to stay in x0 register
142 regs.regs[0] = pm_api_id;
143 regs.regs[1] = ((u64)arg1 << 32) | arg0;
144 regs.regs[2] = ((u64)arg3 << 32) | arg2;
148 if (ret_payload != NULL) {
149 ret_payload[0] = (u32)regs.regs[0];
150 ret_payload[1] = upper_32_bits(regs.regs[0]);
151 ret_payload[2] = (u32)regs.regs[1];
152 ret_payload[3] = upper_32_bits(regs.regs[1]);
153 ret_payload[4] = (u32)regs.regs[2];
159 #define ZYNQMP_SIP_SVC_GET_API_VERSION 0xC2000001
161 #define ZYNQMP_PM_VERSION_MAJOR 0
162 #define ZYNQMP_PM_VERSION_MINOR 3
163 #define ZYNQMP_PM_VERSION_MAJOR_SHIFT 16
164 #define ZYNQMP_PM_VERSION_MINOR_MASK 0xFFFF
166 #define ZYNQMP_PM_VERSION \
167 ((ZYNQMP_PM_VERSION_MAJOR << ZYNQMP_PM_VERSION_MAJOR_SHIFT) | \
168 ZYNQMP_PM_VERSION_MINOR)
170 #if defined(CONFIG_CLK_ZYNQMP)
171 void zynqmp_pmufw_version(void)
174 u32 ret_payload[PAYLOAD_ARG_CNT];
177 ret = invoke_smc(ZYNQMP_SIP_SVC_GET_API_VERSION, 0, 0, 0, 0,
179 pm_api_version = ret_payload[1];
182 panic("PMUFW is not found - Please load it!\n");
184 printf("PMUFW:\tv%d.%d\n",
185 pm_api_version >> ZYNQMP_PM_VERSION_MAJOR_SHIFT,
186 pm_api_version & ZYNQMP_PM_VERSION_MINOR_MASK);
188 if (pm_api_version < ZYNQMP_PM_VERSION)
189 panic("PMUFW version error. Expected: v%d.%d\n",
190 ZYNQMP_PM_VERSION_MAJOR, ZYNQMP_PM_VERSION_MINOR);
194 static int zynqmp_mmio_rawwrite(const u32 address,
199 u32 value_local = value;
201 zynqmp_mmio_read(address, &data);
205 writel(value_local, (ulong)address);
209 static int zynqmp_mmio_rawread(const u32 address, u32 *value)
211 *value = readl((ulong)address);
215 int zynqmp_mmio_write(const u32 address,
219 if (IS_ENABLED(CONFIG_SPL_BUILD) || current_el() == 3)
220 return zynqmp_mmio_rawwrite(address, mask, value);
222 return invoke_smc(ZYNQMP_MMIO_WRITE, address, mask,
228 int zynqmp_mmio_read(const u32 address, u32 *value)
230 u32 ret_payload[PAYLOAD_ARG_CNT];
236 if (IS_ENABLED(CONFIG_SPL_BUILD) || current_el() == 3) {
237 ret = zynqmp_mmio_rawread(address, value);
239 ret = invoke_smc(ZYNQMP_MMIO_READ, address, 0, 0,
241 *value = ret_payload[1];