Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the coreboot project. |
| 3 | * |
| 4 | * Copyright 2013 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. |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | #include <arch/cache.h> |
Furquan Shaikh | 441df53 | 2014-09-11 16:06:01 -0700 | [diff] [blame] | 17 | #include <arch/lib_helpers.h> |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 18 | #include <arch/stages.h> |
Furquan Shaikh | 441df53 | 2014-09-11 16:06:01 -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 <cbmem.h> |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 22 | #include <console/console.h> |
Aaron Durbin | 04654a2 | 2015-03-17 11:43:44 -0500 | [diff] [blame] | 23 | #include <program_loading.h> |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 24 | #include <rules.h> |
Furquan Shaikh | 441df53 | 2014-09-11 16:06:01 -0700 | [diff] [blame] | 25 | #include <string.h> |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 26 | |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 27 | static void run_payload(struct prog *prog) |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 28 | { |
Aaron Durbin | 3948e53 | 2015-03-20 13:00:20 -0500 | [diff] [blame] | 29 | void (*doit)(void *); |
| 30 | void *arg; |
Furquan Shaikh | abde3b5 | 2014-08-26 15:39:51 -0700 | [diff] [blame] | 31 | |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 32 | doit = prog_entry(prog); |
| 33 | arg = prog_entry_arg(prog); |
Julius Werner | da3a146 | 2015-05-13 11:19:33 -0700 | [diff] [blame] | 34 | u64 payload_spsr = SPSR_EXCEPTION_MASK | get_eret_el(EL2, SPSR_USE_L); |
Aaron Durbin | 3948e53 | 2015-03-20 13:00:20 -0500 | [diff] [blame] | 35 | |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 36 | if (IS_ENABLED(CONFIG_ARM64_USE_ARM_TRUSTED_FIRMWARE)) |
| 37 | arm_tf_run_bl31((u64)doit, (u64)arg, payload_spsr); |
Julius Werner | 786b122 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 38 | else { |
Julius Werner | f52602a | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 39 | uint8_t current_el = get_current_el(); |
| 40 | |
Julius Werner | 883ec98 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 41 | cache_sync_instructions(); |
| 42 | |
Julius Werner | f52602a | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 43 | printk(BIOS_SPEW, "entry = %p\n", doit); |
| 44 | |
Julius Werner | 786b122 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 45 | /* If current EL is not EL3, jump to payload at same EL. */ |
Julius Werner | bbca3a9 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 46 | if (current_el != EL3) |
Julius Werner | 786b122 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 47 | doit(arg); |
Julius Werner | bbca3a9 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 48 | else { |
| 49 | /* If current EL is EL3, we transition to payload in EL2. */ |
| 50 | struct exc_state exc_state; |
| 51 | memset(&exc_state, 0, sizeof(exc_state)); |
Julius Werner | 745a75f | 2015-05-11 16:45:56 -0700 | [diff] [blame] | 52 | exc_state.elx.spsr = payload_spsr; |
Julius Werner | bbca3a9 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 53 | |
| 54 | transition_with_entry(doit, arg, &exc_state); |
Julius Werner | 786b122 | 2015-05-07 16:59:31 -0700 | [diff] [blame] | 55 | } |
Furquan Shaikh | 441df53 | 2014-09-11 16:06:01 -0700 | [diff] [blame] | 56 | } |
Furquan Shaikh | 2af76f4 | 2014-04-28 16:39:40 -0700 | [diff] [blame] | 57 | } |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 58 | |
| 59 | void arch_prog_run(struct prog *prog) |
| 60 | { |
| 61 | void (*doit)(void *); |
| 62 | void *arg; |
| 63 | |
Aaron Durbin | ac12c66c | 2015-05-20 12:08:55 -0500 | [diff] [blame] | 64 | if (ENV_RAMSTAGE && prog_type(prog) == ASSET_PAYLOAD) { |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 65 | run_payload(prog); |
| 66 | return; |
Paul Menzel | 9484f55 | 2015-04-05 18:30:05 +0200 | [diff] [blame] | 67 | } |
Aaron Durbin | b3847e6 | 2015-03-20 15:55:08 -0500 | [diff] [blame] | 68 | |
| 69 | doit = prog_entry(prog); |
| 70 | arg = prog_entry_arg(prog); |
| 71 | |
| 72 | doit(prog_entry_arg(prog)); |
| 73 | } |
Julius Werner | 66a476a | 2015-10-12 16:45:21 -0700 | [diff] [blame^] | 74 | |
| 75 | #if !IS_ENABLED(CONFIG_SOC_NVIDIA_TEGRA132) |
| 76 | /* Generic stage entry point. Can be overridden by board/SoC if needed. */ |
| 77 | __attribute__((weak)) void stage_entry(void) |
| 78 | { |
| 79 | main(); |
| 80 | } |
| 81 | #endif |