Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 1 | /* |
Antonio Nino Diaz | e0f21f6 | 2018-03-27 09:39:47 +0100 | [diff] [blame] | 2 | * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved. |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 7 | #include <assert.h> |
Antonio Nino Diaz | 09d40e0 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 8 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 9 | #include <platform_def.h> |
Antonio Nino Diaz | 09d40e0 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 10 | |
| 11 | #include <arch_helpers.h> |
| 12 | #include <common/bl_common.h> |
| 13 | #include <common/debug.h> |
| 14 | #include <common/desc_image_load.h> |
| 15 | #include <lib/optee_utils.h> |
| 16 | #include <lib/xlat_tables/xlat_mmu_helpers.h> |
| 17 | #include <lib/xlat_tables/xlat_tables_defs.h> |
Ying-Chun Liu (PaulLiu) | 2be86dd | 2019-01-22 03:27:55 +0800 | [diff] [blame] | 18 | #include <drivers/generic_delay_timer.h> |
| 19 | #include <drivers/rpi3/gpio/rpi3_gpio.h> |
Ying-Chun Liu (PaulLiu) | 968377f | 2019-01-30 04:20:38 +0800 | [diff] [blame] | 20 | #include <drivers/rpi3/sdhost/rpi3_sdhost.h> |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 21 | |
| 22 | #include "rpi3_private.h" |
| 23 | |
| 24 | /* Data structure which holds the extents of the trusted SRAM for BL2 */ |
| 25 | static meminfo_t bl2_tzram_layout __aligned(CACHE_WRITEBACK_GRANULE); |
| 26 | |
Ying-Chun Liu (PaulLiu) | 2be86dd | 2019-01-22 03:27:55 +0800 | [diff] [blame] | 27 | /* rpi3 GPIO setup function. */ |
| 28 | static void rpi3_gpio_setup(void) |
| 29 | { |
| 30 | struct rpi3_gpio_params params; |
| 31 | |
| 32 | memset(¶ms, 0, sizeof(struct rpi3_gpio_params)); |
| 33 | params.reg_base = RPI3_GPIO_BASE; |
| 34 | |
| 35 | rpi3_gpio_init(¶ms); |
| 36 | } |
| 37 | |
Ying-Chun Liu (PaulLiu) | 968377f | 2019-01-30 04:20:38 +0800 | [diff] [blame] | 38 | /* Data structure which holds the MMC info */ |
| 39 | static struct mmc_device_info mmc_info; |
| 40 | |
| 41 | static void rpi3_sdhost_setup(void) |
| 42 | { |
| 43 | struct rpi3_sdhost_params params; |
| 44 | |
| 45 | memset(¶ms, 0, sizeof(struct rpi3_sdhost_params)); |
| 46 | params.reg_base = RPI3_SDHOST_BASE; |
Ying-Chun Liu (PaulLiu) | 2c8ef2a | 2019-02-12 22:41:06 +0800 | [diff] [blame] | 47 | params.bus_width = MMC_BUS_WIDTH_1; |
| 48 | params.clk_rate = 50000000; |
Ying-Chun Liu (PaulLiu) | 968377f | 2019-01-30 04:20:38 +0800 | [diff] [blame] | 49 | mmc_info.mmc_dev_type = MMC_IS_SD_HC; |
| 50 | rpi3_sdhost_init(¶ms, &mmc_info); |
| 51 | } |
| 52 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 53 | /******************************************************************************* |
| 54 | * BL1 has passed the extents of the trusted SRAM that should be visible to BL2 |
| 55 | * in x0. This memory layout is sitting at the base of the free trusted SRAM. |
| 56 | * Copy it to a safe location before its reclaimed by later BL2 functionality. |
| 57 | ******************************************************************************/ |
Antonio Nino Diaz | 941a624 | 2018-08-17 14:25:08 +0100 | [diff] [blame] | 58 | |
| 59 | void bl2_early_platform_setup2(u_register_t arg0, u_register_t arg1, |
| 60 | u_register_t arg2, u_register_t arg3) |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 61 | { |
Antonio Nino Diaz | 941a624 | 2018-08-17 14:25:08 +0100 | [diff] [blame] | 62 | meminfo_t *mem_layout = (meminfo_t *) arg1; |
| 63 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 64 | /* Initialize the console to provide early debug support */ |
Antonio Nino Diaz | e0f21f6 | 2018-03-27 09:39:47 +0100 | [diff] [blame] | 65 | rpi3_console_init(); |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 66 | |
Ying-Chun Liu (PaulLiu) | 2be86dd | 2019-01-22 03:27:55 +0800 | [diff] [blame] | 67 | /* Enable arch timer */ |
| 68 | generic_delay_timer_init(); |
| 69 | |
| 70 | /* Setup GPIO driver */ |
| 71 | rpi3_gpio_setup(); |
| 72 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 73 | /* Setup the BL2 memory layout */ |
| 74 | bl2_tzram_layout = *mem_layout; |
| 75 | |
Ying-Chun Liu (PaulLiu) | 968377f | 2019-01-30 04:20:38 +0800 | [diff] [blame] | 76 | /* Setup SDHost driver */ |
| 77 | rpi3_sdhost_setup(); |
| 78 | |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 79 | plat_rpi3_io_setup(); |
| 80 | } |
| 81 | |
| 82 | void bl2_platform_setup(void) |
| 83 | { |
| 84 | /* |
| 85 | * This is where a TrustZone address space controller and other |
Antonio Nino Diaz | e0f21f6 | 2018-03-27 09:39:47 +0100 | [diff] [blame] | 86 | * security related peripherals would be configured. |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 87 | */ |
| 88 | } |
| 89 | |
| 90 | /******************************************************************************* |
| 91 | * Perform the very early platform specific architectural setup here. |
| 92 | ******************************************************************************/ |
| 93 | void bl2_plat_arch_setup(void) |
| 94 | { |
| 95 | rpi3_setup_page_tables(bl2_tzram_layout.total_base, |
| 96 | bl2_tzram_layout.total_size, |
| 97 | BL_CODE_BASE, BL_CODE_END, |
| 98 | BL_RO_DATA_BASE, BL_RO_DATA_END |
| 99 | #if USE_COHERENT_MEM |
| 100 | , BL_COHERENT_RAM_BASE, BL_COHERENT_RAM_END |
| 101 | #endif |
| 102 | ); |
| 103 | |
| 104 | enable_mmu_el1(0); |
| 105 | } |
| 106 | |
| 107 | /******************************************************************************* |
| 108 | * This function can be used by the platforms to update/use image |
| 109 | * information for given `image_id`. |
| 110 | ******************************************************************************/ |
| 111 | int bl2_plat_handle_post_image_load(unsigned int image_id) |
| 112 | { |
| 113 | int err = 0; |
| 114 | bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id); |
Ying-Chun Liu (PaulLiu) | 7812aba | 2018-06-10 02:00:27 +0800 | [diff] [blame] | 115 | #ifdef SPD_opteed |
| 116 | bl_mem_params_node_t *pager_mem_params = NULL; |
| 117 | bl_mem_params_node_t *paged_mem_params = NULL; |
| 118 | #endif |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 119 | |
| 120 | assert(bl_mem_params != NULL); |
| 121 | |
| 122 | switch (image_id) { |
| 123 | case BL32_IMAGE_ID: |
Ying-Chun Liu (PaulLiu) | 7812aba | 2018-06-10 02:00:27 +0800 | [diff] [blame] | 124 | #ifdef SPD_opteed |
| 125 | pager_mem_params = get_bl_mem_params_node(BL32_EXTRA1_IMAGE_ID); |
| 126 | assert(pager_mem_params); |
| 127 | |
| 128 | paged_mem_params = get_bl_mem_params_node(BL32_EXTRA2_IMAGE_ID); |
| 129 | assert(paged_mem_params); |
| 130 | |
| 131 | err = parse_optee_header(&bl_mem_params->ep_info, |
| 132 | &pager_mem_params->image_info, |
| 133 | &paged_mem_params->image_info); |
| 134 | if (err != 0) |
| 135 | WARN("OPTEE header parse error.\n"); |
| 136 | #endif |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 137 | bl_mem_params->ep_info.spsr = rpi3_get_spsr_for_bl32_entry(); |
| 138 | break; |
| 139 | |
| 140 | case BL33_IMAGE_ID: |
| 141 | /* BL33 expects to receive the primary CPU MPID (through r0) */ |
| 142 | bl_mem_params->ep_info.args.arg0 = 0xffff & read_mpidr(); |
| 143 | bl_mem_params->ep_info.spsr = rpi3_get_spsr_for_bl33_entry(); |
Ying-Chun Liu (PaulLiu) | 968377f | 2019-01-30 04:20:38 +0800 | [diff] [blame] | 144 | |
| 145 | /* Shutting down the SDHost driver to let BL33 drives SDHost.*/ |
| 146 | rpi3_sdhost_stop(); |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 147 | break; |
| 148 | |
Jonathan Wright | 649c48f | 2018-03-14 15:24:00 +0000 | [diff] [blame] | 149 | default: |
| 150 | /* Do nothing in default case */ |
| 151 | break; |
Antonio Nino Diaz | d83c1db | 2017-11-06 14:49:04 +0000 | [diff] [blame] | 152 | } |
| 153 | |
| 154 | return err; |
| 155 | } |