blob: 1203521d4a2c0fe298758dc28c1ecdb77421f5f1 [file] [log] [blame]
// SPDX-License-Identifier: BSD-3-Clause
/*
* Copyright (c) 2021-2025, Arm Limited and Contributors. All rights reserved.
*/
#include "components/rpc/common/endpoint/rpc_service_interface.h"
#include "components/rpc/ts_rpc/endpoint/sp/ts_rpc_endpoint_sp.h"
#include "config/ramstore/config_ramstore.h"
#include "config/loader/sp/sp_config_loader.h"
#include "sp_api.h"
#include "sp_discovery.h"
#include "sp_rxtx.h"
#include "trace.h"
#include "deployments/se-proxy/env/commonsp/proxy_service_factory_list.h"
#include <stddef.h>
/*
* This must be a global variable so the communication layer (e.g. RSE_COMMS)
* can use this to remap message client_ids if needed.
*/
uint16_t own_id;
static bool sp_init(uint16_t *own_sp_id);
void __noreturn sp_main(union ffa_boot_info *boot_info)
{
struct ts_rpc_endpoint_sp rpc_endpoint = { 0 };
struct sp_msg req_msg = { 0 };
struct sp_msg resp_msg = { 0 };
struct rpc_service_interface *rpc_iface = NULL;
sp_result result = SP_RESULT_INTERNAL_ERROR;
rpc_status_t rpc_status = RPC_ERROR_INTERNAL;
unsigned int n_services = PROXY_SERVICE_FACTORY_LIST_LENGTH();
/* Two memory shares for each service, plus additional 6 extra slots. */
unsigned int n_shares = (n_services * 2) + 6;
const struct se_proxy_list_entry *service_factory_iterator = __proxy_service_factory_list;
/* Boot phase */
if (!sp_init(&own_id)) {
EMSG("Failed to init SP");
goto fatal_error;
}
config_ramstore_init();
if (!sp_config_load(boot_info)) {
EMSG("Failed to load SP config");
goto fatal_error;
}
rpc_status = ts_rpc_endpoint_sp_init(&rpc_endpoint, n_services, n_shares);
if (rpc_status != RPC_SUCCESS) {
EMSG("Failed to initialize RPC endpoint: %d", rpc_status);
goto fatal_error;
}
IMSG("Created RPC endpoint for %u service and %u memory shares.", n_services, n_shares);
/* Create services */
if (service_factory_iterator == __proxy_service_factory_list_end) {
EMSG("No services to construct.");
goto fatal_error;
}
/* Iterate the proxy_service_factory_list created by the linker.
* See: proxy_service_factory_list.h
*/
while (service_factory_iterator < __proxy_service_factory_list_end) {
IMSG("Creating proxy service %s", service_factory_iterator->name);
rpc_iface = service_factory_iterator->fn();
if (!rpc_iface) {
EMSG("Failed to create service %s", service_factory_iterator->name);
goto fatal_error;
}
rpc_status = ts_rpc_endpoint_sp_add_service(&rpc_endpoint, rpc_iface);
if (rpc_status != RPC_SUCCESS) {
EMSG("Failed to add service to RPC endpoint: %d", rpc_status);
goto fatal_error;
}
service_factory_iterator ++;
}
/* End of boot phase */
result = sp_msg_wait(&req_msg);
if (result != SP_RESULT_OK) {
EMSG("Failed to send message wait %d", result);
goto fatal_error;
}
while (1) {
ts_rpc_endpoint_sp_receive(&rpc_endpoint, &req_msg, &resp_msg);
result = sp_msg_send_direct_resp(&resp_msg, &req_msg);
if (result != SP_RESULT_OK) {
EMSG("Failed to send direct response %d", result);
result = sp_msg_wait(&req_msg);
if (result != SP_RESULT_OK) {
EMSG("Failed to send message wait %d", result);
goto fatal_error;
}
}
}
fatal_error:
/* SP is not viable */
EMSG("SE proxy SP error");
while (1) {}
}
void sp_interrupt_handler(uint32_t interrupt_id)
{
(void)interrupt_id;
}
ffa_result ffa_vm_created_handler(uint16_t vm_id, uint64_t handle)
{
(void)vm_id;
(void)handle;
return FFA_OK;
}
ffa_result ffa_vm_destroyed_handler(uint16_t vm_id, uint64_t handle)
{
(void)vm_id;
(void)handle;
return FFA_OK;
}
static bool sp_init(uint16_t *own_id)
{
sp_result sp_res = SP_RESULT_INTERNAL_ERROR;
static uint8_t tx_buffer[4096] __aligned(4096);
static uint8_t rx_buffer[4096] __aligned(4096);
sp_res = sp_rxtx_buffer_map(tx_buffer, rx_buffer, sizeof(rx_buffer));
if (sp_res != SP_RESULT_OK) {
EMSG("Failed to map RXTX buffers: %d", sp_res);
return false;
}
sp_res = sp_discovery_own_id_get(own_id);
if (sp_res != SP_RESULT_OK) {
EMSG("Failed to query own ID: %d", sp_res);
return false;
}
return true;
}