J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2021 The Hafnium Authors. |
| 3 | * |
| 4 | * Use of this source code is governed by a BSD-style |
| 5 | * license that can be found in the LICENSE file or at |
| 6 | * https://opensource.org/licenses/BSD-3-Clause. |
| 7 | */ |
| 8 | |
| 9 | #include <stdalign.h> |
| 10 | #include <stdint.h> |
| 11 | |
| 12 | #include "hf/ffa.h" |
| 13 | #include "hf/mm.h" |
| 14 | #include "hf/std.h" |
| 15 | |
| 16 | #include "vmapi/hf/call.h" |
| 17 | |
J-Alves | 35e6192 | 2021-05-06 10:01:05 +0100 | [diff] [blame] | 18 | #include "test/abort.h" |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 19 | #include "test/hftest.h" |
Federico Recanati | 69c554b | 2022-03-14 15:48:28 +0100 | [diff] [blame] | 20 | #include "test/vmapi/ffa.h" |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 21 | |
J-Alves | ff7be1b | 2022-05-23 12:26:36 +0100 | [diff] [blame^] | 22 | static struct ffa_boot_info_header* boot_info_header; |
| 23 | |
| 24 | struct ffa_boot_info_header* get_boot_info_header(void) |
| 25 | { |
| 26 | return boot_info_header; |
| 27 | } |
| 28 | |
Olivier Deprez | 175161a | 2021-11-23 18:41:09 +0100 | [diff] [blame] | 29 | alignas(4096) uint8_t kstack[MAX_CPUS][4096]; |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 30 | |
Federico Recanati | 632fa14 | 2022-04-27 13:14:58 +0200 | [diff] [blame] | 31 | bool sel1_secure_service = true; |
| 32 | |
Olivier Deprez | 175161a | 2021-11-23 18:41:09 +0100 | [diff] [blame] | 33 | void test_main_sp(bool); |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 34 | |
J-Alves | ff7be1b | 2022-05-23 12:26:36 +0100 | [diff] [blame^] | 35 | noreturn void kmain(struct ffa_boot_info_header* boot_info_blob) |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 36 | { |
Olivier Deprez | 175161a | 2021-11-23 18:41:09 +0100 | [diff] [blame] | 37 | extern void secondary_ep_entry(void); |
| 38 | struct ffa_value res; |
| 39 | |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 40 | /* |
| 41 | * Initialize the stage-1 MMU and identity-map the entire address space. |
| 42 | */ |
| 43 | if (!hftest_mm_init()) { |
| 44 | HFTEST_LOG_FAILURE(); |
| 45 | HFTEST_LOG(HFTEST_LOG_INDENT "Memory initialization failed"); |
| 46 | abort(); |
| 47 | } |
| 48 | |
Olivier Deprez | 175161a | 2021-11-23 18:41:09 +0100 | [diff] [blame] | 49 | /* Register entry point for secondary vCPUs. */ |
| 50 | res = ffa_secondary_ep_register((uintptr_t)secondary_ep_entry); |
| 51 | EXPECT_EQ(res.func, FFA_SUCCESS_32); |
| 52 | |
J-Alves | ff7be1b | 2022-05-23 12:26:36 +0100 | [diff] [blame^] | 53 | boot_info_header = boot_info_blob; |
| 54 | |
Federico Recanati | 69c554b | 2022-03-14 15:48:28 +0100 | [diff] [blame] | 55 | /* Register RX/TX buffers via FFA_RXTX_MAP */ |
| 56 | set_up_mailbox(); |
| 57 | |
Olivier Deprez | 175161a | 2021-11-23 18:41:09 +0100 | [diff] [blame] | 58 | test_main_sp(true); |
J-Alves | 3388b0b | 2021-04-13 10:39:38 +0100 | [diff] [blame] | 59 | |
| 60 | /* Do not expect to get to this point, so abort. */ |
| 61 | abort(); |
| 62 | } |