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[] = {
24 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
30 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
32 PTE_BLOCK_PXN | PTE_BLOCK_UXN
37 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
39 PTE_BLOCK_PXN | PTE_BLOCK_UXN
41 .virt = 0x400000000UL,
42 .phys = 0x400000000UL,
43 .size = 0x200000000UL,
44 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
46 PTE_BLOCK_PXN | PTE_BLOCK_UXN
48 .virt = 0x600000000UL,
49 .phys = 0x600000000UL,
50 .size = 0x800000000UL,
51 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
54 .virt = 0xe00000000UL,
55 .phys = 0xe00000000UL,
56 .size = 0xf200000000UL,
57 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
59 PTE_BLOCK_PXN | PTE_BLOCK_UXN
65 struct mm_region *mem_map = zynqmp_mem_map;
67 u64 get_page_table_size(void)
72 static unsigned int zynqmp_get_silicon_version_secure(void)
76 ver = readl(&csu_base->version);
77 ver &= ZYNQMP_SILICON_VER_MASK;
78 ver >>= ZYNQMP_SILICON_VER_SHIFT;
83 unsigned int zynqmp_get_silicon_version(void)
85 if (current_el() == 3)
86 return zynqmp_get_silicon_version_secure();
88 gd->cpu_clk = get_tbclk();
90 switch (gd->cpu_clk) {
92 return ZYNQMP_CSU_VERSION_VELOCE;
94 return ZYNQMP_CSU_VERSION_QEMU;
96 return ZYNQMP_CSU_VERSION_EP108;
99 return ZYNQMP_CSU_VERSION_SILICON;
102 #define ZYNQMP_MMIO_READ 0xC2000014
103 #define ZYNQMP_MMIO_WRITE 0xC2000013
105 #ifndef CONFIG_SPL_BUILD
106 int invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2, u32 arg3,
110 * Added SIP service call Function Identifier
111 * Make sure to stay in x0 register
115 regs.regs[0] = pm_api_id;
116 regs.regs[1] = ((u64)arg1 << 32) | arg0;
117 regs.regs[2] = ((u64)arg3 << 32) | arg2;
121 if (ret_payload != NULL) {
122 ret_payload[0] = (u32)regs.regs[0];
123 ret_payload[1] = upper_32_bits(regs.regs[0]);
124 ret_payload[2] = (u32)regs.regs[1];
125 ret_payload[3] = upper_32_bits(regs.regs[1]);
126 ret_payload[4] = (u32)regs.regs[2];
132 #define ZYNQMP_SIP_SVC_GET_API_VERSION 0xC2000001
134 #define ZYNQMP_PM_VERSION_MAJOR 0
135 #define ZYNQMP_PM_VERSION_MINOR 3
136 #define ZYNQMP_PM_VERSION_MAJOR_SHIFT 16
137 #define ZYNQMP_PM_VERSION_MINOR_MASK 0xFFFF
139 #define ZYNQMP_PM_VERSION \
140 ((ZYNQMP_PM_VERSION_MAJOR << ZYNQMP_PM_VERSION_MAJOR_SHIFT) | \
141 ZYNQMP_PM_VERSION_MINOR)
143 #if defined(CONFIG_CLK_ZYNQMP)
144 void zynqmp_pmufw_version(void)
147 u32 ret_payload[PAYLOAD_ARG_CNT];
150 ret = invoke_smc(ZYNQMP_SIP_SVC_GET_API_VERSION, 0, 0, 0, 0,
152 pm_api_version = ret_payload[1];
155 panic("PMUFW is not found - Please load it!\n");
157 printf("PMUFW:\tv%d.%d\n",
158 pm_api_version >> ZYNQMP_PM_VERSION_MAJOR_SHIFT,
159 pm_api_version & ZYNQMP_PM_VERSION_MINOR_MASK);
161 if (pm_api_version != ZYNQMP_PM_VERSION)
162 panic("PMUFW version error. Expected: v%d.%d\n",
163 ZYNQMP_PM_VERSION_MAJOR, ZYNQMP_PM_VERSION_MINOR);
167 int zynqmp_mmio_write(const u32 address,
171 return invoke_smc(ZYNQMP_MMIO_WRITE, address, mask, value, 0, NULL);
174 int zynqmp_mmio_read(const u32 address, u32 *value)
176 u32 ret_payload[PAYLOAD_ARG_CNT];
182 ret = invoke_smc(ZYNQMP_MMIO_READ, address, 0, 0, 0, ret_payload);
183 *value = ret_payload[1];
188 int zynqmp_mmio_write(const u32 address,
193 u32 value_local = value;
195 zynqmp_mmio_read(address, &data);
199 writel(value_local, (ulong)address);
203 int zynqmp_mmio_read(const u32 address, u32 *value)
205 *value = readl((ulong)address);