Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the coreboot project. |
| 3 | * |
| 4 | * Copyright 2015 Google Inc. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; version 2 of the License. |
| 9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 13 | * GNU General Public License for more details. |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | #include <arch/cache.h> |
Furquan Shaikh | a384c28 | 2015-05-28 12:13:51 -0700 | [diff] [blame] | 17 | #include <arch/lib_helpers.h> |
Julius Werner | fe4cbf1 | 2015-10-07 18:38:24 -0700 | [diff] [blame] | 18 | #include <arch/mmu.h> |
Furquan Shaikh | a384c28 | 2015-05-28 12:13:51 -0700 | [diff] [blame] | 19 | #include <arch/transition.h> |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 20 | #include <arm_tf.h> |
| 21 | #include <assert.h> |
| 22 | #include <cbfs.h> |
| 23 | #include <cbmem.h> |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 24 | #include <program_loading.h> |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 25 | |
| 26 | /* |
| 27 | * TODO: Many of these structures are currently unused. Better not fill them out |
| 28 | * to make future changes fail fast, rather than try to come up with content |
| 29 | * that might turn out to not make sense. Implement later as required. |
| 30 | * |
| 31 | static image_info_t bl31_image_info; |
| 32 | static image_info_t bl32_image_info; |
| 33 | static image_info_t bl33_image_info; |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 34 | */ |
Furquan Shaikh | a384c28 | 2015-05-28 12:13:51 -0700 | [diff] [blame] | 35 | static entry_point_info_t bl32_ep_info; |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 36 | static entry_point_info_t bl33_ep_info; |
| 37 | static bl31_params_t bl31_params; |
| 38 | |
Furquan Shaikh | 49d3066 | 2015-05-20 11:03:50 -0700 | [diff] [blame] | 39 | void __attribute__((weak)) *soc_get_bl31_plat_params(bl31_params_t *params) |
| 40 | { |
| 41 | /* Default weak implementation. */ |
| 42 | return NULL; |
| 43 | } |
| 44 | |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 45 | void arm_tf_run_bl31(u64 payload_entry, u64 payload_arg0, u64 payload_spsr) |
| 46 | { |
Aaron Durbin | 7e7a4df | 2015-12-08 14:34:35 -0600 | [diff] [blame] | 47 | struct prog bl31 = PROG_INIT(PROG_BL31, CONFIG_CBFS_PREFIX"/bl31"); |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 48 | void (*bl31_entry)(bl31_params_t *params, void *plat_params) = NULL; |
| 49 | |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 50 | if (prog_locate(&bl31)) |
| 51 | die("BL31 not found"); |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 52 | |
Aaron Durbin | 899d13d | 2015-05-15 23:39:23 -0500 | [diff] [blame] | 53 | if (cbfs_prog_stage_load(&bl31)) |
| 54 | die("BL31 load failed"); |
| 55 | |
| 56 | bl31_entry = prog_entry(&bl31); |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 57 | |
| 58 | SET_PARAM_HEAD(&bl31_params, PARAM_BL31, VERSION_1, 0); |
Furquan Shaikh | a384c28 | 2015-05-28 12:13:51 -0700 | [diff] [blame] | 59 | |
| 60 | if (IS_ENABLED(CONFIG_ARM64_USE_SECURE_OS)) { |
Aaron Durbin | 7e7a4df | 2015-12-08 14:34:35 -0600 | [diff] [blame] | 61 | struct prog bl32 = PROG_INIT(PROG_BL32, CONFIG_CBFS_PREFIX"/secure_os"); |
Furquan Shaikh | a384c28 | 2015-05-28 12:13:51 -0700 | [diff] [blame] | 62 | |
| 63 | if (prog_locate(&bl32)) |
| 64 | die("BL31 not found"); |
| 65 | |
| 66 | if (cbfs_prog_stage_load(&bl32)) |
| 67 | die("BL31 load failed"); |
| 68 | |
| 69 | SET_PARAM_HEAD(&bl32_ep_info, PARAM_EP, VERSION_1, PARAM_EP_SECURE); |
| 70 | bl32_ep_info.pc = (uintptr_t)prog_entry(&bl32); |
| 71 | bl32_ep_info.spsr = SPSR_EXCEPTION_MASK | get_eret_el(EL1, SPSR_USE_L); |
| 72 | bl31_params.bl32_ep_info = &bl32_ep_info; |
| 73 | } |
| 74 | |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 75 | bl31_params.bl33_ep_info = &bl33_ep_info; |
| 76 | |
| 77 | SET_PARAM_HEAD(&bl33_ep_info, PARAM_EP, VERSION_1, PARAM_EP_NON_SECURE); |
| 78 | bl33_ep_info.pc = payload_entry; |
| 79 | bl33_ep_info.spsr = payload_spsr; |
| 80 | bl33_ep_info.args.arg0 = payload_arg0; |
| 81 | |
| 82 | /* May update bl31_params if necessary. Must flush all added structs. */ |
| 83 | void *bl31_plat_params = soc_get_bl31_plat_params(&bl31_params); |
| 84 | |
| 85 | dcache_clean_by_mva(&bl31_params, sizeof(bl31_params)); |
| 86 | dcache_clean_by_mva(&bl33_ep_info, sizeof(bl33_ep_info)); |
Julius Werner | 3834520 | 2016-02-01 19:47:10 -0800 | [diff] [blame] | 87 | raw_write_daif(SPSR_EXCEPTION_MASK); |
Julius Werner | fe4cbf1 | 2015-10-07 18:38:24 -0700 | [diff] [blame] | 88 | mmu_disable(); |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 89 | bl31_entry(&bl31_params, bl31_plat_params); |
| 90 | die("BL31 returned!"); |
| 91 | } |