193 lines
5.0 KiB
C
193 lines
5.0 KiB
C
/*
|
|
* Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <arch_helpers.h>
|
|
#include <bl_common.h>
|
|
#include <console.h>
|
|
#include <debug.h>
|
|
#include <interrupt_mgmt.h>
|
|
#include <platform_def.h>
|
|
#include <uart_16550.h>
|
|
#include <xlat_tables_v2.h>
|
|
|
|
#include "rpi3_hw.h"
|
|
#include "rpi3_private.h"
|
|
|
|
#define MAP_DEVICE0 MAP_REGION_FLAT(DEVICE0_BASE, \
|
|
DEVICE0_SIZE, \
|
|
MT_DEVICE | MT_RW | MT_SECURE)
|
|
|
|
#define MAP_SHARED_RAM MAP_REGION_FLAT(SHARED_RAM_BASE, \
|
|
SHARED_RAM_SIZE, \
|
|
MT_DEVICE | MT_RW | MT_SECURE)
|
|
|
|
#define MAP_NS_DRAM0 MAP_REGION_FLAT(NS_DRAM0_BASE, NS_DRAM0_SIZE, \
|
|
MT_MEMORY | MT_RW | MT_NS)
|
|
|
|
#define MAP_FIP MAP_REGION_FLAT(PLAT_RPI3_FIP_BASE, \
|
|
PLAT_RPI3_FIP_MAX_SIZE, \
|
|
MT_MEMORY | MT_RO | MT_NS)
|
|
|
|
#define MAP_BL32_MEM MAP_REGION_FLAT(BL32_MEM_BASE, BL32_MEM_SIZE, \
|
|
MT_MEMORY | MT_RW | MT_SECURE)
|
|
|
|
/*
|
|
* Table of regions for various BL stages to map using the MMU.
|
|
*/
|
|
#ifdef IMAGE_BL1
|
|
static const mmap_region_t plat_rpi3_mmap[] = {
|
|
MAP_SHARED_RAM,
|
|
MAP_DEVICE0,
|
|
MAP_FIP,
|
|
{0}
|
|
};
|
|
#endif
|
|
|
|
#ifdef IMAGE_BL2
|
|
static const mmap_region_t plat_rpi3_mmap[] = {
|
|
MAP_SHARED_RAM,
|
|
MAP_DEVICE0,
|
|
MAP_FIP,
|
|
MAP_NS_DRAM0,
|
|
#ifdef BL32_BASE
|
|
MAP_BL32_MEM,
|
|
#endif
|
|
{0}
|
|
};
|
|
#endif
|
|
|
|
#ifdef IMAGE_BL31
|
|
static const mmap_region_t plat_rpi3_mmap[] = {
|
|
MAP_SHARED_RAM,
|
|
MAP_DEVICE0,
|
|
#ifdef BL32_BASE
|
|
MAP_BL32_MEM,
|
|
#endif
|
|
{0}
|
|
};
|
|
#endif
|
|
|
|
/*******************************************************************************
|
|
* Function that sets up the console
|
|
******************************************************************************/
|
|
static console_16550_t rpi3_console;
|
|
|
|
void rpi3_console_init(void)
|
|
{
|
|
int rc = console_16550_register(PLAT_RPI3_UART_BASE,
|
|
PLAT_RPI3_UART_CLK_IN_HZ,
|
|
PLAT_RPI3_UART_BAUDRATE,
|
|
&rpi3_console);
|
|
if (rc == 0) {
|
|
/*
|
|
* The crash console doesn't use the multi console API, it uses
|
|
* the core console functions directly. It is safe to call panic
|
|
* and let it print debug information.
|
|
*/
|
|
panic();
|
|
}
|
|
|
|
console_set_scope(&rpi3_console.console,
|
|
CONSOLE_FLAG_BOOT | CONSOLE_FLAG_RUNTIME);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function that sets up the translation tables.
|
|
******************************************************************************/
|
|
void rpi3_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
|
|
#if USE_COHERENT_MEM
|
|
, uintptr_t coh_start, uintptr_t coh_limit
|
|
#endif
|
|
)
|
|
{
|
|
/*
|
|
* Map the Trusted SRAM with appropriate memory attributes.
|
|
* Subsequent mappings will adjust the attributes for specific regions.
|
|
*/
|
|
VERBOSE("Trusted SRAM seen by this BL image: %p - %p\n",
|
|
(void *) total_base, (void *) (total_base + total_size));
|
|
mmap_add_region(total_base, total_base,
|
|
total_size,
|
|
MT_MEMORY | MT_RW | MT_SECURE);
|
|
|
|
/* Re-map the code section */
|
|
VERBOSE("Code region: %p - %p\n",
|
|
(void *) code_start, (void *) code_limit);
|
|
mmap_add_region(code_start, code_start,
|
|
code_limit - code_start,
|
|
MT_CODE | MT_SECURE);
|
|
|
|
/* Re-map the read-only data section */
|
|
VERBOSE("Read-only data region: %p - %p\n",
|
|
(void *) rodata_start, (void *) rodata_limit);
|
|
mmap_add_region(rodata_start, rodata_start,
|
|
rodata_limit - rodata_start,
|
|
MT_RO_DATA | MT_SECURE);
|
|
|
|
#if USE_COHERENT_MEM
|
|
/* Re-map the coherent memory region */
|
|
VERBOSE("Coherent region: %p - %p\n",
|
|
(void *) coh_start, (void *) coh_limit);
|
|
mmap_add_region(coh_start, coh_start,
|
|
coh_limit - coh_start,
|
|
MT_DEVICE | MT_RW | MT_SECURE);
|
|
#endif
|
|
|
|
mmap_add(plat_rpi3_mmap);
|
|
|
|
init_xlat_tables();
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Return entrypoint of BL33.
|
|
******************************************************************************/
|
|
uintptr_t plat_get_ns_image_entrypoint(void)
|
|
{
|
|
#ifdef PRELOADED_BL33_BASE
|
|
return PRELOADED_BL33_BASE;
|
|
#else
|
|
return PLAT_RPI3_NS_IMAGE_OFFSET;
|
|
#endif
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Gets SPSR for BL32 entry
|
|
******************************************************************************/
|
|
uint32_t rpi3_get_spsr_for_bl32_entry(void)
|
|
{
|
|
/*
|
|
* The Secure Payload Dispatcher service is responsible for
|
|
* setting the SPSR prior to entry into the BL32 image.
|
|
*/
|
|
return 0;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Gets SPSR for BL33 entry
|
|
******************************************************************************/
|
|
uint32_t rpi3_get_spsr_for_bl33_entry(void)
|
|
{
|
|
#if RPI3_BL33_IN_AARCH32
|
|
INFO("BL33 will boot in Non-secure AArch32 Hypervisor mode\n");
|
|
return SPSR_MODE32(MODE32_hyp, SPSR_T_ARM, SPSR_E_LITTLE,
|
|
DISABLE_ALL_EXCEPTIONS);
|
|
#else
|
|
return SPSR_64(MODE_EL2, MODE_SP_ELX, DISABLE_ALL_EXCEPTIONS);
|
|
#endif
|
|
}
|
|
|
|
unsigned int plat_get_syscnt_freq2(void)
|
|
{
|
|
return SYS_COUNTER_FREQ_IN_TICKS;
|
|
}
|
|
|
|
uint32_t plat_ic_get_pending_interrupt_type(void)
|
|
{
|
|
return INTR_TYPE_INVAL;
|
|
}
|