Marc Bonnici | 35248f1 | 2021-08-19 14:42:19 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2022, ARM Limited and Contributors. All rights reserved. |
| 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include <common/debug.h> |
| 8 | #include <services/el3_spmc_logical_sp.h> |
| 9 | #include <services/ffa_svc.h> |
| 10 | #include <smccc_helpers.h> |
| 11 | |
| 12 | #define LP_PARTITION_ID 0xC001 |
| 13 | #define LP_UUID {0x47a3bf57, 0xe98e43ad, 0xb7db524f, 0x1588f4e3} |
| 14 | |
| 15 | /* Our Logical SP currently only supports receipt of direct messaging. */ |
| 16 | #define PARTITION_PROPERTIES FFA_PARTITION_DIRECT_REQ_RECV |
| 17 | |
| 18 | static int32_t sp_init(void) |
| 19 | { |
| 20 | INFO("LSP: Init function called.\n"); |
| 21 | return 0; |
| 22 | } |
| 23 | |
| 24 | static uint64_t handle_ffa_direct_request(uint32_t smc_fid, bool secure_origin, |
| 25 | uint64_t x1, uint64_t x2, uint64_t x3, |
| 26 | uint64_t x4, void *cookie, |
| 27 | void *handle, uint64_t flags) |
| 28 | { |
| 29 | uint64_t ret; |
| 30 | |
| 31 | /* Determine if we have a 64 or 32 direct request. */ |
| 32 | if (smc_fid == FFA_MSG_SEND_DIRECT_REQ_SMC32) { |
| 33 | ret = FFA_MSG_SEND_DIRECT_RESP_SMC32; |
| 34 | } else if (smc_fid == FFA_MSG_SEND_DIRECT_REQ_SMC64) { |
| 35 | ret = FFA_MSG_SEND_DIRECT_RESP_SMC64; |
| 36 | } else { |
| 37 | panic(); /* Unknown SMC. */ |
| 38 | } |
| 39 | /* |
| 40 | * Handle the incoming request. For testing purposes we echo the |
| 41 | * incoming message. |
| 42 | */ |
| 43 | INFO("Logical Partition: Received Direct Request from %s world!\n", |
| 44 | secure_origin ? "Secure" : "Normal"); |
| 45 | |
| 46 | /* |
| 47 | * Logical SP's must always send a direct response so we can populate |
| 48 | * our response directly. |
| 49 | */ |
| 50 | SMC_RET8(handle, ret, 0, 0, x4, 0, 0, 0, 0); |
| 51 | } |
| 52 | |
| 53 | /* Register logical partition */ |
| 54 | DECLARE_LOGICAL_PARTITION( |
| 55 | my_logical_partition, |
| 56 | sp_init, /* Init Function */ |
| 57 | LP_PARTITION_ID, /* FF-A Partition ID */ |
| 58 | LP_UUID, /* UUID */ |
| 59 | PARTITION_PROPERTIES, /* Partition Properties. */ |
| 60 | handle_ffa_direct_request /* Callback for direct requests. */ |
| 61 | ); |