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 #if defined(CONFIG_DEFINE_TCM_OCM_MMAP)
45 .attrs
= PTE_BLOCK_MEMTYPE(MT_NORMAL
) |
49 .virt
= 0x400000000UL
,
50 .phys
= 0x400000000UL
,
51 .size
= 0x400000000UL
,
52 .attrs
= PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE
) |
54 PTE_BLOCK_PXN
| PTE_BLOCK_UXN
56 .virt
= 0x800000000UL
,
57 .phys
= 0x800000000UL
,
58 .size
= 0x800000000UL
,
59 .attrs
= PTE_BLOCK_MEMTYPE(MT_NORMAL
) |
62 .virt
= 0x1000000000UL
,
63 .phys
= 0x1000000000UL
,
64 .size
= 0xf000000000UL
,
65 .attrs
= PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE
) |
67 PTE_BLOCK_PXN
| PTE_BLOCK_UXN
73 struct mm_region
*mem_map
= zynqmp_mem_map
;
75 u64
get_page_table_size(void)
80 #ifdef CONFIG_SYS_MEM_RSVD_FOR_MMU
83 initialize_tcm(TCM_LOCK
);
84 memset((void *)ZYNQMP_TCM_BASE_ADDR
, 0, ZYNQMP_TCM_SIZE
);
85 gd
->arch
.tlb_size
= PGTABLE_SIZE
;
86 gd
->arch
.tlb_addr
= ZYNQMP_TCM_BASE_ADDR
;
92 static unsigned int zynqmp_get_silicon_version_secure(void)
96 ver
= readl(&csu_base
->version
);
97 ver
&= ZYNQMP_SILICON_VER_MASK
;
98 ver
>>= ZYNQMP_SILICON_VER_SHIFT
;
103 unsigned int zynqmp_get_silicon_version(void)
105 if (current_el() == 3)
106 return zynqmp_get_silicon_version_secure();
108 gd
->cpu_clk
= get_tbclk();
110 switch (gd
->cpu_clk
) {
112 return ZYNQMP_CSU_VERSION_VELOCE
;
114 return ZYNQMP_CSU_VERSION_QEMU
;
116 return ZYNQMP_CSU_VERSION_EP108
;
119 return ZYNQMP_CSU_VERSION_SILICON
;
122 #define ZYNQMP_MMIO_READ 0xC2000014
123 #define ZYNQMP_MMIO_WRITE 0xC2000013
125 int __maybe_unused
invoke_smc(u32 pm_api_id
, u32 arg0
, u32 arg1
, u32 arg2
,
126 u32 arg3
, u32
*ret_payload
)
129 * Added SIP service call Function Identifier
130 * Make sure to stay in x0 register
134 regs
.regs
[0] = pm_api_id
;
135 regs
.regs
[1] = ((u64
)arg1
<< 32) | arg0
;
136 regs
.regs
[2] = ((u64
)arg3
<< 32) | arg2
;
140 if (ret_payload
!= NULL
) {
141 ret_payload
[0] = (u32
)regs
.regs
[0];
142 ret_payload
[1] = upper_32_bits(regs
.regs
[0]);
143 ret_payload
[2] = (u32
)regs
.regs
[1];
144 ret_payload
[3] = upper_32_bits(regs
.regs
[1]);
145 ret_payload
[4] = (u32
)regs
.regs
[2];
151 #define ZYNQMP_SIP_SVC_GET_API_VERSION 0xC2000001
153 #define ZYNQMP_PM_VERSION_MAJOR 0
154 #define ZYNQMP_PM_VERSION_MINOR 3
155 #define ZYNQMP_PM_VERSION_MAJOR_SHIFT 16
156 #define ZYNQMP_PM_VERSION_MINOR_MASK 0xFFFF
158 #define ZYNQMP_PM_VERSION \
159 ((ZYNQMP_PM_VERSION_MAJOR << ZYNQMP_PM_VERSION_MAJOR_SHIFT) | \
160 ZYNQMP_PM_VERSION_MINOR)
162 #if defined(CONFIG_CLK_ZYNQMP)
163 void zynqmp_pmufw_version(void)
166 u32 ret_payload
[PAYLOAD_ARG_CNT
];
169 ret
= invoke_smc(ZYNQMP_SIP_SVC_GET_API_VERSION
, 0, 0, 0, 0,
171 pm_api_version
= ret_payload
[1];
174 panic("PMUFW is not found - Please load it!\n");
176 printf("PMUFW:\tv%d.%d\n",
177 pm_api_version
>> ZYNQMP_PM_VERSION_MAJOR_SHIFT
,
178 pm_api_version
& ZYNQMP_PM_VERSION_MINOR_MASK
);
180 if (pm_api_version
!= ZYNQMP_PM_VERSION
)
181 panic("PMUFW version error. Expected: v%d.%d\n",
182 ZYNQMP_PM_VERSION_MAJOR
, ZYNQMP_PM_VERSION_MINOR
);
186 static int zynqmp_mmio_rawwrite(const u32 address
,
191 u32 value_local
= value
;
193 zynqmp_mmio_read(address
, &data
);
197 writel(value_local
, (ulong
)address
);
201 static int zynqmp_mmio_rawread(const u32 address
, u32
*value
)
203 *value
= readl((ulong
)address
);
207 int zynqmp_mmio_write(const u32 address
,
211 if (IS_ENABLED(CONFIG_SPL_BUILD
) || current_el() == 3)
212 return zynqmp_mmio_rawwrite(address
, mask
, value
);
214 return invoke_smc(ZYNQMP_MMIO_WRITE
, address
, mask
,
220 int zynqmp_mmio_read(const u32 address
, u32
*value
)
222 u32 ret_payload
[PAYLOAD_ARG_CNT
];
228 if (IS_ENABLED(CONFIG_SPL_BUILD
) || current_el() == 3) {
229 ret
= zynqmp_mmio_rawread(address
, value
);
231 ret
= invoke_smc(ZYNQMP_MMIO_READ
, address
, 0, 0,
233 *value
= ret_payload
[1];