diff options
Diffstat (limited to 'plat')
-rw-r--r-- | plat/fvp/bl1_plat_setup.c | 1 | ||||
-rw-r--r-- | plat/fvp/bl2_plat_setup.c | 20 | ||||
-rw-r--r-- | plat/fvp/plat_io_storage.c | 240 | ||||
-rw-r--r-- | plat/fvp/platform.h | 18 | ||||
-rw-r--r-- | plat/fvp/platform.mk | 4 |
5 files changed, 251 insertions, 32 deletions
diff --git a/plat/fvp/bl1_plat_setup.c b/plat/fvp/bl1_plat_setup.c index 3daa480..7a61c66 100644 --- a/plat/fvp/bl1_plat_setup.c +++ b/plat/fvp/bl1_plat_setup.c @@ -28,7 +28,6 @@ * POSSIBILITY OF SUCH DAMAGE. */ -#include <string.h> #include <assert.h> #include <arch_helpers.h> #include <platform.h> diff --git a/plat/fvp/bl2_plat_setup.c b/plat/fvp/bl2_plat_setup.c index 4efb436..f8c922e 100644 --- a/plat/fvp/bl2_plat_setup.c +++ b/plat/fvp/bl2_plat_setup.c @@ -28,7 +28,6 @@ * POSSIBILITY OF SUCH DAMAGE. */ -#include <string.h> #include <assert.h> #include <arch_helpers.h> #include <platform.h> @@ -71,12 +70,21 @@ extern unsigned char **bl2_el_change_mem_ptr; static meminfo bl2_tzram_layout __attribute__ ((aligned(PLATFORM_CACHE_LINE_SIZE), section("tzfw_coherent_mem"))); +/* Data structure which holds the extents of the Non-Secure DRAM for BL33 */ +static meminfo bl33_dram_layout +__attribute__ ((aligned(PLATFORM_CACHE_LINE_SIZE), + section("tzfw_coherent_mem"))); meminfo *bl2_plat_sec_mem_layout(void) { return &bl2_tzram_layout; } +meminfo *bl2_get_ns_mem_layout(void) +{ + return &bl33_dram_layout; +} + /******************************************************************************* * BL1 has passed the extents of the trusted SRAM that should be visible to BL2 * in x0. This memory layout is sitting at the base of the free trusted SRAM. @@ -93,6 +101,16 @@ void bl2_early_platform_setup(meminfo *mem_layout, bl2_tzram_layout.attr = mem_layout->attr; bl2_tzram_layout.next = 0; + /* Setup the BL3-3 memory layout. + * Normal World Firmware loaded into main DRAM. + */ + bl33_dram_layout.total_base = DRAM_BASE; + bl33_dram_layout.total_size = DRAM_SIZE; + bl33_dram_layout.free_base = DRAM_BASE; + bl33_dram_layout.free_size = DRAM_SIZE; + bl33_dram_layout.attr = 0; + bl33_dram_layout.next = 0; + /* Initialize the platform config for future decision making */ platform_config_setup(); diff --git a/plat/fvp/plat_io_storage.c b/plat/fvp/plat_io_storage.c index e476106..fd2d2b2 100644 --- a/plat/fvp/plat_io_storage.c +++ b/plat/fvp/plat_io_storage.c @@ -35,69 +35,259 @@ #include "io_driver.h" #include "io_semihosting.h" #include "semihosting.h" /* For FOPEN_MODE_... */ +#include "io_fip.h" +#include "io_memmap.h" #include "debug.h" +typedef struct { + char *image_name; + int (*image_policy)(io_dev_handle *dev_handle, void **image_spec); +} plat_io_policy; + + /* IO devices */ static struct io_plat_data io_data; static struct io_dev_connector *sh_dev_con; static void *const sh_dev_spec; static void *const sh_init_params; static io_dev_handle sh_dev_handle; +static struct io_dev_connector *fip_dev_con; +static void *const fip_dev_spec; +static io_dev_handle fip_dev_handle; +static struct io_dev_connector *memmap_dev_con; +static void *const memmap_dev_spec; +static void *const memmap_init_params; +static io_dev_handle memmap_dev_handle; + +static int fvp_bl2_policy(io_dev_handle *dev_handle, void **image_spec); +static int fvp_bl31_policy(io_dev_handle *dev_handle, void **image_spec); +static int fvp_bl33_policy(io_dev_handle *dev_handle, void **image_spec); +static int fvp_fip_policy(io_dev_handle *dev_handle, void **image_spec); + + +static io_block_spec fip_block_spec = { + .offset = FLASH0_BASE, + .length = FLASH0_SIZE +}; -static io_file_spec bl2_image_spec = { +static io_file_spec bl2_file_spec = { .path = BL2_IMAGE_NAME, .mode = FOPEN_MODE_R }; -static io_file_spec bl31_image_spec = { +static io_file_spec bl31_file_spec = { .path = BL31_IMAGE_NAME, .mode = FOPEN_MODE_R }; +static io_file_spec bl33_file_spec = { + .path = BL33_IMAGE_NAME, + .mode = FOPEN_MODE_R +}; + +static plat_io_policy fvp_policy[] = { + {BL2_IMAGE_NAME, fvp_bl2_policy}, + {BL31_IMAGE_NAME, fvp_bl31_policy}, + {BL33_IMAGE_NAME, fvp_bl33_policy}, + {FIP_IMAGE_NAME, fvp_fip_policy}, + {NULL, NULL} +}; + + +static int open_fip(void *spec) +{ + int result = IO_FAIL; + + /* See if a Firmware Image Package is available */ + result = io_dev_init(fip_dev_handle, (void *)FIP_IMAGE_NAME); + if (result == IO_SUCCESS) { + INFO("Using FIP\n"); + /*TODO: Check image defined in spec is present in FIP. */ + } + return result; +} + + +static int open_memmap(void *spec) +{ + int result = IO_FAIL; + io_handle local_image_handle; + + result = io_dev_init(memmap_dev_handle, memmap_init_params); + if (result == IO_SUCCESS) { + result = io_open(memmap_dev_handle, spec, &local_image_handle); + if (result == IO_SUCCESS) { + /* INFO("Using Memmap IO\n"); */ + io_close(local_image_handle); + } + } + return result; +} + + +static int open_semihosting(void *spec) +{ + int result = IO_FAIL; + io_handle local_image_handle; + + /* See if the file exists on semi-hosting.*/ + result = io_dev_init(sh_dev_handle, sh_init_params); + if (result == IO_SUCCESS) { + result = io_open(sh_dev_handle, spec, &local_image_handle); + if (result == IO_SUCCESS) { + INFO("Using Semi-hosting IO\n"); + io_close(local_image_handle); + } + } + return result; +} + + +/* Try to load BL2 from Firmware Image Package in FLASH first. If there is no + * FIP in FLASH or it is broken, try to load the file from semi-hosting. + */ +static int fvp_bl2_policy(io_dev_handle *dev_handle, void **image_spec) +{ + int result = IO_FAIL; + void *local_image_spec = &bl2_file_spec; + + INFO("Loading BL2\n"); + /* FIP first then fall back to semi-hosting */ + result = open_fip(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = fip_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } else { + result = open_semihosting(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = sh_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } + } + return result; +} + + +/* Try to load BL31 from Firmware Image Package in FLASH first. If there is no + * FIP in FLASH or it is broken, try to load the file from semi-hosting. + */ +static int fvp_bl31_policy(io_dev_handle *dev_handle, void **image_spec) +{ + int result = IO_FAIL; + void *local_image_spec = &bl31_file_spec; + + INFO("Loading BL31\n"); + /* FIP first then fall back to semi-hosting */ + result = open_fip(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = fip_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } else { + result = open_semihosting(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = sh_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } + } + return result; +} + + +/* Try to load BL33 from Firmware Image Package in FLASH first. If there is no + * FIP in FLASH or it is broken, try to load the file from semi-hosting. + */ +static int fvp_bl33_policy(io_dev_handle *dev_handle, void **image_spec) +{ + int result = IO_FAIL; + void *local_image_spec = &bl33_file_spec; + + INFO("Loading BL33 (UEFI)\n"); + /* FIP first then fall back to semi-hosting */ + result = open_fip(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = fip_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } else { + result = open_semihosting(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = sh_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } + } + return result; +} + -/* Set up the IO devices present on this platform, ready for use */ -void io_setup(void) +/* Try to find FIP on NOR FLASH */ +static int fvp_fip_policy(io_dev_handle *dev_handle, void **image_spec) { + int result = IO_FAIL; + void *local_image_spec = &fip_block_spec; + + result = open_memmap(local_image_spec); + if (result == IO_SUCCESS) { + *dev_handle = memmap_dev_handle; + *(io_file_spec **)image_spec = local_image_spec; + } + return result; +} + + +void io_setup (void) +{ + int io_result = IO_FAIL; + /* Initialise the IO layer */ io_init(&io_data); - /* Register a semi-hosting device */ - int io_result = register_io_dev_sh(&sh_dev_con); + /* Register the IO devices on this platform */ + io_result = register_io_dev_sh(&sh_dev_con); + assert(io_result == IO_SUCCESS); + + io_result = register_io_dev_fip(&fip_dev_con); + assert(io_result == IO_SUCCESS); + + io_result = register_io_dev_memmap(&memmap_dev_con); assert(io_result == IO_SUCCESS); - /* Open a connection to the semi-hosting device and cache the handle */ + /* Open connections to devices and cache the handles */ io_result = io_dev_open(sh_dev_con, sh_dev_spec, &sh_dev_handle); assert(io_result == IO_SUCCESS); + io_result = io_dev_open(fip_dev_con, fip_dev_spec, &fip_dev_handle); + assert(io_result == IO_SUCCESS); + + io_result = io_dev_open(memmap_dev_con, memmap_dev_spec, + &memmap_dev_handle); + assert(io_result == IO_SUCCESS); + /* Ignore improbable errors in release builds */ (void)io_result; } /* Return an IO device handle and specification which can be used to access - * an image */ + * an image. Use this to enforce platform load policy */ int plat_get_image_source(const char *image_name, io_dev_handle *dev_handle, - void **image_spec) + void **image_spec) { int result = IO_FAIL; - assert((image_name != NULL) && (dev_handle != NULL) && - (image_spec != NULL)); + plat_io_policy *policy; - if (strcmp(BL2_IMAGE_NAME, image_name) == 0) { - result = io_dev_init(sh_dev_handle, sh_init_params); - if (result == IO_SUCCESS) { - *dev_handle = sh_dev_handle; - *(io_file_spec **)image_spec = &bl2_image_spec; - } - } else if (strcmp(BL31_IMAGE_NAME, image_name) == 0) { - result = io_dev_init(sh_dev_handle, sh_init_params); - if (result == IO_SUCCESS) { - *dev_handle = sh_dev_handle; - *(io_file_spec **)image_spec = &bl31_image_spec; - } - } else - assert(0); + assert(image_name != NULL); + assert(dev_handle != NULL); + assert(image_spec != NULL); + policy = fvp_policy; + while ((policy->image_name != NULL) && + (policy->image_policy != NULL)) { + result = strcmp(policy->image_name, image_name); + if (result == 0) { + result = policy->image_policy(dev_handle, image_spec); + break; + } + policy++; + } return result; } diff --git a/plat/fvp/platform.h b/plat/fvp/platform.h index ece882f..a12a094 100644 --- a/plat/fvp/platform.h +++ b/plat/fvp/platform.h @@ -50,9 +50,19 @@ #define PLATFORM_STACK_SIZE 0x800 #define FIRMWARE_WELCOME_STR "Booting trusted firmware boot loader stage 1\n\r" + +/* Trusted Boot Firmware BL2 */ #define BL2_IMAGE_NAME "bl2.bin" -#define BL31_IMAGE_NAME "bl31.bin" -#define NS_IMAGE_OFFSET FLASH0_BASE +/* EL3 Runtime Firmware BL31 */ +#define BL31_IMAGE_NAME "bl31.bin" +/* Secure Payload BL32 (Trusted OS) */ +#define BL32_IMAGE_NAME "bl32.bin" +/* Non-Trusted Firmware BL33 and its load address */ +#define BL33_IMAGE_NAME "bl33.bin" /* e.g. UEFI */ +#define NS_IMAGE_OFFSET (DRAM_BASE + 0x8000000) /* DRAM + 128MB */ +/* Firmware Image Package */ +#define FIP_IMAGE_NAME "fip.bin" + #define PLATFORM_CACHE_LINE_SIZE 64 #define PLATFORM_CLUSTER_COUNT 2ull @@ -62,7 +72,7 @@ PLATFORM_CLUSTER0_CORE_COUNT) #define PLATFORM_MAX_CPUS_PER_CLUSTER 4 #define PRIMARY_CPU 0x0 -#define MAX_IO_DEVICES 1 +#define MAX_IO_DEVICES 3 #define MAX_IO_HANDLES 4 /* Constants for accessing platform configuration */ @@ -215,7 +225,7 @@ /******************************************************************************* * BL2 specific defines. ******************************************************************************/ -#define BL2_BASE 0x0402C000 +#define BL2_BASE 0x0402B000 /******************************************************************************* * BL31 specific defines. diff --git a/plat/fvp/platform.mk b/plat/fvp/platform.mk index 2efc7bc..cd7faa5 100644 --- a/plat/fvp/platform.mk +++ b/plat/fvp/platform.mk @@ -63,7 +63,9 @@ PLAT_BL_COMMON_OBJS := semihosting_call.o \ semihosting.o \ sysreg_helpers.o \ plat_io_storage.o \ - io_semihosting.o + io_semihosting.o \ + io_fip.o \ + io_memmap.o BL1_OBJS += bl1_plat_setup.o \ bl1_plat_helpers.o \ |