mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-17 01:54:22 +00:00
c040621dba
Ensure that the example LSP correctly sets the sender/receiver field in a direct response. Signed-off-by: Marc Bonnici <marc.bonnici@arm.com> Change-Id: I482c08d4657617adb00b0f3cf3c8ddc84f1bf7c8
66 lines
1.9 KiB
C
66 lines
1.9 KiB
C
/*
|
|
* Copyright (c) 2022, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <common/debug.h>
|
|
#include <services/el3_spmc_logical_sp.h>
|
|
#include <services/ffa_svc.h>
|
|
#include <smccc_helpers.h>
|
|
|
|
#define LP_PARTITION_ID 0xC001
|
|
#define LP_UUID {0x47a3bf57, 0xe98e43ad, 0xb7db524f, 0x1588f4e3}
|
|
|
|
/* Our Logical SP currently only supports receipt of direct messaging. */
|
|
#define PARTITION_PROPERTIES FFA_PARTITION_DIRECT_REQ_RECV
|
|
|
|
static int32_t sp_init(void)
|
|
{
|
|
INFO("LSP: Init function called.\n");
|
|
return 0;
|
|
}
|
|
|
|
static uint64_t handle_ffa_direct_request(uint32_t smc_fid, bool secure_origin,
|
|
uint64_t x1, uint64_t x2, uint64_t x3,
|
|
uint64_t x4, void *cookie,
|
|
void *handle, uint64_t flags)
|
|
{
|
|
uint64_t ret;
|
|
uint32_t src_dst;
|
|
|
|
/* Determine if we have a 64 or 32 direct request. */
|
|
if (smc_fid == FFA_MSG_SEND_DIRECT_REQ_SMC32) {
|
|
ret = FFA_MSG_SEND_DIRECT_RESP_SMC32;
|
|
} else if (smc_fid == FFA_MSG_SEND_DIRECT_REQ_SMC64) {
|
|
ret = FFA_MSG_SEND_DIRECT_RESP_SMC64;
|
|
} else {
|
|
panic(); /* Unknown SMC. */
|
|
}
|
|
|
|
/*
|
|
* Handle the incoming request. For testing purposes we echo the
|
|
* incoming message.
|
|
*/
|
|
INFO("LSP: Received Direct Request from %s world (0x%x)\n",
|
|
secure_origin ? "Secure" : "Normal", ffa_endpoint_source(x1));
|
|
|
|
/* Populate the source and destination IDs. */
|
|
src_dst = (uint32_t) LP_PARTITION_ID << FFA_DIRECT_MSG_SOURCE_SHIFT |
|
|
ffa_endpoint_source(x1) << FFA_DIRECT_MSG_DESTINATION_SHIFT;
|
|
/*
|
|
* Logical SP's must always send a direct response so we can populate
|
|
* our response directly.
|
|
*/
|
|
SMC_RET8(handle, ret, src_dst, 0, x4, 0, 0, 0, 0);
|
|
}
|
|
|
|
/* Register logical partition */
|
|
DECLARE_LOGICAL_PARTITION(
|
|
my_logical_partition,
|
|
sp_init, /* Init Function */
|
|
LP_PARTITION_ID, /* FF-A Partition ID */
|
|
LP_UUID, /* UUID */
|
|
PARTITION_PROPERTIES, /* Partition Properties. */
|
|
handle_ffa_direct_request /* Callback for direct requests. */
|
|
);
|