arm_common.c 5.98 KB
Newer Older
1
/*
2
 * Copyright (c) 2015-2017, ARM Limited and Contributors. All rights reserved.
3
 *
dp-arm's avatar
dp-arm committed
4
 * SPDX-License-Identifier: BSD-3-Clause
5
6
7
 */
#include <arch.h>
#include <arch_helpers.h>
8
#include <arm_xlat_tables.h>
9
#include <assert.h>
10
#include <debug.h>
11
12
#include <mmio.h>
#include <plat_arm.h>
13
#include <platform_def.h>
14
#include <secure_partition.h>
15

16
extern const mmap_region_t plat_arm_mmap[];
17
18
19

/* Weak definitions may be overridden in specific ARM standard platform */
#pragma weak plat_get_ns_image_entrypoint
20
#pragma weak plat_arm_get_mmap
21
22
23
24
25
26

/* Conditionally provide a weak definition of plat_get_syscnt_freq2 to avoid
 * conflicts with the definition in plat/common. */
#if ERROR_DEPRECATED
#pragma weak plat_get_syscnt_freq2
#endif
27

28
29
30
31
32
/*
 * Set up the page tables for the generic and platform-specific memory regions.
 * The extents of the generic memory regions are specified by the function
 * arguments and consist of:
 * - Trusted SRAM seen by the BL image;
33
34
 * - Code section;
 * - Read-only data section;
35
36
 * - Coherent memory region, if applicable.
 */
37
38
39
40
41
42
void arm_setup_page_tables(uintptr_t total_base,
			   size_t total_size,
			   uintptr_t code_start,
			   uintptr_t code_limit,
			   uintptr_t rodata_start,
			   uintptr_t rodata_limit
43
#if USE_COHERENT_MEM
44
			   ,
45
46
			   uintptr_t coh_start,
			   uintptr_t coh_limit
47
#endif
48
49
50
51
52
53
			   )
{
	/*
	 * Map the Trusted SRAM with appropriate memory attributes.
	 * Subsequent mappings will adjust the attributes for specific regions.
	 */
54
55
	VERBOSE("Trusted SRAM seen by this BL image: %p - %p\n",
		(void *) total_base, (void *) (total_base + total_size));
56
57
58
	mmap_add_region(total_base, total_base,
			total_size,
			MT_MEMORY | MT_RW | MT_SECURE);
59
60

	/* Re-map the code section */
61
62
	VERBOSE("Code region: %p - %p\n",
		(void *) code_start, (void *) code_limit);
63
64
65
66
67
	mmap_add_region(code_start, code_start,
			code_limit - code_start,
			MT_CODE | MT_SECURE);

	/* Re-map the read-only data section */
68
69
	VERBOSE("Read-only data region: %p - %p\n",
		(void *) rodata_start, (void *) rodata_limit);
70
71
72
73
	mmap_add_region(rodata_start, rodata_start,
			rodata_limit - rodata_start,
			MT_RO_DATA | MT_SECURE);

74
75
#if USE_COHERENT_MEM
	/* Re-map the coherent memory region */
76
77
	VERBOSE("Coherent region: %p - %p\n",
		(void *) coh_start, (void *) coh_limit);
78
79
80
81
	mmap_add_region(coh_start, coh_start,
			coh_limit - coh_start,
			MT_DEVICE | MT_RW | MT_SECURE);
#endif
82

83
84
85
86
87
88
89
90
#if ENABLE_SPM && defined(IMAGE_BL31)
	/* The address of the following region is calculated by the linker. */
	mmap_add_region(SP_IMAGE_XLAT_TABLES_START,
			SP_IMAGE_XLAT_TABLES_START,
			SP_IMAGE_XLAT_TABLES_SIZE,
			MT_MEMORY | MT_RW | MT_SECURE);
#endif

91
92
	/* Now (re-)map the platform-specific memory regions */
	mmap_add(plat_arm_get_mmap());
93

94
95
96
	/* Create the page tables to reflect the above mappings */
	init_xlat_tables();
}
97

98
uintptr_t plat_get_ns_image_entrypoint(void)
99
{
100
101
102
#ifdef PRELOADED_BL33_BASE
	return PRELOADED_BL33_BASE;
#else
103
	return PLAT_ARM_NS_IMAGE_OFFSET;
104
#endif
105
106
107
108
109
110
111
112
113
}

/*******************************************************************************
 * Gets SPSR for BL32 entry
 ******************************************************************************/
uint32_t arm_get_spsr_for_bl32_entry(void)
{
	/*
	 * The Secure Payload Dispatcher service is responsible for
114
	 * setting the SPSR prior to entry into the BL32 image.
115
116
117
118
119
120
121
	 */
	return 0;
}

/*******************************************************************************
 * Gets SPSR for BL33 entry
 ******************************************************************************/
122
#ifndef AARCH32
123
124
125
126
127
128
uint32_t arm_get_spsr_for_bl33_entry(void)
{
	unsigned int mode;
	uint32_t spsr;

	/* Figure out what mode we enter the non-secure world in */
129
	mode = EL_IMPLEMENTED(2) ? MODE_EL2 : MODE_EL1;
130
131
132
133
134
135
136
137
138

	/*
	 * TODO: Consider the possibility of specifying the SPSR in
	 * the FIP ToC and allowing the platform to have a say as
	 * well.
	 */
	spsr = SPSR_64(mode, MODE_SP_ELX, DISABLE_ALL_EXCEPTIONS);
	return spsr;
}
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
#else
/*******************************************************************************
 * Gets SPSR for BL33 entry
 ******************************************************************************/
uint32_t arm_get_spsr_for_bl33_entry(void)
{
	unsigned int hyp_status, mode, spsr;

	hyp_status = GET_VIRT_EXT(read_id_pfr1());

	mode = (hyp_status) ? MODE32_hyp : MODE32_svc;

	/*
	 * TODO: Consider the possibility of specifying the SPSR in
	 * the FIP ToC and allowing the platform to have a say as
	 * well.
	 */
	spsr = SPSR_MODE32(mode, plat_get_ns_image_entrypoint() & 0x1,
			SPSR_E_LITTLE, DISABLE_ALL_EXCEPTIONS);
	return spsr;
}
#endif /* AARCH32 */
161

162
163
164
/*******************************************************************************
 * Configures access to the system counter timer module.
 ******************************************************************************/
165
#ifdef ARM_SYS_TIMCTL_BASE
166
167
168
169
void arm_configure_sys_timer(void)
{
	unsigned int reg_val;

170
#if ARM_CONFIG_CNTACR
171
172
173
174
	reg_val = (1 << CNTACR_RPCT_SHIFT) | (1 << CNTACR_RVCT_SHIFT);
	reg_val |= (1 << CNTACR_RFRQ_SHIFT) | (1 << CNTACR_RVOFF_SHIFT);
	reg_val |= (1 << CNTACR_RWVT_SHIFT) | (1 << CNTACR_RWPT_SHIFT);
	mmio_write_32(ARM_SYS_TIMCTL_BASE + CNTACR_BASE(PLAT_ARM_NSTIMER_FRAME_ID), reg_val);
175
#endif /* ARM_CONFIG_CNTACR */
176
177
178
179

	reg_val = (1 << CNTNSAR_NS_SHIFT(PLAT_ARM_NSTIMER_FRAME_ID));
	mmio_write_32(ARM_SYS_TIMCTL_BASE + CNTNSAR, reg_val);
}
180
#endif /* ARM_SYS_TIMCTL_BASE */
181
182
183
184
185
186
187
188

/*******************************************************************************
 * Returns ARM platform specific memory map regions.
 ******************************************************************************/
const mmap_region_t *plat_arm_get_mmap(void)
{
	return plat_arm_mmap;
}
189

190
#ifdef ARM_SYS_CNTCTL_BASE
191
192
193

unsigned int plat_get_syscnt_freq2(void)
{
Sandrine Bailleux's avatar
Sandrine Bailleux committed
194
	unsigned int counter_base_frequency;
195
196
197
198
199
200
201
202
203
204

	/* Read the frequency from Frequency modes table */
	counter_base_frequency = mmio_read_32(ARM_SYS_CNTCTL_BASE + CNTFID_OFF);

	/* The first entry of the frequency modes table must not be 0 */
	if (counter_base_frequency == 0)
		panic();

	return counter_base_frequency;
}
205

206
#endif /* ARM_SYS_CNTCTL_BASE */