Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: BSD-3-Clause |
| 2 | /* |
Balint Dobszay | 1b631eb | 2021-01-15 11:09:36 +0100 | [diff] [blame] | 3 | * Copyright (c) 2020-2021, Arm Limited and Contributors. All rights reserved. |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 4 | */ |
| 5 | |
julhal01 | 3a4207d | 2021-03-08 13:32:08 +0000 | [diff] [blame] | 6 | |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 7 | #include <rpc/ffarpc/endpoint/ffarpc_call_ep.h> |
julhal01 | 3a4207d | 2021-03-08 13:32:08 +0000 | [diff] [blame] | 8 | #include <service/secure_storage/factory/storage_factory.h> |
Julian Hall | 7bfb18e | 2021-07-13 15:48:13 +0100 | [diff] [blame] | 9 | #include <service/crypto/factory/crypto_provider_factory.h> |
Julian Hall | 9061e6c | 2021-06-29 14:24:20 +0100 | [diff] [blame] | 10 | #include <service/crypto/backend/mbedcrypto/mbedcrypto_backend.h> |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 11 | #include <protocols/rpc/common/packed-c/status.h> |
julhal01 | 37e1aea | 2021-02-09 15:22:20 +0000 | [diff] [blame] | 12 | #include <config/ramstore/config_ramstore.h> |
| 13 | #include <config/loader/sp/sp_config_loader.h> |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 14 | #include <ffa_api.h> |
| 15 | #include <sp_api.h> |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 16 | #include <sp_messaging.h> |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 17 | #include <sp_rxtx.h> |
| 18 | #include <trace.h> |
| 19 | |
| 20 | |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 21 | uint16_t own_id = 0; /* !!Needs refactoring as parameter to ffarpc_caller_init */ |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 22 | |
| 23 | |
| 24 | static int sp_init(uint16_t *own_sp_id); |
| 25 | |
| 26 | void __noreturn sp_main(struct ffa_init_info *init_info) |
| 27 | { |
Julian Hall | 7bfb18e | 2021-07-13 15:48:13 +0100 | [diff] [blame] | 28 | struct crypto_provider *crypto_provider; |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 29 | struct ffa_call_ep ffarpc_call_ep; |
julhal01 | c3f4e9a | 2020-12-15 13:39:01 +0000 | [diff] [blame] | 30 | struct rpc_interface *crypto_iface; |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 31 | struct sp_msg req_msg = { 0 }; |
| 32 | struct sp_msg resp_msg = { 0 }; |
julhal01 | 3a4207d | 2021-03-08 13:32:08 +0000 | [diff] [blame] | 33 | struct storage_backend *storage_backend; |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 34 | |
julhal01 | 3a4207d | 2021-03-08 13:32:08 +0000 | [diff] [blame] | 35 | /* Boot phase */ |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 36 | if (sp_init(&own_id) != 0) goto fatal_error; |
| 37 | |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 38 | config_ramstore_init(); |
julhal01 | 37e1aea | 2021-02-09 15:22:20 +0000 | [diff] [blame] | 39 | sp_config_load(init_info); |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 40 | |
julhal01 | 3a4207d | 2021-03-08 13:32:08 +0000 | [diff] [blame] | 41 | /* Create a storage backend for persistent key storage - prefer ITS */ |
| 42 | storage_backend = storage_factory_create(storage_factory_security_class_INTERNAL_TRUSTED); |
| 43 | if (!storage_backend) goto fatal_error; |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 44 | |
| 45 | /* Initialize the crypto service */ |
Julian Hall | 9061e6c | 2021-06-29 14:24:20 +0100 | [diff] [blame] | 46 | crypto_iface = NULL; |
julhal01 | 734dbad | 2020-12-21 10:27:41 +0000 | [diff] [blame] | 47 | |
Julian Hall | 7bfb18e | 2021-07-13 15:48:13 +0100 | [diff] [blame] | 48 | if (mbedcrypto_backend_init(storage_backend, 0) == PSA_SUCCESS) { |
Julian Hall | 9061e6c | 2021-06-29 14:24:20 +0100 | [diff] [blame] | 49 | |
Julian Hall | 7bfb18e | 2021-07-13 15:48:13 +0100 | [diff] [blame] | 50 | crypto_provider = crypto_provider_factory_create(); |
| 51 | crypto_iface = service_provider_get_rpc_interface(&crypto_provider->base_provider); |
Julian Hall | 9061e6c | 2021-06-29 14:24:20 +0100 | [diff] [blame] | 52 | } |
julhal01 | 734dbad | 2020-12-21 10:27:41 +0000 | [diff] [blame] | 53 | |
julhal01 | c3f4e9a | 2020-12-15 13:39:01 +0000 | [diff] [blame] | 54 | ffa_call_ep_init(&ffarpc_call_ep, crypto_iface); |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 55 | |
julhal01 | 1260f10 | 2021-02-15 17:34:08 +0000 | [diff] [blame] | 56 | /* End of boot phase */ |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 57 | sp_msg_wait(&req_msg); |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 58 | |
| 59 | while (1) { |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 60 | ffa_call_ep_receive(&ffarpc_call_ep, &req_msg, &resp_msg); |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 61 | |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 62 | resp_msg.source_id = req_msg.destination_id; |
| 63 | resp_msg.destination_id = req_msg.source_id; |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 64 | |
Imre Kis | 76e8a3c | 2021-04-16 16:54:17 +0200 | [diff] [blame] | 65 | sp_msg_send_direct_resp(&resp_msg, &req_msg); |
Julian Hall | 4061ed6 | 2020-11-23 18:24:06 +0100 | [diff] [blame] | 66 | } |
| 67 | |
| 68 | fatal_error: |
| 69 | /* SP is not viable */ |
| 70 | EMSG("Crypto SP error"); |
| 71 | while (1) {} |
| 72 | } |
| 73 | |
| 74 | void sp_interrupt_handler(uint32_t interrupt_id) |
| 75 | { |
| 76 | (void)interrupt_id; |
| 77 | } |
| 78 | |
| 79 | static int sp_init(uint16_t *own_sp_id) |
| 80 | { |
| 81 | int status = -1; |
| 82 | ffa_result ffa_res; |
| 83 | sp_result sp_res; |
| 84 | static uint8_t tx_buffer[4096] __aligned(4096); |
| 85 | static uint8_t rx_buffer[4096] __aligned(4096); |
| 86 | |
| 87 | sp_res = sp_rxtx_buffer_map(tx_buffer, rx_buffer, sizeof(rx_buffer)); |
| 88 | if (sp_res == SP_RESULT_OK) { |
| 89 | ffa_res = ffa_id_get(own_sp_id); |
| 90 | if (ffa_res == FFA_OK) { |
| 91 | status = 0; |
| 92 | } |
| 93 | } |
| 94 | |
| 95 | return status; |
| 96 | } |