Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 1 | /* |
Olivier Deprez | 6baf5b8 | 2021-05-14 19:04:40 +0200 | [diff] [blame] | 2 | * Copyright (c) 2018-2022, Arm Limited. All rights reserved. |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include <assert.h> |
| 8 | #include <debug.h> |
| 9 | #include <errno.h> |
| 10 | #include <ffa_helpers.h> |
Olivier Deprez | 2765ebf | 2020-12-16 15:46:14 +0100 | [diff] [blame] | 11 | #include <sp_debug.h> |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 12 | |
| 13 | #include "ivy.h" |
| 14 | |
| 15 | /* Host machine information injected by the build system in the ELF file. */ |
| 16 | extern const char build_message[]; |
| 17 | extern const char version_string[]; |
| 18 | |
| 19 | void __dead2 ivy_main(void) |
| 20 | { |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 21 | struct ffa_value ret; |
Olivier Deprez | 6baf5b8 | 2021-05-14 19:04:40 +0200 | [diff] [blame] | 22 | ffa_id_t my_id; |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 23 | |
Olivier Deprez | 2765ebf | 2020-12-16 15:46:14 +0100 | [diff] [blame] | 24 | set_putc_impl(SVC_CALL_AS_STDOUT); |
| 25 | |
Olivier Deprez | 6baf5b8 | 2021-05-14 19:04:40 +0200 | [diff] [blame] | 26 | /* Get FF-A id. */ |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 27 | ret = ffa_id_get(); |
| 28 | if (ffa_func_id(ret) != FFA_SUCCESS_SMC32) { |
Olivier Deprez | 6baf5b8 | 2021-05-14 19:04:40 +0200 | [diff] [blame] | 29 | ERROR("Cannot get FF-A id.\n"); |
| 30 | panic(); |
| 31 | } |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 32 | my_id = ffa_endpoint_id(ret); |
Olivier Deprez | 24bd170 | 2021-10-05 14:35:17 +0200 | [diff] [blame] | 33 | |
Olivier Deprez | 6baf5b8 | 2021-05-14 19:04:40 +0200 | [diff] [blame] | 34 | NOTICE("Booting Secure Partition (ID: %x)\n", my_id); |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 35 | NOTICE("%s\n", build_message); |
| 36 | NOTICE("%s\n", version_string); |
| 37 | |
| 38 | init: |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 39 | ret = ffa_msg_wait(); |
Olivier Deprez | 2765ebf | 2020-12-16 15:46:14 +0100 | [diff] [blame] | 40 | |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 41 | while (1) { |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 42 | if (ffa_func_id(ret) != FFA_MSG_SEND_DIRECT_REQ_SMC32) { |
| 43 | ERROR("unknown FF-A request %x\n", ffa_func_id(ret)); |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 44 | goto init; |
| 45 | } |
Olivier Deprez | 2765ebf | 2020-12-16 15:46:14 +0100 | [diff] [blame] | 46 | |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 47 | VERBOSE("Received request: %lx\n", ret.ret3); |
Olivier Deprez | 2765ebf | 2020-12-16 15:46:14 +0100 | [diff] [blame] | 48 | |
Daniel Boulby | ce386b1 | 2022-03-29 18:36:36 +0100 | [diff] [blame^] | 49 | ret = ffa_msg_send_direct_resp32(my_id, ffa_dir_msg_source(ret), |
| 50 | 0, 0, 0, 0, 0); |
Ruari Phipps | 1925b2a | 2020-09-10 14:05:55 +0100 | [diff] [blame] | 51 | } |
| 52 | } |