blob: 705834ce684792ad423006600a3a0b94d29c8738 [file] [log] [blame]
Andrew Scull18834872018-10-12 11:48:09 +01001/*
Federico Recanati25053ee2022-03-14 15:01:53 +01002 * Copyright 2022 The Hafnium Authors.
Andrew Scull18834872018-10-12 11:48:09 +01003 *
Andrew Walbrane959ec12020-06-17 15:01:09 +01004 * Use of this source code is governed by a BSD-style
5 * license that can be found in the LICENSE file or at
6 * https://opensource.org/licenses/BSD-3-Clause.
Andrew Scull18834872018-10-12 11:48:09 +01007 */
8
Andrew Scull18c78fc2018-08-20 12:57:41 +01009#include "hf/api.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010010
Andrew Walbran318f5732018-11-20 16:23:42 +000011#include "hf/arch/cpu.h"
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +000012#include "hf/arch/ffa.h"
J-Alves0a21db12024-03-28 12:43:30 +000013#include "hf/arch/memcpy_trapped.h"
Olivier Deprez96a2a262020-06-11 17:21:38 +020014#include "hf/arch/mm.h"
Olivier Deprez112d2b52020-09-30 07:39:23 +020015#include "hf/arch/other_world.h"
Andrew Walbran508e63c2018-12-20 17:02:37 +000016#include "hf/arch/timer.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000017
Karl Meakined91e992025-02-01 16:16:27 +000018#include "hf/addr.h"
Karl Meakin49ec1e42024-05-10 13:08:24 +010019#include "hf/bits.h"
Andrew Scull877ae4b2019-07-02 12:52:33 +010020#include "hf/check.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000021#include "hf/dlog.h"
Karl Meakin902af082024-11-28 14:58:38 +000022#include "hf/ffa.h"
23#include "hf/ffa/cpu_cycles.h"
24#include "hf/ffa/direct_messaging.h"
25#include "hf/ffa/ffa_memory.h"
26#include "hf/ffa/indirect_messaging.h"
27#include "hf/ffa/interrupts.h"
28#include "hf/ffa/notifications.h"
Karl Meakin902af082024-11-28 14:58:38 +000029#include "hf/ffa/setup_and_discovery.h"
30#include "hf/ffa/vm.h"
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010031#include "hf/ffa_internal.h"
32#include "hf/ffa_memory.h"
J-Alves33c47bf2022-09-29 11:36:20 +010033#include "hf/ffa_v1_0.h"
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +010034#include "hf/hf_ipi.h"
Andrew Scull6386f252018-12-06 13:29:10 +000035#include "hf/mm.h"
Manish Pandeya5f39fb2020-09-11 09:47:11 +010036#include "hf/plat/interrupts.h"
Andrew Scull8d9e1212019-04-05 13:52:55 +010037#include "hf/std.h"
Madhukar Pappireddy32424db2024-09-25 15:06:19 -050038#include "hf/timer_mgmt.h"
Karl Meakinc5cebbc2024-06-17 11:30:27 +010039#include "hf/vcpu.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010040#include "hf/vm.h"
41
Andrew Scullf35a5c92018-08-07 18:09:46 +010042#include "vmapi/hf/call.h"
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010043#include "vmapi/hf/ffa.h"
J-Alves126ab502022-09-29 11:37:33 +010044#include "vmapi/hf/ffa_v1_0.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010045
Daniel Boulby1ddb3d72021-12-16 18:16:50 +000046static_assert(sizeof(struct ffa_partition_info_v1_0) == 8,
Fuad Tabbae4efcc32020-07-16 15:37:27 +010047 "Partition information descriptor size doesn't match the one in "
48 "the FF-A 1.0 EAC specification, Table 82.");
Daniel Boulby1ddb3d72021-12-16 18:16:50 +000049static_assert(sizeof(struct ffa_partition_info) == 24,
50 "Partition information descriptor size doesn't match the one in "
51 "the FF-A 1.1 BETA0 EAC specification, Table 13.34.");
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -080052static_assert((sizeof(struct ffa_partition_info) & 7) == 0,
53 "Partition information descriptor must be a multiple of 8 bytes"
54 " for ffa_partition_info_get_regs to work correctly. Information"
55 " from this structure are returned in 8 byte registers and the"
56 " count of 8 byte registers is returned by the ABI.");
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000057/*
58 * To eliminate the risk of deadlocks, we define a partial order for the
59 * acquisition of locks held concurrently by the same physical CPU. Our current
60 * ordering requirements are as follows:
61 *
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +010062 * vm::lock -> vcpu::lock -> mm_stage1_lock -> dlog sl
Andrew Scull6386f252018-12-06 13:29:10 +000063 *
Andrew Scull4caadaf2019-07-03 13:13:47 +010064 * Locks of the same kind require the lock of lowest address to be locked first,
65 * see `sl_lock_both()`.
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000066 */
67
Andrew Scullaa039b32018-10-04 15:02:26 +010068static_assert(HF_MAILBOX_SIZE == PAGE_SIZE,
Andrew Scull13652af2018-09-17 14:49:08 +010069 "Currently, a page is mapped for the send and receive buffers so "
70 "the maximum request is the size of a page.");
71
Andrew Walbran5de9c3d2020-02-10 13:35:29 +000072static_assert(MM_PPOOL_ENTRY_SIZE >= HF_MAILBOX_SIZE,
73 "The page pool entry size must be at least as big as the mailbox "
74 "size, so that memory region descriptors can be copied from the "
75 "mailbox for memory sharing.");
76
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -080077/*
78 * Maximum ffa_partition_info entries that can be returned by an invocation
79 * of FFA_PARTITION_INFO_GET_REGS_64 is size in bytes, of available
80 * registers/args in struct ffa_value divided by size of struct
81 * ffa_partition_info. For this ABI, arg3-arg17 in ffa_value can be used, i.e.
82 * 15 uint64_t fields. For FF-A v1.1, this value should be 5.
83 */
84#define MAX_INFO_REGS_ENTRIES_PER_CALL \
85 ((15 * sizeof(uint64_t)) / sizeof(struct ffa_partition_info))
86static_assert(MAX_INFO_REGS_ENTRIES_PER_CALL == 5,
87 "FF-A v1.1 supports no more than 5 entries"
88 " per FFA_PARTITION_INFO_GET_REGS64 calls");
89
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000090static struct mpool api_page_pool;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000091
92/**
Wedson Almeida Filho81568c42019-01-04 13:33:02 +000093 * Initialises the API page pool by taking ownership of the contents of the
94 * given page pool.
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000095 */
96void api_init(struct mpool *ppool)
97{
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000098 mpool_init_from(&api_page_pool, ppool);
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000099}
100
Madhukar Pappireddycbb836c2025-05-08 17:16:42 -0500101struct mpool *api_get_ppool(void)
102{
103 return &api_page_pool;
104}
105
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100106/**
J-Alvesad6a0432021-04-09 16:06:21 +0100107 * Get target VM vCPU:
108 * If VM is UP then return first vCPU.
109 * If VM is MP then return vCPU whose index matches current CPU index.
110 */
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500111struct vcpu *api_ffa_get_vm_vcpu(struct vm *vm, struct vcpu *current)
J-Alvesad6a0432021-04-09 16:06:21 +0100112{
113 ffa_vcpu_index_t current_cpu_index = cpu_index(current->cpu);
114 struct vcpu *vcpu = NULL;
115
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500116 CHECK((vm != NULL) && (current != NULL));
117
Karl Meakin82041822024-05-20 11:14:34 +0100118 if (vm_is_up(vm)) {
J-Alvesad6a0432021-04-09 16:06:21 +0100119 vcpu = vm_get_vcpu(vm, 0);
120 } else if (current_cpu_index < vm->vcpu_count) {
121 vcpu = vm_get_vcpu(vm, current_cpu_index);
122 }
123
124 return vcpu;
125}
126
127/**
J-Alvesfe7f7372020-11-09 11:32:12 +0000128 * Switches the physical CPU back to the corresponding vCPU of the VM whose ID
129 * is given as argument of the function.
130 *
131 * Called to change the context between SPs for direct messaging (when Hafnium
132 * is SPMC), and on the context of the remaining 'api_switch_to_*' functions.
133 *
134 * This function works for partitions that are:
J-Alvesad6a0432021-04-09 16:06:21 +0100135 * - UP migratable.
J-Alvesfe7f7372020-11-09 11:32:12 +0000136 * - MP with pinned Execution Contexts.
137 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600138struct vcpu *api_switch_to_vm(struct vcpu_locked current_locked,
139 struct ffa_value to_ret,
J-Alves19e20cf2023-08-02 12:48:55 +0100140 enum vcpu_state vcpu_state, ffa_id_t to_id)
J-Alvesfe7f7372020-11-09 11:32:12 +0000141{
142 struct vm *to_vm = vm_find(to_id);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600143 struct vcpu *next = api_ffa_get_vm_vcpu(to_vm, current_locked.vcpu);
J-Alvesfe7f7372020-11-09 11:32:12 +0000144
145 CHECK(next != NULL);
146
147 /* Set the return value for the target VM. */
148 arch_regs_set_retval(&next->regs, to_ret);
149
150 /* Set the current vCPU state. */
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -0500151 CHECK(vcpu_state_set(current_locked, vcpu_state));
J-Alvesfe7f7372020-11-09 11:32:12 +0000152
153 return next;
154}
155
156/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000157 * Switches the physical CPU back to the corresponding vCPU of the primary VM.
Andrew Scullaa039b32018-10-04 15:02:26 +0100158 *
159 * This triggers the scheduling logic to run. Run in the context of secondary VM
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100160 * to cause FFA_RUN to return and the primary VM to regain control of the CPU.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100161 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600162struct vcpu *api_switch_to_primary(struct vcpu_locked current_locked,
J-Alves27b71962022-12-12 15:29:58 +0000163 struct ffa_value primary_ret,
164 enum vcpu_state secondary_state)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100165{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600166 return api_switch_to_vm(current_locked, primary_ret, secondary_state,
J-Alvesfe7f7372020-11-09 11:32:12 +0000167 HF_PRIMARY_VM_ID);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100168}
169
170/**
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200171 * Choose next vCPU to run to be the counterpart vCPU in the other
172 * world (run the normal world if currently running in the secure
173 * world). Set current vCPU state to the given vcpu_state parameter.
174 * Set FF-A return values to the target vCPU in the other world.
175 *
176 * Called in context of a direct message response from a secure
177 * partition to a VM.
178 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600179struct vcpu *api_switch_to_other_world(struct vcpu_locked current_locked,
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100180 struct ffa_value other_world_ret,
181 enum vcpu_state vcpu_state)
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200182{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600183 return api_switch_to_vm(current_locked, other_world_ret, vcpu_state,
J-Alvesfe7f7372020-11-09 11:32:12 +0000184 HF_OTHER_WORLD_ID);
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200185}
186
187/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000188 * Returns true if the given vCPU is executing in context of an
189 * FFA_MSG_SEND_DIRECT_REQ invocation.
190 */
J-Alves27b71962022-12-12 15:29:58 +0000191bool is_ffa_direct_msg_request_ongoing(struct vcpu_locked locked)
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000192{
Kathleen Capellae468c112023-12-13 17:56:28 -0500193 return locked.vcpu->direct_request_origin.vm_id != HF_INVALID_VM_ID;
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000194}
195
196/**
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100197 * Returns true if the VM owning the given vCPU is supporting managed exit and
198 * the vCPU is currently processing a managed exit.
199 */
200static bool api_ffa_is_managed_exit_ongoing(struct vcpu_locked vcpu_locked)
201{
Karl Meakin117c8082024-12-04 16:03:28 +0000202 return (ffa_vm_managed_exit_supported(vcpu_locked.vcpu->vm) &&
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100203 vcpu_locked.vcpu->processing_managed_exit);
204}
205
206/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000207 * Returns to the primary VM and signals that the vCPU still has work to do so.
Andrew Scull33fecd32019-01-08 14:48:27 +0000208 */
209struct vcpu *api_preempt(struct vcpu *current)
210{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600211 struct vcpu_locked current_locked;
212 struct vcpu *next;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100213 struct ffa_value ret = {
214 .func = FFA_INTERRUPT_32,
Olivier Deprez0d725f52022-07-06 14:20:27 +0200215 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull33fecd32019-01-08 14:48:27 +0000216 };
217
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600218 current_locked = vcpu_lock(current);
219 next = api_switch_to_primary(current_locked, ret, VCPU_STATE_PREEMPTED);
220 vcpu_unlock(&current_locked);
221
222 return next;
Andrew Scull33fecd32019-01-08 14:48:27 +0000223}
224
225/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000226 * Puts the current vCPU in wait for interrupt mode, and returns to the primary
Fuad Tabbaed294af2019-12-20 10:43:01 +0000227 * VM.
Andrew Scullaa039b32018-10-04 15:02:26 +0100228 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100229struct vcpu *api_wait_for_interrupt(struct vcpu *current)
Andrew Scullaa039b32018-10-04 15:02:26 +0100230{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600231 struct vcpu_locked current_locked;
232 struct vcpu *next;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100233 struct ffa_value ret = {
234 .func = HF_FFA_RUN_WAIT_FOR_INTERRUPT,
235 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull6d2db332018-10-10 15:28:17 +0100236 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000237
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600238 current_locked = vcpu_lock(current);
239 next = api_switch_to_primary(current_locked, ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100240 VCPU_STATE_BLOCKED_INTERRUPT);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600241 vcpu_unlock(&current_locked);
242
243 return next;
Andrew Scullaa039b32018-10-04 15:02:26 +0100244}
245
246/**
Andrew Walbran33645652019-04-15 12:29:31 +0100247 * Puts the current vCPU in off mode, and returns to the primary VM.
248 */
249struct vcpu *api_vcpu_off(struct vcpu *current)
250{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600251 struct vcpu_locked current_locked;
252 struct vcpu *next;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100253 struct ffa_value ret = {
254 .func = HF_FFA_RUN_WAIT_FOR_INTERRUPT,
255 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Walbran33645652019-04-15 12:29:31 +0100256 };
257
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600258 current_locked = vcpu_lock(current);
Andrew Walbran33645652019-04-15 12:29:31 +0100259
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600260 next = api_switch_to_primary(current_locked, ret, VCPU_STATE_OFF);
261 vcpu_unlock(&current_locked);
262
263 return next;
Andrew Walbran33645652019-04-15 12:29:31 +0100264}
265
266/**
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500267 * The current vCPU is blocked on some resource and needs to relinquish
268 * control back to the execution context of the endpoint that originally
269 * allocated cycles to it.
Andrew Scull66d62bf2019-02-01 13:54:10 +0000270 */
Madhukar Pappireddy184501c2023-05-23 17:24:06 -0500271struct ffa_value api_yield(struct vcpu *current, struct vcpu **next,
272 struct ffa_value *args)
Andrew Scull66d62bf2019-02-01 13:54:10 +0000273{
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000274 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_32};
275 struct vcpu_locked current_locked;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500276 bool transition_allowed;
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -0500277 enum vcpu_state next_state = VCPU_STATE_RUNNING;
Madhukar Pappireddy184501c2023-05-23 17:24:06 -0500278 uint32_t timeout_low = 0;
279 uint32_t timeout_high = 0;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600280 struct vcpu_locked next_locked = (struct vcpu_locked){
281 .vcpu = NULL,
282 };
Madhukar Pappireddy184501c2023-05-23 17:24:06 -0500283
284 if (args != NULL) {
285 if (args->arg4 != 0U || args->arg5 != 0U || args->arg6 != 0U ||
286 args->arg7 != 0U) {
287 dlog_error(
288 "Parameters passed through registers X4-X7 "
289 "must be zero\n");
290 return ffa_error(FFA_INVALID_PARAMETERS);
291 }
292 timeout_low = (uint32_t)args->arg2 & 0xFFFFFFFF;
293 timeout_high = (uint32_t)args->arg3 & 0xFFFFFFFF;
294 }
Andrew Scull66d62bf2019-02-01 13:54:10 +0000295
Karl Meakin5e996992024-05-20 11:27:07 +0100296 if (vm_is_primary(current->vm)) {
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000297 /* NOOP on the primary as it makes the scheduling decisions. */
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000298 return ret;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000299 }
300
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000301 current_locked = vcpu_lock(current);
Karl Meakin117c8082024-12-04 16:03:28 +0000302 transition_allowed = ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600303 current_locked, current->vm->id, HF_INVALID_VM_ID, next_locked,
304 FFA_YIELD_32, &next_state);
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000305
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500306 if (!transition_allowed) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600307 ret = ffa_error(FFA_DENIED);
308 goto out;
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000309 }
310
Madhukar Pappireddy65764072023-05-23 17:18:58 -0500311 /*
312 * The current vCPU is expected to move to BLOCKED state. However,
313 * under certain circumstances, it is allowed for the current vCPU
314 * to be resumed immediately without ever moving to BLOCKED state. One
315 * such scenario occurs when an SP's execution context attempts to
316 * yield cycles while handling secure interrupt. Refer to the comments
Karl Meakin117c8082024-12-04 16:03:28 +0000317 * in the SPMC variant of the ffa_cpu_cycles_yield_prepare function.
Madhukar Pappireddy65764072023-05-23 17:18:58 -0500318 */
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -0500319 assert(!vm_id_is_current_world(current->vm->id) ||
320 next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500321
Karl Meakin117c8082024-12-04 16:03:28 +0000322 ret = ffa_cpu_cycles_yield_prepare(current_locked, next, timeout_low,
323 timeout_high);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600324out:
325 vcpu_unlock(&current_locked);
326 return ret;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000327}
328
329/**
Andrew Walbran33645652019-04-15 12:29:31 +0100330 * Switches to the primary so that it can switch to the target, or kick it if it
331 * is already running on a different physical CPU.
332 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600333static struct vcpu *api_wake_up_locked(struct vcpu_locked current_locked,
334 struct vcpu *target_vcpu)
Andrew Walbran33645652019-04-15 12:29:31 +0100335{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100336 struct ffa_value ret = {
Andrew Walbran7e824602020-10-22 16:51:40 +0100337 .func = FFA_INTERRUPT_32,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100338 .arg1 = ffa_vm_vcpu(target_vcpu->vm->id,
339 vcpu_index(target_vcpu)),
Andrew Walbran33645652019-04-15 12:29:31 +0100340 };
Madhukar Pappireddybd10e572023-03-06 16:39:49 -0600341
342 return api_switch_to_primary(current_locked, ret, VCPU_STATE_BLOCKED);
343}
344
345struct vcpu *api_wake_up(struct vcpu *current, struct vcpu *target_vcpu)
346{
347 struct vcpu_locked current_locked;
348 struct vcpu *next;
349
350 current_locked = vcpu_lock(current);
351 next = api_wake_up_locked(current_locked, target_vcpu);
352 vcpu_unlock(&current_locked);
353
354 return next;
Andrew Walbran33645652019-04-15 12:29:31 +0100355}
356
357/**
Madhukar Pappireddy04cf9e82025-03-17 17:32:02 -0500358 * An execution context of a partition invokes FFA_ABORT ABI upon encountering
359 * a fatal error and enters ABORTED state. SPMC then takes necessary steps
360 * based on the abort action specified by the partition through its manifest.
361 */
362struct ffa_value api_ffa_abort(struct vcpu *current, struct vcpu **next,
363 struct ffa_value *args)
364{
365 assert(args != NULL);
366
367 if (ffa_is_vm_id(current->vm->id)) {
368 dlog_error("FFA_ABORT ABI not supported in NWd.\n");
369 return ffa_error(FFA_NOT_SUPPORTED);
370 }
371
372 if (args->arg1 != 0U || args->arg3 != 0U || args->arg4 != 0U ||
373 args->arg5 != 0U || args->arg6 != 0U || args->arg7 != 0U) {
374 dlog_error(
375 "Parameters passed through registers X1 and X3-X7 "
376 "must be zero\n");
377 return ffa_error(FFA_INVALID_PARAMETERS);
378 }
379
380 return ffa_partition_abort(current, next);
381}
382
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000383/*
384 * Format the partition info descriptors according to the version supported
385 * by the endpoint and return the size of the array created.
386 */
387static struct ffa_value send_versioned_partition_info_descriptors(
Daniel Boulby191b5f02022-02-17 17:26:14 +0000388 struct vm_locked vm_locked, struct ffa_partition_info *partitions,
J-Alves90d30d02025-05-09 16:04:48 +0100389 size_t entries_count)
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000390{
Daniel Boulby191b5f02022-02-17 17:26:14 +0000391 struct vm *vm = vm_locked.vm;
Karl Meakin0e617d92024-04-05 12:55:22 +0100392 enum ffa_version version = vm->ffa_version;
Daniel Boulby835e1592022-05-30 17:38:51 +0100393 uint32_t partition_info_size;
394 uint32_t buffer_size;
Federico Recanati644f0462022-03-17 12:04:00 +0100395 struct ffa_value ret;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000396
J-Alvese8c8c2b2022-12-16 15:34:48 +0000397 /* Acquire receiver's RX buffer. */
Karl Meakin117c8082024-12-04 16:03:28 +0000398 if (!ffa_setup_acquire_receiver_rx(vm_locked, &ret)) {
J-Alvese8c8c2b2022-12-16 15:34:48 +0000399 dlog_verbose("Failed to acquire RX buffer for VM %x\n", vm->id);
400 return ret;
401 }
402
J-Alves122f1a12022-12-12 15:55:42 +0000403 if (vm_is_mailbox_busy(vm_locked)) {
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000404 /*
405 * Can't retrieve memory information if the mailbox is not
406 * available.
407 */
408 dlog_verbose("RX buffer not ready.\n");
Daniel Boulby191b5f02022-02-17 17:26:14 +0000409 return ffa_error(FFA_BUSY);
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000410 }
411
Karl Meakin0e617d92024-04-05 12:55:22 +0100412 if (version == FFA_VERSION_1_0) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000413 struct ffa_partition_info_v1_0 *recv_mailbox = vm->mailbox.recv;
414
Daniel Boulby835e1592022-05-30 17:38:51 +0100415 partition_info_size = sizeof(struct ffa_partition_info_v1_0);
J-Alves90d30d02025-05-09 16:04:48 +0100416 buffer_size = partition_info_size * entries_count;
Daniel Boulby835e1592022-05-30 17:38:51 +0100417 if (buffer_size > HF_MAILBOX_SIZE) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000418 dlog_error(
419 "Partition information does not fit in the "
J-Alves0a21db12024-03-28 12:43:30 +0000420 "VM's RX buffer.\n");
Daniel Boulby191b5f02022-02-17 17:26:14 +0000421 return ffa_error(FFA_NO_MEMORY);
422 }
423
J-Alves90d30d02025-05-09 16:04:48 +0100424 for (size_t i = 0; i < entries_count; i++) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000425 /*
426 * Populate the VM's RX buffer with the partition
Kathleen Capella402fa852022-11-09 16:16:51 -0500427 * information. Clear properties bits that must be zero
428 * according to DEN0077A FF-A v1.0 REL Table 8.25.
Daniel Boulby191b5f02022-02-17 17:26:14 +0000429 */
430 recv_mailbox[i].vm_id = partitions[i].vm_id;
431 recv_mailbox[i].vcpu_count = partitions[i].vcpu_count;
Kathleen Capella402fa852022-11-09 16:16:51 -0500432 recv_mailbox[i].properties =
433 partitions[i].properties &
434 ~FFA_PARTITION_v1_0_RES_MASK;
Daniel Boulby191b5f02022-02-17 17:26:14 +0000435 }
436
437 } else {
Daniel Boulby835e1592022-05-30 17:38:51 +0100438 partition_info_size = sizeof(struct ffa_partition_info);
J-Alves90d30d02025-05-09 16:04:48 +0100439 buffer_size = partition_info_size * entries_count;
J-Alves0a21db12024-03-28 12:43:30 +0000440
Daniel Boulby835e1592022-05-30 17:38:51 +0100441 if (buffer_size > HF_MAILBOX_SIZE) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000442 dlog_error(
443 "Partition information does not fit in the "
J-Alves0a824e92024-04-26 16:20:12 +0100444 "VM's RX buffer.\n");
Daniel Boulby191b5f02022-02-17 17:26:14 +0000445 return ffa_error(FFA_NO_MEMORY);
446 }
447
J-Alves0a21db12024-03-28 12:43:30 +0000448 /*
449 * Populate the VM's RX buffer with the partition information.
Daniel Boulby191b5f02022-02-17 17:26:14 +0000450 */
J-Alves0a21db12024-03-28 12:43:30 +0000451 if (!memcpy_trapped(vm->mailbox.recv, HF_MAILBOX_SIZE,
452 partitions, buffer_size)) {
453 dlog_error(
454 "%s: Failed to copy ffa_partition_info "
455 "descriptor\n",
456 __func__);
457 return ffa_error(FFA_ABORTED);
458 }
Daniel Boulby191b5f02022-02-17 17:26:14 +0000459 }
460
Daniel Boulby835e1592022-05-30 17:38:51 +0100461 vm->mailbox.recv_size = buffer_size;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000462
463 /* Sender is Hypervisor in the normal world (TEE in secure world). */
Daniel Boulby191b5f02022-02-17 17:26:14 +0000464 vm->mailbox.recv_sender = HF_VM_ID_BASE;
465 vm->mailbox.recv_func = FFA_PARTITION_INFO_GET_32;
J-Alvese8c8c2b2022-12-16 15:34:48 +0000466 vm->mailbox.state = MAILBOX_STATE_FULL;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000467
Daniel Boulby835e1592022-05-30 17:38:51 +0100468 /*
469 * Return the count of partition information descriptors in w2
470 * and the size of the descriptors in w3.
471 */
472 return (struct ffa_value){.func = FFA_SUCCESS_32,
J-Alves90d30d02025-05-09 16:04:48 +0100473 .arg2 = entries_count,
Daniel Boulby835e1592022-05-30 17:38:51 +0100474 .arg3 = partition_info_size};
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000475}
476
J-Alves7fb0fdb2024-10-09 11:28:07 +0100477/**
478 * Set properties accoridng to the version of the partition, and the FF-A
479 * features it supports.
480 */
481static ffa_partition_properties_t api_ffa_partitions_info_get_properties(
482 ffa_id_t caller_id, struct vm *vm)
483{
484 ffa_partition_properties_t properties;
485
Karl Meakin117c8082024-12-04 16:03:28 +0000486 properties = ffa_setup_partition_properties(caller_id, vm);
J-Alves7fb0fdb2024-10-09 11:28:07 +0100487 properties |= FFA_PARTITION_AARCH64_EXEC;
488
489 if (vm->ffa_version >= FFA_VERSION_1_1) {
490 properties |= vm_are_notifications_enabled(vm)
491 ? FFA_PARTITION_NOTIFICATION
492 : 0;
493 properties |= vm->messaging_method & FFA_PARTITION_INDIRECT_MSG;
494 }
495
Karl Meakina603e082024-08-02 17:57:27 +0100496 /*
497 * Only populate on calls from normal world,
498 * and if SP supports receiving direct message requests.
499 */
500 if (ffa_is_vm_id(caller_id) &&
501 (properties & FFA_PARTITION_DIRECT_REQ_RECV) != 0) {
502 if (vm->vm_availability_messages.vm_created) {
503 properties |= FFA_PARTITION_VM_CREATED;
504 }
505 if (vm->vm_availability_messages.vm_destroyed) {
506 properties |= FFA_PARTITION_VM_DESTROYED;
507 }
508 }
J-Alves7fb0fdb2024-10-09 11:28:07 +0100509 return properties;
510}
511
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100512static void api_ffa_fill_partition_info(
J-Alves7fb0fdb2024-10-09 11:28:07 +0100513 struct ffa_partition_info *out_partition, struct vm *vm,
514 ffa_id_t caller_id)
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800515{
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100516 out_partition->vm_id = vm->id;
517 out_partition->vcpu_count = vm->vcpu_count;
J-Alves7fb0fdb2024-10-09 11:28:07 +0100518 out_partition->properties =
519 api_ffa_partitions_info_get_properties(caller_id, vm);
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100520}
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800521
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100522/**
523 * Find VMs with UUID matching `uuid_to_find` , and fill `out_partitions` with
524 * partition infos. Returns number of VMs that matched.
J-Alves90d30d02025-05-09 16:04:48 +0100525 *
526 * A null UUID matches against any VM, all UUIDs from all partitions will be
527 * part of the return information if the version of the caller is higher or
528 * equal to v1.2. In addition, the return value indicates the number of entries
529 * populated in the partition info out buffer through the `entries_count`
530 * argument. If `count_flag` is true, no partition infos are written to
531 * `out_partitions`, only the number of VMs that matched is returned.
532 *
533 * If all goes well, function returns true.
534 * If there is no space to accomodate all the descriptors return false.
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100535 */
J-Alves90d30d02025-05-09 16:04:48 +0100536static bool api_ffa_fill_partitions_info_array(
537 struct ffa_partition_info out_partitions[],
538 const size_t out_partitions_len, const struct ffa_uuid *uuid_to_find,
539 bool count_flag, ffa_id_t caller_id, enum ffa_version caller_version,
540 size_t *entries_count)
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100541{
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100542 bool match_any = ffa_uuid_is_null(uuid_to_find);
543
J-Alves90d30d02025-05-09 16:04:48 +0100544 *entries_count = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800545
546 /*
547 * Iterate through the VMs to find the ones with a matching
548 * UUID. A Null UUID retrieves information for all VMs.
549 */
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100550 for (ffa_vm_count_t vm_idx = 0; vm_idx < vm_get_count(); vm_idx++) {
551 struct vm *vm = vm_find_index(vm_idx);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800552
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100553 for (size_t uuid_idx = 0; uuid_idx < PARTITION_MAX_UUIDS;
554 uuid_idx++) {
555 struct ffa_uuid uuid = vm->uuids[uuid_idx];
556 struct ffa_partition_info *out_partition =
J-Alves90d30d02025-05-09 16:04:48 +0100557 &out_partitions[*entries_count];
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100558
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400559 /*
560 * Null UUID indicates reaching the end of a
561 * partition's array of UUIDs.
562 */
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100563 if (ffa_uuid_is_null(&uuid)) {
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400564 break;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800565 }
566
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100567 if (match_any || ffa_uuid_equal(uuid_to_find, &uuid)) {
J-Alves90d30d02025-05-09 16:04:48 +0100568 /*
569 * If the number of entries surpasses the size
570 * of `out_partitions`
571 */
J-Alves9decd782025-05-16 11:59:30 +0100572 if (*entries_count >= out_partitions_len) {
J-Alves90d30d02025-05-09 16:04:48 +0100573 return false;
574 }
575
576 (*entries_count)++;
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100577
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400578 if (count_flag) {
579 continue;
580 }
581
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100582 api_ffa_fill_partition_info(out_partition, vm,
J-Alves7fb0fdb2024-10-09 11:28:07 +0100583 caller_id);
J-Alves9decd782025-05-16 11:59:30 +0100584 /*
585 * If the ABI has specified an UUID, then do not
586 * write it
587 */
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100588 if (match_any) {
589 out_partition->uuid = uuid;
J-Alves9decd782025-05-16 11:59:30 +0100590 } else {
591 out_partition->uuid =
592 (struct ffa_uuid){0};
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400593 }
Daniel Boulby48546b12025-01-08 18:22:13 +0000594
595 /*
596 * Multiple UUIDs for a partition was only
597 * introduced in FF-A v1.2, so for any version
598 * less than v1.2 return only one UUID per
599 * partition.
600 */
601 if (caller_version < FFA_VERSION_1_2) {
602 break;
603 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800604 }
605 }
606 }
607
J-Alves90d30d02025-05-09 16:04:48 +0100608 return true;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800609}
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800610
611static inline void api_ffa_pack_vmid_count_props(
J-Alves19e20cf2023-08-02 12:48:55 +0100612 uint64_t *xn, ffa_id_t vm_id, ffa_vcpu_count_t vcpu_count,
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800613 ffa_partition_properties_t properties)
614{
615 *xn = (uint64_t)vm_id;
616 *xn |= (uint64_t)vcpu_count << 16;
617 *xn |= (uint64_t)properties << 32;
618}
619
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700620/**
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700621 * This function forwards the FFA_PARTITION_INFO_GET_REGS ABI to the other world
622 * when hafnium is the hypervisor to determine the secure partitions. When
623 * hafnium is the SPMC, this function forwards the call to the SPMD to discover
624 * SPMD logical partitions. The function returns true when partition information
625 * is filled in the partitions array and false if there are errors. Note that
626 * the SPMD and SPMC may return an FF-A error code of FFA_NOT_SUPPORTED when
627 * there are no SPMD logical partitions or no secure partitions respectively,
628 * and this is not considered a failure of the forwarded call. A caller is
629 * expected to check the return value before consuming the information in the
630 * partitions array passed in and ret_count.
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700631 */
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700632static bool api_ffa_partition_info_get_regs_forward(
633 const struct ffa_uuid *uuid, const uint16_t tag,
634 struct ffa_partition_info *partitions, uint16_t partitions_len,
J-Alves90d30d02025-05-09 16:04:48 +0100635 size_t *ret_count)
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700636{
637 (void)tag;
638 struct ffa_value ret;
639 uint16_t last_index = UINT16_MAX;
640 uint16_t curr_index = 0;
641 uint16_t start_index = 0;
642
Karl Meakin117c8082024-12-04 16:03:28 +0000643 if (!ffa_setup_partition_info_get_regs_forward_allowed()) {
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700644 return true;
645 }
646
647 while (start_index <= last_index) {
648 ret = ffa_partition_info_get_regs(uuid, start_index, 0);
649 if (ffa_func_id(ret) != FFA_SUCCESS_64) {
650 /*
651 * If there are no logical partitions, SPMD returns
652 * NOT_SUPPORTED, that is not an error. If there are no
653 * secure partitions the SPMC returns NOT_SUPPORTED.
654 */
Karl Meakind0123af2025-03-17 16:46:38 +0000655 return (ffa_func_id(ret) == FFA_ERROR_32) &&
656 (ffa_error_code(ret) == FFA_NOT_SUPPORTED);
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700657 }
658
659 if (!api_ffa_fill_partition_info_from_regs(
660 ret, start_index, partitions, partitions_len,
661 ret_count)) {
662 return false;
663 }
664
665 last_index = ffa_partition_info_regs_get_last_idx(ret);
666 curr_index = ffa_partition_info_regs_get_curr_idx(ret);
667 start_index = curr_index + 1;
668 }
669 return true;
670}
671
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700672bool api_ffa_fill_partition_info_from_regs(
673 struct ffa_value ret, uint16_t start_index,
J-Alves90d30d02025-05-09 16:04:48 +0100674 struct ffa_partition_info *partitions, size_t partitions_max_len,
675 size_t *ret_count)
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700676{
J-Alves90d30d02025-05-09 16:04:48 +0100677 size_t entries_count = *ret_count;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700678 uint16_t curr_index = 0;
679 uint8_t num_entries = 0;
680 uint8_t idx = 0;
681 /* List of pointers to args in return value. */
682 uint64_t *arg_ptrs[] = {
683 &ret.arg3,
684 &ret.arg4,
685 &ret.arg5,
686 &ret.arg6,
687 &ret.arg7,
688 &ret.extended_val.arg8,
689 &ret.extended_val.arg9,
690 &ret.extended_val.arg10,
691 &ret.extended_val.arg11,
692 &ret.extended_val.arg12,
693 &ret.extended_val.arg13,
694 &ret.extended_val.arg14,
695 &ret.extended_val.arg15,
696 &ret.extended_val.arg16,
697 &ret.extended_val.arg17,
698 };
699
J-Alves90d30d02025-05-09 16:04:48 +0100700 if (entries_count > partitions_max_len) {
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700701 return false;
702 }
703
704 /*
705 * Tags are currently unused in the implementation. Expect it to be
706 * zero since the implementation does not provide a tag when calling
707 * the FFA_PARTITION_INFO_GET_REGS ABI.
708 */
709 assert(ffa_partition_info_regs_get_tag(ret) == 0);
710
711 /*
712 * Hafnium expects the size of the returned descriptor to be equal to
713 * the size of the structure in the FF-A 1.1 specification. When future
714 * enhancements are made, this assert can be relaxed.
715 */
716 assert(ffa_partition_info_regs_get_desc_size(ret) ==
717 sizeof(struct ffa_partition_info));
718
719 curr_index = ffa_partition_info_regs_get_curr_idx(ret);
720
721 /* FF-A 1.2 ALP0, section 14.9.2 Usage rule 7. */
722 assert(start_index <= curr_index);
723
724 num_entries = curr_index - start_index + 1;
J-Alves90d30d02025-05-09 16:04:48 +0100725 if (num_entries > (partitions_max_len - entries_count) ||
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700726 num_entries > MAX_INFO_REGS_ENTRIES_PER_CALL) {
727 return false;
728 }
729
730 while (num_entries) {
731 uint64_t info = *(arg_ptrs[(ptrdiff_t)(idx++)]);
732 uint64_t uuid_lo = *(arg_ptrs[(ptrdiff_t)(idx++)]);
733 uint64_t uuid_high = *(arg_ptrs[(ptrdiff_t)(idx++)]);
734
J-Alves90d30d02025-05-09 16:04:48 +0100735 partitions[entries_count].vm_id = info & 0xFFFF;
736 partitions[entries_count].vcpu_count = (info >> 16) & 0xFFFF;
737 partitions[entries_count].properties = (info >> 32);
738 partitions[entries_count].uuid.uuid[0] = uuid_lo & 0xFFFFFFFF;
739 partitions[entries_count].uuid.uuid[1] =
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700740 (uuid_lo >> 32) & 0xFFFFFFFF;
J-Alves90d30d02025-05-09 16:04:48 +0100741 partitions[entries_count].uuid.uuid[2] = uuid_high & 0xFFFFFFFF;
742 partitions[entries_count].uuid.uuid[3] =
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700743 (uuid_high >> 32) & 0xFFFFFFFF;
J-Alves90d30d02025-05-09 16:04:48 +0100744 entries_count++;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700745 num_entries--;
746 }
747
J-Alves90d30d02025-05-09 16:04:48 +0100748 *ret_count = entries_count;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700749 return true;
750}
751
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800752struct ffa_value api_ffa_partition_info_get_regs(struct vcpu *current,
753 const struct ffa_uuid *uuid,
754 const uint16_t start_index,
755 const uint16_t tag)
756{
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800757 struct vm *current_vm = current->vm;
J-Alves90d30d02025-05-09 16:04:48 +0100758 struct ffa_partition_info *partitions;
759 size_t buffer_size;
760 size_t partitions_max_len;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800761 bool uuid_is_null = ffa_uuid_is_null(uuid);
J-Alves90d30d02025-05-09 16:04:48 +0100762 size_t entries_count = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800763 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
764 uint16_t max_idx = 0;
765 uint16_t curr_idx = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800766 uint8_t num_entries_to_ret = 0;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800767 uint8_t arg_idx = 3;
768
J-Alves90d30d02025-05-09 16:04:48 +0100769 /* List of pointers to args in return value. */
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800770 uint64_t *arg_ptrs[] = {
771 &(ret).func,
772 &(ret).arg1,
773 &(ret).arg2,
774 &(ret).arg3,
775 &(ret).arg4,
776 &(ret).arg5,
777 &(ret).arg6,
778 &(ret).arg7,
779 &(ret).extended_val.arg8,
780 &(ret).extended_val.arg9,
781 &(ret).extended_val.arg10,
782 &(ret).extended_val.arg11,
783 &(ret).extended_val.arg12,
784 &(ret).extended_val.arg13,
785 &(ret).extended_val.arg14,
786 &(ret).extended_val.arg15,
787 &(ret).extended_val.arg16,
788 &(ret).extended_val.arg17,
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800789 };
790
J-Alves90d30d02025-05-09 16:04:48 +0100791 /* Use CPU buffer to temporarily save the descriptor. */
792 partitions = (struct ffa_partition_info *)cpu_get_buffer(current->cpu);
793
794 buffer_size = cpu_get_buffer_size(current->cpu);
795
796 /* Expect size to match that of the mailbox. */
797 assert(buffer_size == PAGE_SIZE);
798 assert(partitions != NULL);
799
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800800 /* TODO: Add support for using tags */
801 if (tag != 0) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800802 dlog_error("Tag not 0. Unsupported tag. %d\n", tag);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800803 return ffa_error(FFA_RETRY);
804 }
805
J-Alves90d30d02025-05-09 16:04:48 +0100806 partitions_max_len = buffer_size / sizeof(struct ffa_partition_info);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800807
J-Alves90d30d02025-05-09 16:04:48 +0100808 if (!api_ffa_fill_partitions_info_array(
809 partitions, partitions_max_len, uuid, false, current_vm->id,
810 current_vm->ffa_version, &entries_count)) {
811 dlog_verbose(
812 "%s: No memory to hold all partition information.\n",
813 __func__);
814 return ffa_error(FFA_NO_MEMORY);
815 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800816
J-Alves90d30d02025-05-09 16:04:48 +0100817 /* If UUID is Null entries_count must not be zero at this stage. */
818 CHECK(!uuid_is_null || entries_count != 0);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800819
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800820 /*
821 * When running the Hypervisor:
822 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
823 * it to fill with secure partitions information.
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700824 * When running the SPMC, the SPMC forwards the call to the SPMD to
825 * discover any EL3 SPMD logical partitions, if the call came from an
826 * SP. Otherwise, the call is not forwarded.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800827 * TODO: Note that for this ABI, forwarding on every invocation when
828 * uuid is Null is inefficient,and if performance becomes a problem,
829 * this would be a good place to optimize using strategies such as
830 * caching info etc. For now, assuming this inefficiency is not a major
831 * issue.
J-Alves90d30d02025-05-09 16:04:48 +0100832 * - If UUID is non-Null entries_count may be zero because the UUID
833 * matches a secure partition and the query is forwarded to the SPMC.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800834 * When running the SPMC:
J-Alves90d30d02025-05-09 16:04:48 +0100835 * - If UUID is non-Null and entries_count is zero it means there is no
836 * such partition identified in the system.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800837 */
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700838 if (vm_id_is_current_world(current_vm->id)) {
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700839 if (!api_ffa_partition_info_get_regs_forward(
J-Alves90d30d02025-05-09 16:04:48 +0100840 uuid, tag, partitions, partitions_max_len,
841 &entries_count)) {
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700842 dlog_error(
843 "Failed to forward "
844 "ffa_partition_info_get_regs.\n");
845 return ffa_error(FFA_DENIED);
846 }
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800847 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800848
849 /*
850 * Unrecognized UUID: does not match any of the VMs (or SPs)
851 * and is not Null.
852 */
J-Alves90d30d02025-05-09 16:04:48 +0100853 if (entries_count == 0 || entries_count > partitions_max_len) {
Olivier Deprez89da0a42023-09-01 17:38:33 +0200854 dlog_verbose(
J-Alves90d30d02025-05-09 16:04:48 +0100855 "Invalid parameters. entries_count = %zu (must not be "
856 "zero or > %lu)\n",
857 entries_count, partitions_max_len);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800858 return ffa_error(FFA_INVALID_PARAMETERS);
859 }
860
J-Alves90d30d02025-05-09 16:04:48 +0100861 if (start_index >= entries_count) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800862 dlog_error(
J-Alves90d30d02025-05-09 16:04:48 +0100863 "start index = %d entries_count = %zu (start_index "
864 "must "
865 "be "
866 "less than entries_count)\n",
867 start_index, entries_count);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800868 return ffa_error(FFA_INVALID_PARAMETERS);
869 }
870
J-Alves90d30d02025-05-09 16:04:48 +0100871 max_idx = entries_count - 1;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800872 num_entries_to_ret = (max_idx - start_index) + 1;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800873 num_entries_to_ret =
874 MIN(num_entries_to_ret, MAX_INFO_REGS_ENTRIES_PER_CALL);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800875 curr_idx = start_index + num_entries_to_ret - 1;
876 assert(curr_idx <= max_idx);
877
878 ret.func = FFA_SUCCESS_64;
879 ret.arg2 = (sizeof(struct ffa_partition_info) & 0xFFFF) << 48;
J-Alves296c9012025-03-20 19:59:36 +0000880 ret.arg2 |= ((uint64_t)curr_idx) << 16;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800881 ret.arg2 |= max_idx;
882
883 if (num_entries_to_ret > 1) {
884 ret.extended_val.valid = 1;
885 }
886
887 for (uint16_t idx = start_index; idx <= curr_idx; ++idx) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800888 uint64_t *xn_0 = arg_ptrs[arg_idx++];
889 uint64_t *xn_1 = arg_ptrs[arg_idx++];
890 uint64_t *xn_2 = arg_ptrs[arg_idx++];
891
892 api_ffa_pack_vmid_count_props(xn_0, partitions[idx].vm_id,
893 partitions[idx].vcpu_count,
894 partitions[idx].properties);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800895 if (uuid_is_null) {
Karl Meakin9478e322024-09-23 17:47:09 +0100896 ffa_uuid_to_u64x2(xn_1, xn_2, &partitions[idx].uuid);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800897 }
Raghu Krishnamurthycded31b2023-04-23 15:07:35 -0700898 assert(arg_idx <= ARRAY_SIZE(arg_ptrs));
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800899 }
900
901 return ret;
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800902}
903
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100904struct ffa_value api_ffa_partition_info_get(struct vcpu *current,
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000905 const struct ffa_uuid *uuid,
906 const uint32_t flags)
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100907{
908 struct vm *current_vm = current->vm;
J-Alves90d30d02025-05-09 16:04:48 +0100909 size_t entries_count = 0;
Olivier Deprez013f4d62022-11-21 15:46:20 +0100910 bool count_flag = (flags & FFA_PARTITION_COUNT_FLAG_MASK) ==
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000911 FFA_PARTITION_COUNT_FLAG;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100912 bool uuid_is_null = ffa_uuid_is_null(uuid);
J-Alves90d30d02025-05-09 16:04:48 +0100913 struct ffa_partition_info *partitions;
914 size_t buffer_size;
915 size_t partitions_max_len;
Daniel Boulby191b5f02022-02-17 17:26:14 +0000916 struct vm_locked vm_locked;
917 struct ffa_value ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100918
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000919 /* Bits 31:1 Must Be Zero */
Olivier Deprez013f4d62022-11-21 15:46:20 +0100920 if ((flags & ~FFA_PARTITION_COUNT_FLAG_MASK) != 0) {
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000921 return ffa_error(FFA_INVALID_PARAMETERS);
922 }
923
J-Alves90d30d02025-05-09 16:04:48 +0100924 /* Use CPU buffer to temporarily save the descriptor. */
925 partitions = (struct ffa_partition_info *)cpu_get_buffer(current->cpu);
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100926
J-Alves90d30d02025-05-09 16:04:48 +0100927 buffer_size = cpu_get_buffer_size(current->cpu);
928
929 /* Expect size to match that of the mailbox. */
930 assert(buffer_size == PAGE_SIZE);
931 assert(partitions != NULL);
932
933 partitions_max_len = buffer_size / sizeof(struct ffa_partition_info);
934
935 if (!api_ffa_fill_partitions_info_array(
936 partitions, partitions_max_len, uuid, count_flag,
937 current_vm->id, current_vm->ffa_version, &entries_count)) {
938 dlog_verbose(
939 "%s: No memory to hold all partition information.\n",
940 __func__);
941 return ffa_error(FFA_NO_MEMORY);
942 }
943
944 /* If UUID is Null entries_count must not be zero at this stage. */
945 CHECK(!uuid_is_null || entries_count != 0);
Olivier Depreze562e542020-06-11 17:31:54 +0200946
947 /*
948 * When running the Hypervisor:
949 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
950 * it to fill with secure partitions information.
J-Alves90d30d02025-05-09 16:04:48 +0100951 * - If UUID is non-Null entries_count may be zero because the UUID
952 * matches a secure partition and the query is forwarded to the SPMC.
953 * - If the Partitions returned from this call can't fit in the
954 * partitions buffer, this call will only return information from VMs.
955 *
Olivier Depreze562e542020-06-11 17:31:54 +0200956 * When running the SPMC:
J-Alves90d30d02025-05-09 16:04:48 +0100957 * - If UUID is non-Null and entries_count is zero it means there is no
958 * such partition identified in the system.
Olivier Depreze562e542020-06-11 17:31:54 +0200959 */
J-Alves90d30d02025-05-09 16:04:48 +0100960 entries_count = ffa_setup_partition_info_get_forward(
961 uuid, flags, partitions, partitions_max_len, entries_count);
Olivier Depreze562e542020-06-11 17:31:54 +0200962
963 /*
964 * Unrecognized UUID: does not match any of the VMs (or SPs)
965 * and is not Null.
966 */
J-Alves90d30d02025-05-09 16:04:48 +0100967 if (entries_count == 0) {
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100968 return ffa_error(FFA_INVALID_PARAMETERS);
969 }
970
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000971 /*
972 * If the count flag is set we don't need to return the partition info
973 * descriptors.
974 */
975 if (count_flag) {
976 return (struct ffa_value){.func = FFA_SUCCESS_32,
J-Alves90d30d02025-05-09 16:04:48 +0100977 .arg2 = entries_count};
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000978 }
979
Daniel Boulby191b5f02022-02-17 17:26:14 +0000980 vm_locked = vm_lock(current_vm);
981 ret = send_versioned_partition_info_descriptors(vm_locked, partitions,
J-Alves90d30d02025-05-09 16:04:48 +0100982 entries_count);
Daniel Boulby191b5f02022-02-17 17:26:14 +0000983 vm_unlock(&vm_locked);
984 return ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100985}
986
Andrew Scull9726c252019-01-23 13:44:19 +0000987/**
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000988 * Returns the ID of the VM.
989 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100990struct ffa_value api_ffa_id_get(const struct vcpu *current)
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000991{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100992 return (struct ffa_value){.func = FFA_SUCCESS_32,
993 .arg2 = current->vm->id};
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000994}
995
996/**
Olivier Deprez421677d2021-06-18 12:18:53 +0200997 * Returns the SPMC FF-A ID at NS virtual/physical and secure virtual
998 * FF-A instances.
999 * DEN0077A FF-A v1.1 Beta0 section 13.9 FFA_SPM_ID_GET.
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00001000 */
1001struct ffa_value api_ffa_spm_id_get(void)
1002{
Karl Meakin0e617d92024-04-05 12:55:22 +01001003 if (FFA_VERSION_1_1 <= FFA_VERSION_COMPILED) {
1004 /*
1005 * Return the SPMC ID that was fetched during FF-A
1006 * initialization.
1007 */
1008 return (struct ffa_value){.func = FFA_SUCCESS_32,
1009 .arg2 = arch_ffa_spmc_id_get()};
1010 }
1011
J-Alves3829fc02021-03-18 12:49:18 +00001012 return ffa_error(FFA_NOT_SUPPORTED);
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00001013}
1014
1015/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001016 * This function is called by the architecture-specific context switching
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001017 * function to indicate that register state for the given vCPU has been saved
1018 * and can therefore be used by other pCPUs.
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001019 */
1020void api_regs_state_saved(struct vcpu *vcpu)
1021{
1022 sl_lock(&vcpu->lock);
1023 vcpu->regs_available = true;
1024 sl_unlock(&vcpu->lock);
1025}
J-Alves0ffce752024-10-09 14:37:10 +01001026
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001027/**
J-Alves2ced1672022-12-12 14:35:38 +00001028 * Constructs the return value from a successful FFA_MSG_WAIT call, when used
1029 * with FFA_MSG_SEND_32.
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001030 */
J-Alves27b71962022-12-12 15:29:58 +00001031struct ffa_value ffa_msg_recv_return(const struct vm *receiver)
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001032{
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001033 switch (receiver->mailbox.recv_func) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001034 case FFA_MSG_SEND_32:
1035 return (struct ffa_value){
1036 .func = FFA_MSG_SEND_32,
J-Alves296c9012025-03-20 19:59:36 +00001037 .arg1 = ((uint64_t)(receiver->mailbox.recv_sender)
1038 << 16) |
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001039 receiver->id,
1040 .arg3 = receiver->mailbox.recv_size};
J-Alvesd9e7c8f2024-09-11 13:37:25 +01001041 default:
Federico Recanati25053ee2022-03-14 15:01:53 +01001042 return (struct ffa_value){
1043 .func = FFA_RUN_32,
1044 /*
1045 * TODO: FFA_RUN should return vCPU and VM ID in arg1.
1046 * Retrieving vCPU requires a rework of the function,
1047 * while receiver ID must be set because it's checked by
1048 * other APIs (eg: FFA_NOTIFICATION_GET).
1049 */
1050 .arg1 = receiver->id};
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001051 }
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001052}
1053
J-Alvese8c8c2b2022-12-16 15:34:48 +00001054/**
1055 * Change the state of mailbox to empty, such that the ownership is given to the
1056 * Partition manager.
Karl Meakin1064a9c2024-06-04 17:20:43 +01001057 * Returns FFA_SUCCESS if the mailbox was reset successfully, FFA_ERROR
1058 * otherwise.
J-Alvese8c8c2b2022-12-16 15:34:48 +00001059 */
Karl Meakin1064a9c2024-06-04 17:20:43 +01001060static struct ffa_value api_release_mailbox(struct vm_locked vm_locked)
J-Alvese8c8c2b2022-12-16 15:34:48 +00001061{
Karl Meakin1064a9c2024-06-04 17:20:43 +01001062 struct ffa_value ret = {.func = FFA_SUCCESS_32};
J-Alves19e20cf2023-08-02 12:48:55 +01001063 ffa_id_t vm_id = vm_locked.vm->id;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001064
1065 switch (vm_locked.vm->mailbox.state) {
1066 case MAILBOX_STATE_EMPTY:
1067 dlog_verbose("Mailbox of %x is empty.\n", vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001068 ret = ffa_error(FFA_DENIED);
J-Alves31f8bef2023-07-14 12:46:28 +01001069 break;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001070 case MAILBOX_STATE_FULL:
1071 /* Check it doesn't have pending RX full notifications. */
1072 if (vm_are_fwk_notifications_pending(vm_locked)) {
1073 dlog_verbose(
1074 "Mailbox of endpoint %x has pending "
1075 "messages.\n",
1076 vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001077 ret = ffa_error(FFA_DENIED);
J-Alvese8c8c2b2022-12-16 15:34:48 +00001078 }
1079 break;
1080 case MAILBOX_STATE_OTHER_WORLD_OWNED:
1081 /*
1082 * The SPMC shouldn't let SP's mailbox get into this state.
1083 * For the Hypervisor, the VM may call FFA_RX_RELEASE, whilst
1084 * the mailbox is in this state. In that case, we should report
1085 * error.
1086 */
1087 if (vm_id_is_current_world(vm_id)) {
1088 dlog_verbose(
Karl Meakin1064a9c2024-06-04 17:20:43 +01001089 "Mailbox of endpoint %x is in an incorrect "
1090 "state.\n",
J-Alvese8c8c2b2022-12-16 15:34:48 +00001091 vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001092 ret = ffa_error(FFA_ABORTED);
J-Alvese8c8c2b2022-12-16 15:34:48 +00001093 }
1094 break;
1095 }
1096
Karl Meakin1064a9c2024-06-04 17:20:43 +01001097 if (ret.func == FFA_SUCCESS_32) {
1098 vm_locked.vm->mailbox.state = MAILBOX_STATE_EMPTY;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001099 }
1100
Karl Meakin1064a9c2024-06-04 17:20:43 +01001101 return ret;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001102}
1103
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001104/*
1105 * Helper to check if extended arguments (corresponding to regs x8-x17)
1106 * are zeroed out.
1107 */
Kathleen Capella036cc592023-11-30 18:26:15 -05001108bool api_extended_args_are_zero(struct ffa_value *args)
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001109{
Karl Meakind0123af2025-03-17 16:46:38 +00001110 return (args->extended_val.arg8 == 0U &&
1111 args->extended_val.arg9 == 0U &&
1112 args->extended_val.arg10 == 0U &&
1113 args->extended_val.arg11 == 0U &&
1114 args->extended_val.arg12 == 0U &&
1115 args->extended_val.arg13 == 0U &&
1116 args->extended_val.arg14 == 0U &&
1117 args->extended_val.arg15 == 0U &&
1118 args->extended_val.arg16 == 0U &&
1119 args->extended_val.arg17 == 0U);
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001120}
1121
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001122static void api_ffa_msg_wait_rx_release(struct vcpu *current)
1123{
1124 struct vm_locked vm_locked;
1125
Karl Meakin117c8082024-12-04 16:03:28 +00001126 vm_locked = ffa_vm_find_locked(current->vm->id);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001127 if (vm_locked.vm == NULL) {
1128 return;
1129 }
1130
1131 api_release_mailbox(vm_locked);
1132
1133 if (vm_locked.vm->mailbox.state != MAILBOX_STATE_EMPTY) {
1134 dlog_warning("Mailbox not released to producer\n");
1135 }
1136
1137 vm_unlock(&vm_locked);
1138}
1139
Kathleen Capella7253bd52024-08-14 17:36:09 -04001140static bool api_retain_rx_buffer_ownership(struct ffa_value args)
1141{
1142 return ((args.arg2 & FFA_MSG_WAIT_FLAG_RETAIN_RX) != 0U);
1143}
1144
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001145struct ffa_value api_ffa_msg_wait(struct vcpu *current, struct vcpu **next,
1146 struct ffa_value *args)
1147{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001148 struct vcpu_locked current_locked;
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001149 enum vcpu_state next_state = VCPU_STATE_RUNNING;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001150 struct ffa_value ret;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001151 struct vcpu_locked next_locked = (struct vcpu_locked){
1152 .vcpu = NULL,
1153 };
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001154
Kathleen Capella7253bd52024-08-14 17:36:09 -04001155 if (args->arg1 != 0U || args->arg3 != 0U || args->arg4 != 0U ||
1156 args->arg5 != 0U || args->arg6 != 0U || args->arg7 != 0U) {
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001157 return ffa_error(FFA_INVALID_PARAMETERS);
1158 }
1159
Kathleen Capella7253bd52024-08-14 17:36:09 -04001160 if (current->vm->ffa_version >= FFA_VERSION_1_2) {
1161 if (!api_extended_args_are_zero(args)) {
1162 return ffa_error(FFA_INVALID_PARAMETERS);
1163 }
1164 } else {
1165 if (args->arg2 != 0U) {
1166 return ffa_error(FFA_INVALID_PARAMETERS);
1167 }
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001168 }
1169
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001170 current_locked = vcpu_lock(current);
Karl Meakin117c8082024-12-04 16:03:28 +00001171 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001172 current_locked, current->vm->id, HF_INVALID_VM_ID,
1173 next_locked, FFA_MSG_WAIT_32, &next_state)) {
1174 ret = ffa_error(FFA_DENIED);
1175 goto out;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001176 }
1177
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001178 assert(!vm_id_is_current_world(current->vm->id) ||
1179 next_state == VCPU_STATE_WAITING);
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001180
Karl Meakin117c8082024-12-04 16:03:28 +00001181 ret = ffa_cpu_cycles_msg_wait_prepare(current_locked, next);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001182
1183 /*
1184 * To maintain partial ordering of locks, release vCPU lock before
1185 * releasing the VM's RX buffer, a process which requires locking the
1186 * VM.
1187 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001188out:
1189 vcpu_unlock(&current_locked);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001190
Kathleen Capella7253bd52024-08-14 17:36:09 -04001191 if (ret.func != FFA_ERROR_32 &&
1192 !api_retain_rx_buffer_ownership(*args)) {
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001193 api_ffa_msg_wait_rx_release(current);
1194 }
J-Alvese8c8c2b2022-12-16 15:34:48 +00001195 return ret;
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001196}
1197
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001198/**
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001199 * Inject virtual timer interrupt to next vCPU if its timer has expired.
1200 */
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001201static void api_inject_arch_timer_interrupt(struct vcpu_locked next_locked)
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001202{
1203 struct vcpu *next = next_locked.vcpu;
1204
1205 if (arch_timer_expired(&next->regs)) {
1206 /* Make virtual timer interrupt pending. */
Daniel Boulby3c1506b2025-02-25 10:49:51 +00001207 vcpu_virt_interrupt_inject(next_locked, HF_VIRTUAL_TIMER_INTID);
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001208 }
1209}
1210
1211/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001212 * Prepares the vCPU to run by updating its state and fetching whether a return
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001213 * value needs to be forced onto the vCPU.
1214 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001215static bool api_vcpu_prepare_run(struct vcpu_locked current_locked,
1216 struct vcpu_locked vcpu_next_locked,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001217 struct ffa_value *run_ret)
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001218{
Max Shvetsov40108e72020-08-27 12:39:50 +01001219 struct vm_locked vm_locked;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001220 bool ret;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001221 uint64_t timer_remaining_ns = FFA_SLEEP_INDEFINITE;
Olivier Deprez04168ed2022-09-26 09:20:00 +02001222 bool vcpu_was_init_state = false;
J-Alves6e2abc62021-12-02 14:58:56 +00001223 bool need_vm_lock;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001224 struct two_vcpu_locked vcpus_locked;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001225
J-Alves478faac2024-10-23 10:35:57 +01001226 const struct ffa_value ffa_run_abi =
1227 (struct ffa_value){.func = FFA_RUN_32};
1228 const struct ffa_value *ffa_run_ret = NULL;
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001229 enum vm_state target_vm_state;
J-Alves478faac2024-10-23 10:35:57 +01001230
Andrew Scullb06d1752019-02-04 10:15:48 +00001231 /*
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001232 * Check that the registers are available so that the vCPU can be run.
Andrew Scullb06d1752019-02-04 10:15:48 +00001233 *
Andrew Scull4caadaf2019-07-03 13:13:47 +01001234 * The VM lock is not needed in the common case so it must only be taken
1235 * when it is going to be needed. This ensures there are no inter-vCPU
1236 * dependencies in the common run case meaning the sensitive context
1237 * switch performance is consistent.
Andrew Scullb06d1752019-02-04 10:15:48 +00001238 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001239 struct vcpu *vcpu = vcpu_next_locked.vcpu;
1240 struct vcpu *current = current_locked.vcpu;
Max Shvetsov40108e72020-08-27 12:39:50 +01001241
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001242 /* The VM needs to be locked to deliver mailbox messages. */
J-Alves6e2abc62021-12-02 14:58:56 +00001243 need_vm_lock = vcpu->state == VCPU_STATE_WAITING ||
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001244 vcpu->state == VCPU_STATE_CREATED ||
J-Alves6e2abc62021-12-02 14:58:56 +00001245 (!vcpu->vm->el0_partition &&
1246 (vcpu->state == VCPU_STATE_BLOCKED_INTERRUPT ||
1247 vcpu->state == VCPU_STATE_BLOCKED ||
1248 vcpu->state == VCPU_STATE_PREEMPTED));
1249
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001250 if (need_vm_lock) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001251 vcpu_unlock(&vcpu_next_locked);
1252 vcpu_unlock(&current_locked);
Max Shvetsov40108e72020-08-27 12:39:50 +01001253 vm_locked = vm_lock(vcpu->vm);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001254
1255 /* Lock both vCPUs at once to avoid deadlock. */
1256 vcpus_locked = vcpu_lock_both(current, vcpu);
1257 current_locked = vcpus_locked.vcpu1;
1258 vcpu_next_locked = vcpus_locked.vcpu2;
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001259 }
1260
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001261 target_vm_state = vm_read_state(vcpu->vm);
1262
1263 switch (target_vm_state) {
1264 case VM_STATE_NULL:
1265 *run_ret = ffa_error(FFA_INVALID_PARAMETERS);
1266 ret = false;
1267 goto out;
1268 case VM_STATE_CREATED:
1269 /*
1270 * An initial FFA_RUN is necessary for vCPUs of secondary VMs
1271 * to reach the message wait loop. Note that vCPU(s) of Secure
1272 * Partitions don't need it.
1273 */
1274 if (ffa_is_vm_id(vcpu->vm->id)) {
1275 break;
1276 }
1277 *run_ret = ffa_error(FFA_BUSY);
1278 ret = false;
1279 goto out;
1280 case VM_STATE_ABORTING:
1281 if (vcpu->state != VCPU_STATE_NULL &&
1282 vcpu->state != VCPU_STATE_STOPPED &&
1283 vcpu->state != VCPU_STATE_ABORTED) {
1284 dlog_verbose("VM %#x was aborted, cannot run vCPU %u\n",
1285 vcpu->vm->id, vcpu_index(vcpu));
1286 vcpu->state = VCPU_STATE_ABORTED;
1287 }
1288 [[fallthrough]];
1289 case VM_STATE_RUNNING:
1290 [[fallthrough]];
1291 default:
1292 /* Let the subsequent checks handle further conditions. */
1293 break;
1294 }
1295
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001296 /*
1297 * If the vCPU is already running somewhere then we can't run it here
1298 * simultaneously. While it is actually running then the state should be
1299 * `VCPU_STATE_RUNNING` and `regs_available` should be false. Once it
1300 * stops running but while Hafnium is in the process of switching back
1301 * to the primary there will be a brief period while the state has been
1302 * updated but `regs_available` is still false (until
1303 * `api_regs_state_saved` is called). We can't start running it again
1304 * until this has finished, so count this state as still running for the
1305 * purposes of this check.
1306 */
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001307 if (vcpu->state == VCPU_STATE_RUNNING ||
1308 vcpu->state == VCPU_STATE_STARTING || !vcpu->regs_available) {
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001309 /*
1310 * vCPU is running on another pCPU.
1311 *
1312 * It's okay not to return the sleep duration here because the
1313 * other physical CPU that is currently running this vCPU will
1314 * return the sleep duration if needed.
1315 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001316 *run_ret = ffa_error(FFA_BUSY);
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001317 ret = false;
1318 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001319 }
Andrew Scull9726c252019-01-23 13:44:19 +00001320
Andrew Walbran508e63c2018-12-20 17:02:37 +00001321 switch (vcpu->state) {
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001322 case VCPU_STATE_ABORTED:
1323 if (vcpu->vm->lifecycle_support) {
1324 *run_ret = ffa_error(FFA_BUSY);
1325 } else {
1326 *run_ret = ffa_error(FFA_ABORTED);
1327 }
1328 ret = false;
1329 goto out;
1330 case VCPU_STATE_NULL:
1331 *run_ret = ffa_error(FFA_INVALID_PARAMETERS);
1332 ret = false;
1333 goto out;
1334 case VCPU_STATE_STOPPED:
1335 case VCPU_STATE_STARTING:
1336 *run_ret = ffa_error(FFA_BUSY);
1337 [[fallthrough]];
Andrew Sculld6ee1102019-04-05 22:12:42 +01001338 case VCPU_STATE_RUNNING:
1339 case VCPU_STATE_OFF:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001340 ret = false;
1341 goto out;
1342
1343 case VCPU_STATE_CREATED:
1344 /*
1345 * An initial FFA_RUN is necessary for vCPUs of secondary VMs
1346 * to reach the message wait loop. Note that vCPU(s) of Secure
1347 * Partitions don't need it.
1348 */
1349 if (ffa_is_vm_id(vcpu->vm->id)) {
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001350 size_t cpu_indx = cpu_index(current->cpu);
1351
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001352 assert(vcpu->rt_model == RTM_SP_INIT);
1353 vcpu->rt_model = RTM_NONE;
1354
1355 vcpu_was_init_state = true;
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05001356 CHECK(vcpu_state_set(vcpu_next_locked,
1357 VCPU_STATE_STARTING));
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001358 if (cpu_indx == PRIMARY_CPU_IDX) {
1359 vm_set_state(vm_locked, VM_STATE_RUNNING);
1360 }
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001361 break;
1362 }
1363 *run_ret = ffa_error(FFA_BUSY);
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001364 ret = false;
1365 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001366
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001367 case VCPU_STATE_WAITING:
J-Alves6e2abc62021-12-02 14:58:56 +00001368 assert(need_vm_lock == true);
J-Alves478faac2024-10-23 10:35:57 +01001369 if (!vm_locked.vm->el0_partition) {
Karl Meakin117c8082024-12-04 16:03:28 +00001370 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001371 vcpu_next_locked, vm_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00001372 }
1373
J-Alves478faac2024-10-23 10:35:57 +01001374 /* Provide reference to the return value. */
1375 ffa_run_ret = &ffa_run_abi;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001376
J-Alves478faac2024-10-23 10:35:57 +01001377 break;
Andrew Sculld6ee1102019-04-05 22:12:42 +01001378 case VCPU_STATE_BLOCKED_INTERRUPT:
J-Alves6e2abc62021-12-02 14:58:56 +00001379 if (need_vm_lock &&
Karl Meakin117c8082024-12-04 16:03:28 +00001380 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001381 vcpu_next_locked, vm_locked)) {
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00001382 assert(vcpu_virt_interrupt_count_get(vcpu_next_locked) >
1383 0);
J-Alves6e2abc62021-12-02 14:58:56 +00001384 break;
1385 }
1386
Andrew Scullb06d1752019-02-04 10:15:48 +00001387 /* Allow virtual interrupts to be delivered. */
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00001388 if (vcpu_virt_interrupt_count_get(vcpu_next_locked) > 0) {
Andrew Scullb06d1752019-02-04 10:15:48 +00001389 break;
1390 }
1391
Andrew Walbran508e63c2018-12-20 17:02:37 +00001392 if (arch_timer_enabled(&vcpu->regs)) {
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001393 timer_remaining_ns =
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001394 arch_timer_remaining_ns(&vcpu->regs);
1395
1396 /*
1397 * The timer expired so allow the interrupt to be
1398 * delivered.
1399 */
1400 if (timer_remaining_ns == 0) {
1401 break;
1402 }
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001403 }
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001404
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001405 /*
1406 * The vCPU is not ready to run, return the appropriate code to
1407 * the primary which called vcpu_run.
1408 */
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001409 run_ret->func = HF_FFA_RUN_WAIT_FOR_INTERRUPT;
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001410 run_ret->arg1 = ffa_vm_vcpu(vcpu->vm->id, vcpu_index(vcpu));
1411 run_ret->arg2 = timer_remaining_ns;
Andrew Walbran508e63c2018-12-20 17:02:37 +00001412
1413 ret = false;
1414 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001415
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001416 case VCPU_STATE_BLOCKED:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001417 /* A blocked vCPU is run unconditionally. */
1418 [[fallthrough]];
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001419 case VCPU_STATE_PREEMPTED:
J-Alves6e2abc62021-12-02 14:58:56 +00001420 /* Check NPI is to be injected here. */
1421 if (need_vm_lock) {
Karl Meakin117c8082024-12-04 16:03:28 +00001422 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001423 vcpu_next_locked, vm_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00001424 }
Andrew Walbran508e63c2018-12-20 17:02:37 +00001425 break;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001426 default:
1427 /*
1428 * Execution not expected to reach here. Deny the request
1429 * gracefully.
1430 */
1431 *run_ret = ffa_error(FFA_DENIED);
1432 ret = false;
1433 goto out;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001434 }
1435
J-Alves5d65fe72025-02-18 16:02:32 +00001436 ffa_cpu_cycles_init_schedule_mode_ffa_run(current_locked,
1437 vcpu_next_locked);
Madhukar Pappireddy1480fce2022-06-21 18:09:25 -05001438
Madhukar Pappireddy106bfc32024-09-25 15:47:11 -05001439 timer_migrate_to_other_cpu(current_locked.vcpu->cpu, vcpu_next_locked);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001440 vcpu->cpu = current_locked.vcpu->cpu;
J-Alves478faac2024-10-23 10:35:57 +01001441
1442 vcpu_set_running(vcpu_next_locked, ffa_run_ret);
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001443
Olivier Deprez04168ed2022-09-26 09:20:00 +02001444 if (vcpu_was_init_state) {
1445 vcpu_set_phys_core_idx(vcpu);
1446 vcpu_set_boot_info_gp_reg(vcpu);
J-Alves7ac49052022-02-08 17:20:53 +00001447 }
J-Alves7ac49052022-02-08 17:20:53 +00001448
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001449 ret = true;
1450
1451out:
Andrew Scullb06d1752019-02-04 10:15:48 +00001452 if (need_vm_lock) {
Max Shvetsov40108e72020-08-27 12:39:50 +01001453 vm_unlock(&vm_locked);
Andrew Scullb06d1752019-02-04 10:15:48 +00001454 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001455 return ret;
1456}
1457
J-Alves19e20cf2023-08-02 12:48:55 +01001458struct ffa_value api_ffa_run(ffa_id_t vm_id, ffa_vcpu_index_t vcpu_idx,
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001459 struct vcpu *current, struct vcpu **next)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001460{
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001461 struct vm *vm;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001462 struct vcpu *vcpu;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001463 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001464 enum vcpu_state next_state = VCPU_STATE_RUNNING;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001465 struct vcpu_locked current_locked;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001466 struct vcpu_locked vcpu_next_locked;
1467 struct two_vcpu_locked vcpus_locked;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001468
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001469 current_locked = vcpu_lock(current);
Karl Meakin117c8082024-12-04 16:03:28 +00001470 if (!ffa_cpu_cycles_run_checks(current_locked, vm_id, vcpu_idx, &ret,
1471 next)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001472 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001473 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001474
Karl Meakin117c8082024-12-04 16:03:28 +00001475 if (ffa_cpu_cycles_run_forward(vm_id, vcpu_idx, &ret)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001476 goto out;
Raghu Krishnamurthy62f97a72021-07-27 02:14:59 -07001477 }
1478
Andrew Scull19503262018-09-20 14:48:39 +01001479 /* The requested VM must exist. */
Andrew Walbran42347a92019-05-09 13:59:03 +01001480 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +01001481 if (vm == NULL) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001482 goto out;
Andrew Scull19503262018-09-20 14:48:39 +01001483 }
1484
Fuad Tabbaed294af2019-12-20 10:43:01 +00001485 /* The requested vCPU must exist. */
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001486 if (vcpu_idx >= vm->vcpu_count) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001487 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001488 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001489
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001490 /*
1491 * Refer Figure 8.13 Scenario 1 of the FF-A v1.1 EAC spec. SPMC
1492 * bypasses the intermediate execution contexts and resumes the
1493 * SP execution context that was originally preempted.
1494 */
1495 if (*next != NULL) {
1496 vcpu = *next;
1497 } else {
1498 vcpu = vm_get_vcpu(vm, vcpu_idx);
1499 }
1500
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001501 /*
1502 * Unlock current vCPU to allow it to be locked together with next
1503 * vcpu.
1504 */
1505 vcpu_unlock(&current_locked);
1506
1507 /* Lock both vCPUs at once to avoid deadlock. */
1508 vcpus_locked = vcpu_lock_both(current, vcpu);
1509 current_locked = vcpus_locked.vcpu1;
1510 vcpu_next_locked = vcpus_locked.vcpu2;
1511
Karl Meakin117c8082024-12-04 16:03:28 +00001512 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001513 current_locked, current->vm->id, HF_INVALID_VM_ID,
1514 vcpu_next_locked, FFA_RUN_32, &next_state)) {
1515 ret = ffa_error(FFA_DENIED);
1516 goto out_vcpu;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001517 }
1518
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001519 if (!api_vcpu_prepare_run(current_locked, vcpu_next_locked, &ret)) {
1520 goto out_vcpu;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001521 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001522
Fuad Tabbaed294af2019-12-20 10:43:01 +00001523 /* Switch to the vCPU. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001524 *next = vcpu;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001525
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001526 assert(!vm_id_is_current_world(current->vm->id) ||
1527 next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05001528 CHECK(vcpu_state_set(current_locked, VCPU_STATE_BLOCKED));
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001529
Andrew Scull33fecd32019-01-08 14:48:27 +00001530 /*
1531 * Set a placeholder return code to the scheduler. This will be
1532 * overwritten when the switch back to the primary occurs.
1533 */
J-Alvesbd32c972024-02-02 16:20:04 +00001534 ret = api_ffa_interrupt_return(0);
Andrew Scull33fecd32019-01-08 14:48:27 +00001535
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001536out_vcpu:
1537 vcpu_unlock(&vcpu_next_locked);
1538
Andrew Scull6d2db332018-10-10 15:28:17 +01001539out:
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001540 vcpu_unlock(&current_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001541 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001542}
1543
1544/**
Andrew Scull81e85092018-12-12 12:56:20 +00001545 * Check that the mode indicates memory that is valid, owned and exclusive.
1546 */
Karl Meakin07a69ab2025-02-07 14:53:19 +00001547static bool api_mode_valid_owned_and_exclusive(mm_mode_t mode)
Andrew Scull81e85092018-12-12 12:56:20 +00001548{
Andrew Scullb5f49e02019-10-02 13:20:47 +01001549 return (mode & (MM_MODE_D | MM_MODE_INVALID | MM_MODE_UNOWNED |
1550 MM_MODE_SHARED)) == 0;
Andrew Scull81e85092018-12-12 12:56:20 +00001551}
1552
1553/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001554 * Configures the hypervisor's stage-1 view of the send and receive pages.
Andrew Sculle1322792019-07-01 17:46:10 +01001555 */
Karl Meakin738bee12024-01-12 15:19:45 +00001556static struct ffa_value api_vm_configure_stage1(
1557 struct mm_stage1_locked mm_stage1_locked, struct vm_locked vm_locked,
1558 paddr_t pa_send_begin, paddr_t pa_send_end, paddr_t pa_recv_begin,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001559 paddr_t pa_recv_end, mm_mode_t extra_mode,
Karl Meakin738bee12024-01-12 15:19:45 +00001560 struct mpool *local_page_pool)
Andrew Sculle1322792019-07-01 17:46:10 +01001561{
Karl Meakin738bee12024-01-12 15:19:45 +00001562 struct ffa_value ret;
Andrew Sculle1322792019-07-01 17:46:10 +01001563
Karl Meakin738bee12024-01-12 15:19:45 +00001564 /*
1565 * Map the send page as read-only in the SPMC/hypervisor address space.
1566 */
Andrew Sculle1322792019-07-01 17:46:10 +01001567 vm_locked.vm->mailbox.send =
1568 mm_identity_map(mm_stage1_locked, pa_send_begin, pa_send_end,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001569 MM_MODE_R | extra_mode, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001570 if (!vm_locked.vm->mailbox.send) {
Karl Meakin738bee12024-01-12 15:19:45 +00001571 ret = ffa_error(FFA_NO_MEMORY);
1572 goto out;
Andrew Sculle1322792019-07-01 17:46:10 +01001573 }
1574
1575 /*
Karl Meakin738bee12024-01-12 15:19:45 +00001576 * Map the receive page as writable in the SPMC/hypervisor address
1577 * space. On failure, unmap the send page before returning.
Andrew Sculle1322792019-07-01 17:46:10 +01001578 */
1579 vm_locked.vm->mailbox.recv =
1580 mm_identity_map(mm_stage1_locked, pa_recv_begin, pa_recv_end,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001581 MM_MODE_W | extra_mode, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001582 if (!vm_locked.vm->mailbox.recv) {
Karl Meakin738bee12024-01-12 15:19:45 +00001583 ret = ffa_error(FFA_NO_MEMORY);
Andrew Sculle1322792019-07-01 17:46:10 +01001584 goto fail_undo_send;
1585 }
Karl Meakin738bee12024-01-12 15:19:45 +00001586 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
J-Alves90d30d02025-05-09 16:04:48 +01001587
Andrew Sculle1322792019-07-01 17:46:10 +01001588 goto out;
1589
1590 /*
1591 * The following mappings will not require more memory than is available
1592 * in the local pool.
1593 */
1594fail_undo_send:
1595 vm_locked.vm->mailbox.send = NULL;
Andrew Scull7e8de322019-07-02 13:00:56 +01001596 CHECK(mm_unmap(mm_stage1_locked, pa_send_begin, pa_send_end,
1597 local_page_pool));
Andrew Sculle1322792019-07-01 17:46:10 +01001598
Andrew Sculle1322792019-07-01 17:46:10 +01001599out:
Andrew Sculle1322792019-07-01 17:46:10 +01001600 return ret;
1601}
1602
1603/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001604 * Sanity checks and configures the send and receive pages in the VM stage-2
1605 * and hypervisor stage-1 page tables.
1606 *
1607 * Returns:
1608 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001609 * aligned, are the same or have invalid attributes.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001610 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
1611 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001612 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001613 * - FFA_SUCCESS on success if no further action is needed.
Andrew Sculle1322792019-07-01 17:46:10 +01001614 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001615
1616struct ffa_value api_vm_configure_pages(
1617 struct mm_stage1_locked mm_stage1_locked, struct vm_locked vm_locked,
1618 ipaddr_t send, ipaddr_t recv, uint32_t page_count,
1619 struct mpool *local_page_pool)
Andrew Sculle1322792019-07-01 17:46:10 +01001620{
Manish Pandeyd34f8892020-06-19 17:41:07 +01001621 struct ffa_value ret;
1622 paddr_t pa_send_begin;
1623 paddr_t pa_send_end;
1624 paddr_t pa_recv_begin;
1625 paddr_t pa_recv_end;
Karl Meakin07a69ab2025-02-07 14:53:19 +00001626 mm_mode_t orig_send_mode = 0;
1627 mm_mode_t orig_recv_mode = 0;
1628 mm_mode_t extra_mode;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001629
1630 /* We only allow these to be setup once. */
1631 if (vm_locked.vm->mailbox.send || vm_locked.vm->mailbox.recv) {
Karl Meakin738bee12024-01-12 15:19:45 +00001632 dlog_error("%s: Mailboxes have already been setup for VM %#x\n",
1633 __func__, vm_locked.vm->id);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001634 ret = ffa_error(FFA_DENIED);
1635 goto out;
1636 }
1637
1638 /* Hafnium only supports a fixed size of RX/TX buffers. */
1639 if (page_count != HF_MAILBOX_SIZE / FFA_PAGE_SIZE) {
Karl Meakine8937d92024-03-19 16:04:25 +00001640 dlog_error("%s: Page count must be %zu, it is %d\n", __func__,
Karl Meakin738bee12024-01-12 15:19:45 +00001641 HF_MAILBOX_SIZE / FFA_PAGE_SIZE, page_count);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001642 ret = ffa_error(FFA_INVALID_PARAMETERS);
1643 goto out;
1644 }
1645
1646 /* Fail if addresses are not page-aligned. */
1647 if (!is_aligned(ipa_addr(send), PAGE_SIZE) ||
1648 !is_aligned(ipa_addr(recv), PAGE_SIZE)) {
Karl Meakin738bee12024-01-12 15:19:45 +00001649 dlog_error("%s: Mailbox buffers not page-aligned\n", __func__);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001650 ret = ffa_error(FFA_INVALID_PARAMETERS);
1651 goto out;
1652 }
1653
1654 /* Convert to physical addresses. */
1655 pa_send_begin = pa_from_ipa(send);
1656 pa_send_end = pa_add(pa_send_begin, HF_MAILBOX_SIZE);
1657 pa_recv_begin = pa_from_ipa(recv);
1658 pa_recv_end = pa_add(pa_recv_begin, HF_MAILBOX_SIZE);
1659
1660 /* Fail if the same page is used for the send and receive pages. */
1661 if (pa_addr(pa_send_begin) == pa_addr(pa_recv_begin)) {
Karl Meakin738bee12024-01-12 15:19:45 +00001662 dlog_error("%s: Mailbox buffers overlap\n", __func__);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001663 ret = ffa_error(FFA_INVALID_PARAMETERS);
1664 goto out;
1665 }
Andrew Sculle1322792019-07-01 17:46:10 +01001666
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001667 /* Set stage 2 translation tables only for virtual FF-A instances. */
1668 if (vm_id_is_current_world(vm_locked.vm->id)) {
1669 /*
1670 * Ensure the pages are valid, owned and exclusive to the VM and
1671 * that the VM has the required access to the memory.
1672 */
1673 if (!vm_mem_get_mode(vm_locked, send, ipa_add(send, PAGE_SIZE),
1674 &orig_send_mode) ||
1675 !api_mode_valid_owned_and_exclusive(orig_send_mode) ||
1676 (orig_send_mode & MM_MODE_R) == 0 ||
1677 (orig_send_mode & MM_MODE_W) == 0) {
1678 dlog_error(
1679 "VM doesn't have required access rights to map "
1680 "TX buffer in stage 2.\n");
1681 ret = ffa_error(FFA_INVALID_PARAMETERS);
1682 goto out;
1683 }
Manish Pandeyd34f8892020-06-19 17:41:07 +01001684
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001685 if (!vm_mem_get_mode(vm_locked, recv, ipa_add(recv, PAGE_SIZE),
1686 &orig_recv_mode) ||
1687 !api_mode_valid_owned_and_exclusive(orig_recv_mode) ||
1688 (orig_recv_mode & MM_MODE_R) == 0) {
1689 dlog_error(
1690 "VM doesn't have required access rights to map "
1691 "RX buffer in stage 2.\n");
1692 ret = ffa_error(FFA_INVALID_PARAMETERS);
1693 goto out;
1694 }
Andrew Sculle1322792019-07-01 17:46:10 +01001695
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001696 /* Take memory ownership away from the VM and mark as shared. */
Karl Meakin07a69ab2025-02-07 14:53:19 +00001697 mm_mode_t mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R |
1698 MM_MODE_W;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001699 if (vm_locked.vm->el0_partition) {
1700 mode |= MM_MODE_USER | MM_MODE_NG;
1701 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001702
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001703 if (!vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
1704 mode, local_page_pool, NULL)) {
1705 dlog_error(
1706 "Cannot allocate a new entry in stage 2 "
1707 "translation table.\n");
1708 ret = ffa_error(FFA_NO_MEMORY);
1709 goto out;
1710 }
Andrew Sculle1322792019-07-01 17:46:10 +01001711
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001712 mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R;
1713 if (vm_locked.vm->el0_partition) {
1714 mode |= MM_MODE_USER | MM_MODE_NG;
1715 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001716
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001717 if (!vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
1718 mode, local_page_pool, NULL)) {
1719 /* TODO: partial defrag of failed range. */
1720 /* Recover any memory consumed in failed mapping. */
Karl Meakin738bee12024-01-12 15:19:45 +00001721 dlog_error("%s: cannot map recv page\n", __func__);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001722 vm_ptable_defrag(vm_locked, local_page_pool);
Karl Meakin738bee12024-01-12 15:19:45 +00001723 ret = ffa_error(FFA_NO_MEMORY);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001724 goto fail_undo_send;
1725 }
Karl Meakin738bee12024-01-12 15:19:45 +00001726 } else {
1727 ret = arch_other_world_vm_configure_rxtx_map(
1728 vm_locked, local_page_pool, pa_send_begin, pa_send_end,
1729 pa_recv_begin, pa_recv_end);
1730 if (ret.func != FFA_SUCCESS_32) {
1731 goto out;
1732 }
Andrew Sculle1322792019-07-01 17:46:10 +01001733 }
1734
Karl Meakin07a69ab2025-02-07 14:53:19 +00001735 /* Get extra send/recv pages mapping mode for the given VM ID. */
1736 extra_mode = arch_mm_extra_mode_from_vm(vm_locked.vm->id);
Olivier Deprez96a2a262020-06-11 17:21:38 +02001737
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001738 /*
1739 * For EL0 partitions, since both the partition and the hypervisor code
1740 * use the EL2&0 translation regime, it is critical to mark the mappings
1741 * of the send and recv buffers as non-global in the TLB. For one, if we
1742 * dont mark it as non-global, it would cause TLB conflicts since there
1743 * would be an identity mapping with non-global attribute in the
1744 * partitions page tables, but another identity mapping in the
1745 * hypervisor page tables with the global attribute. The other issue is
1746 * one of security, we dont want other partitions to be able to access
1747 * other partitions buffers through cached translations.
1748 */
1749 if (vm_locked.vm->el0_partition) {
Karl Meakin07a69ab2025-02-07 14:53:19 +00001750 extra_mode |= MM_MODE_NG;
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001751 }
1752
Karl Meakin07a69ab2025-02-07 14:53:19 +00001753 ret = api_vm_configure_stage1(mm_stage1_locked, vm_locked,
1754 pa_send_begin, pa_send_end, pa_recv_begin,
1755 pa_recv_end, extra_mode, local_page_pool);
Karl Meakin738bee12024-01-12 15:19:45 +00001756 if (ret.func != FFA_SUCCESS_32) {
Andrew Sculle1322792019-07-01 17:46:10 +01001757 goto fail_undo_send_and_recv;
1758 }
1759
Manish Pandeyd34f8892020-06-19 17:41:07 +01001760 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Sculle1322792019-07-01 17:46:10 +01001761 goto out;
1762
Andrew Sculle1322792019-07-01 17:46:10 +01001763fail_undo_send_and_recv:
Andrew Scull3c257452019-11-26 13:32:50 +00001764 CHECK(vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001765 orig_recv_mode, local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +01001766
1767fail_undo_send:
Andrew Scull3c257452019-11-26 13:32:50 +00001768 CHECK(vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
Manish Pandeyd34f8892020-06-19 17:41:07 +01001769 orig_send_mode, local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +01001770
1771out:
Andrew Sculle1322792019-07-01 17:46:10 +01001772 return ret;
1773}
1774
Karl Meakinb9705e22024-04-05 13:58:28 +01001775/**
1776 * Read the buffer addresses and VM ID of an FFA_RXTX_MAP request. Handles
1777 * forwarded messages by reading from the hypervisor's TX buffer.
1778 *
1779 * Returns the VM/SP ID on success.
1780 *
1781 * Returns `HF_INVALID_VM_ID` when the arguments provided via the ABI
1782 * FFA_RXTX_MAP indicate the SPMC should retrieve the RXTX description from the
1783 * Hypervisor RXTX buffers, and the hypervisor hasn't given its own RXTX buffers
1784 * for the SPMC to map.
1785 */
1786static ffa_id_t api_get_rxtx_description(struct vm *current_vm, ipaddr_t *send,
1787 ipaddr_t *recv, uint32_t *page_count)
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001788{
Karl Meakinb9705e22024-04-05 13:58:28 +01001789 bool forwarded;
1790 struct vm_locked vm_locked;
1791 ffa_id_t owner_vm_id;
1792 struct ffa_endpoint_rx_tx_descriptor *endpoint_desc;
1793 struct ffa_composite_memory_region *rx_region;
1794 struct ffa_composite_memory_region *tx_region;
1795
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001796 /*
1797 * If the message has been forwarded the effective addresses are in
1798 * hypervisor's TX buffer.
1799 */
Karl Meakinb9705e22024-04-05 13:58:28 +01001800 forwarded = (current_vm->id == HF_OTHER_WORLD_ID) &&
1801 (ipa_addr(*send) == 0) && (ipa_addr(*recv) == 0) &&
1802 (*page_count == 0);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001803
1804 if (forwarded) {
Karl Meakinb9705e22024-04-05 13:58:28 +01001805 vm_locked = vm_lock(current_vm);
1806 endpoint_desc = (struct ffa_endpoint_rx_tx_descriptor *)
1807 vm_locked.vm->mailbox.send;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001808
Karl Meakinb9705e22024-04-05 13:58:28 +01001809 if (endpoint_desc == NULL) {
1810 dlog_error(
1811 "Trying to access RXTX description, but "
1812 "hypervisor has not provided RXTX buffers\n");
1813 vm_unlock(&vm_locked);
1814 return HF_INVALID_VM_ID;
1815 }
1816
1817 rx_region = ffa_endpoint_get_rx_memory_region(endpoint_desc);
1818 tx_region = ffa_endpoint_get_tx_memory_region(endpoint_desc);
1819
1820 owner_vm_id = endpoint_desc->endpoint_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001821 *recv = ipa_init(rx_region->constituents[0].address);
1822 *send = ipa_init(tx_region->constituents[0].address);
1823 *page_count = rx_region->constituents[0].page_count;
J-Alves28ad9b42022-12-08 12:19:43 +00001824
1825 vm_unlock(&vm_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001826 } else {
Karl Meakinb9705e22024-04-05 13:58:28 +01001827 owner_vm_id = current_vm->id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001828 }
Karl Meakinb9705e22024-04-05 13:58:28 +01001829
1830 return owner_vm_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001831}
Karl Meakinb9705e22024-04-05 13:58:28 +01001832
Andrew Sculle1322792019-07-01 17:46:10 +01001833/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001834 * Configures the VM to send/receive data through the specified pages. The pages
Manish Pandeyd34f8892020-06-19 17:41:07 +01001835 * must not be shared. Locking of the page tables combined with a local memory
1836 * pool ensures there will always be enough memory to recover from any errors
1837 * that arise. The stage-1 page tables must be locked so memory cannot be taken
1838 * by another core which could result in this transaction being unable to roll
1839 * back in the case of an error.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001840 *
1841 * Returns:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001842 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001843 * aligned, are the same or have invalid attributes.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001844 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001845 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001846 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001847 * - FFA_SUCCESS on success if no further action is needed.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001848 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001849struct ffa_value api_ffa_rxtx_map(ipaddr_t send, ipaddr_t recv,
Federico Recanati9f1b6532022-04-14 13:15:28 +02001850 uint32_t page_count, struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001851{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001852 struct ffa_value ret;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001853 struct vm_locked owner_vm_locked;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001854 struct mm_stage1_locked mm_stage1_locked;
1855 struct mpool local_page_pool;
J-Alves19e20cf2023-08-02 12:48:55 +01001856 ffa_id_t owner_vm_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001857
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001858 /*
1859 * Get the original buffer addresses and VM ID in case of forwarded
1860 * message.
1861 */
Karl Meakinb9705e22024-04-05 13:58:28 +01001862 owner_vm_id = api_get_rxtx_description(current->vm, &send, &recv,
1863 &page_count);
1864 if (owner_vm_id == HF_INVALID_VM_ID) {
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001865 dlog_error("Cannot map RX/TX for invalid VM ID %#x.\n",
1866 owner_vm_id);
Karl Meakinb9705e22024-04-05 13:58:28 +01001867 return ffa_error(FFA_INVALID_PARAMETERS);
1868 }
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001869
Karl Meakin117c8082024-12-04 16:03:28 +00001870 owner_vm_locked = ffa_vm_find_locked_create(owner_vm_id);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001871 if (owner_vm_locked.vm == NULL) {
1872 dlog_error("Cannot map RX/TX for VM ID %#x, not found.\n",
1873 owner_vm_id);
1874 return ffa_error(FFA_DENIED);
1875 }
Andrew Scull220e6212018-12-21 18:09:00 +00001876
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001877 /*
Manish Pandeyd34f8892020-06-19 17:41:07 +01001878 * Create a local pool so any freed memory can't be used by another
1879 * thread. This is to ensure the original mapping can be restored if any
1880 * stage of the process fails.
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001881 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001882 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
1883
Manish Pandeyd34f8892020-06-19 17:41:07 +01001884 mm_stage1_locked = mm_lock_stage1();
Andrew Scull220e6212018-12-21 18:09:00 +00001885
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001886 ret = api_vm_configure_pages(mm_stage1_locked, owner_vm_locked, send,
1887 recv, page_count, &local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001888 if (ret.func != FFA_SUCCESS_32) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001889 goto exit;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001890 }
1891
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001892 /* Forward buffer mapping to SPMC if coming from a VM. */
Karl Meakin117c8082024-12-04 16:03:28 +00001893 ffa_setup_rxtx_map_forward(owner_vm_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001894
Federico Recanati9f1b6532022-04-14 13:15:28 +02001895 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Scull220e6212018-12-21 18:09:00 +00001896
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001897exit:
Manish Pandeyd34f8892020-06-19 17:41:07 +01001898 mpool_fini(&local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001899 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001900 vm_unlock(&owner_vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001901
1902 return ret;
1903}
1904
1905/**
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001906 * Unmaps the RX/TX buffer pair with a partition or partition manager from the
1907 * translation regime of the caller. Unmap the region for the hypervisor and
1908 * set the memory region to owned and exclusive for the component. Since the
1909 * memory region mapped in the page table, when the buffers were originally
1910 * created we can safely remap it.
1911 *
1912 * Returns:
1913 * - FFA_ERROR FFA_INVALID_PARAMETERS if there is no buffer pair registered on
1914 * behalf of the caller.
1915 * - FFA_SUCCESS on success if no further action is needed.
1916 */
J-Alves19e20cf2023-08-02 12:48:55 +01001917struct ffa_value api_ffa_rxtx_unmap(ffa_id_t allocator_id, struct vcpu *current)
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001918{
1919 struct vm *vm = current->vm;
1920 struct vm_locked vm_locked;
J-Alves19e20cf2023-08-02 12:48:55 +01001921 ffa_id_t owner_vm_id;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001922 struct mm_stage1_locked mm_stage1_locked;
1923 paddr_t send_pa_begin;
1924 paddr_t send_pa_end;
1925 paddr_t recv_pa_begin;
1926 paddr_t recv_pa_end;
Federico Recanati8da9e332022-02-10 11:00:17 +01001927 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001928
J-Alves661e1b72023-08-02 13:39:40 +01001929 if (vm->id == HF_HYPERVISOR_VM_ID && !ffa_is_vm_id(allocator_id)) {
Olivier Deprez106c8ce2024-02-08 11:49:02 +01001930 dlog_verbose(
J-Alves9bd324a2023-01-12 10:52:52 +00001931 "The Hypervisor must specify a valid VM ID in register "
1932 "W1, if FFA_RXTX_UNMAP call forwarded to SPM.\n");
1933 return ffa_error(FFA_INVALID_PARAMETERS);
1934 }
1935
Federico Recanati8da9e332022-02-10 11:00:17 +01001936 /* Ensure `allocator_id` is set only at Non-Secure Physical instance. */
1937 if (vm_id_is_current_world(vm->id) && (allocator_id != 0)) {
J-Alves9bd324a2023-01-12 10:52:52 +00001938 dlog_error(
1939 "The register W1 (containing ID) must be 0 at virtual "
1940 "instances.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001941 return ffa_error(FFA_INVALID_PARAMETERS);
1942 }
1943
1944 /* VM ID of which buffers have to be unmapped. */
1945 owner_vm_id = (allocator_id != 0) ? allocator_id : vm->id;
1946
Karl Meakin117c8082024-12-04 16:03:28 +00001947 vm_locked = ffa_vm_find_locked(owner_vm_id);
Federico Recanati8da9e332022-02-10 11:00:17 +01001948 vm = vm_locked.vm;
1949 if (vm == NULL) {
1950 dlog_error("Cannot unmap RX/TX for VM ID %#x, not found.\n",
1951 owner_vm_id);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001952 return ffa_error(FFA_INVALID_PARAMETERS);
1953 }
1954
1955 /* Get send and receive buffers. */
1956 if (vm->mailbox.send == NULL || vm->mailbox.recv == NULL) {
Olivier Deprez86d87ae2021-08-19 14:27:46 +02001957 dlog_verbose(
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001958 "No buffer pair registered on behalf of the caller.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001959 ret = ffa_error(FFA_INVALID_PARAMETERS);
1960 goto out;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001961 }
1962
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001963 vm_unmap_rxtx(vm_locked, &api_page_pool);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001964
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001965 if (!vm_id_is_current_world(owner_vm_id)) {
1966 send_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.send));
1967 send_pa_end = pa_add(send_pa_begin, HF_MAILBOX_SIZE);
1968 recv_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.recv));
1969 recv_pa_end = pa_add(recv_pa_begin, HF_MAILBOX_SIZE);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001970
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001971 mm_stage1_locked = mm_lock_stage1();
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001972
Karl Meakin738bee12024-01-12 15:19:45 +00001973 ret = arch_other_world_vm_configure_rxtx_unmap(
1974 vm_locked, &api_page_pool, send_pa_begin, send_pa_end,
1975 recv_pa_begin, recv_pa_end);
1976 if (ret.func != FFA_SUCCESS_32) {
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001977 mm_unlock_stage1(&mm_stage1_locked);
Karl Meakin738bee12024-01-12 15:19:45 +00001978 goto out;
1979 }
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001980
1981 /* Unmap the buffers in the partition manager. */
1982 CHECK(mm_unmap(mm_stage1_locked, send_pa_begin, send_pa_end,
1983 &api_page_pool));
1984 CHECK(mm_unmap(mm_stage1_locked, recv_pa_begin, recv_pa_end,
1985 &api_page_pool));
1986
1987 vm->mailbox.send = NULL;
1988 vm->mailbox.recv = NULL;
1989
1990 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01001991 }
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001992
Madhukar Pappireddycbb836c2025-05-08 17:16:42 -05001993 ffa_vm_nwd_free(vm_locked);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001994
Federico Recanati8da9e332022-02-10 11:00:17 +01001995 /* Forward buffer unmapping to SPMC if coming from a VM. */
Karl Meakin117c8082024-12-04 16:03:28 +00001996 ffa_setup_rxtx_unmap_forward(vm_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01001997
Federico Recanati8da9e332022-02-10 11:00:17 +01001998out:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001999 vm_unlock(&vm_locked);
2000
Federico Recanati8da9e332022-02-10 11:00:17 +01002001 return ret;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002002}
2003
Karl Meakin355d5c22024-12-12 18:04:56 +00002004static struct ffa_value api_ffa_msg_send2_copy_data(
2005 struct ffa_partition_rxtx_header *header, struct vm *receiver_vm,
Karl Meakina78337f2024-12-12 23:30:06 +00002006 struct vm_locked sender_locked)
Karl Meakin355d5c22024-12-12 18:04:56 +00002007{
Karl Meakina78337f2024-12-12 23:30:06 +00002008 const void *sender_tx_buffer = sender_locked.vm->mailbox.send;
Karl Meakin355d5c22024-12-12 18:04:56 +00002009 uint32_t total_size;
Karl Meakina78337f2024-12-12 23:30:06 +00002010 uint32_t min_offset;
Karl Meakin355d5c22024-12-12 18:04:56 +00002011
Karl Meakina78337f2024-12-12 23:30:06 +00002012 switch (sender_locked.vm->ffa_version) {
2013 case FFA_VERSION_1_0:
2014 dlog_verbose("Indirect messaging not supported in v1.0\n");
2015 return ffa_error(FFA_NOT_SUPPORTED);
2016 case FFA_VERSION_1_1:
2017 min_offset = FFA_RXTX_HEADER_SIZE_V1_1;
2018 break;
2019 default:
2020 min_offset = FFA_RXTX_HEADER_SIZE;
2021 break;
2022 }
2023
2024 if (header->offset < min_offset) {
2025 dlog_error(
2026 "Indirect message payload overlaps with header (%u < "
2027 "%u, version = %#x)\n",
2028 header->offset, min_offset,
2029 sender_locked.vm->ffa_version);
Karl Meakin355d5c22024-12-12 18:04:56 +00002030 return ffa_error(FFA_INVALID_PARAMETERS);
2031 }
2032
Karl Meakina78337f2024-12-12 23:30:06 +00002033 /*
2034 * Check the size of transfer.
2035 * Check for overflow in the sum so that very large offsets and/or sizes
2036 * do not pass the check.
2037 */
2038 if (add_overflow(header->offset, header->size, &total_size)) {
2039 dlog_error(
2040 "Overflow calculating message size (offset = %u, size "
2041 "= %u)\n",
2042 header->offset, header->size);
2043 return ffa_error(FFA_INVALID_PARAMETERS);
2044 }
2045
2046 if (total_size > FFA_MSG_PAYLOAD_MAX) {
2047 dlog_error("Message is too big (%u > %zu)\n", total_size,
2048 FFA_MSG_PAYLOAD_MAX);
Karl Meakin355d5c22024-12-12 18:04:56 +00002049 return ffa_error(FFA_INVALID_PARAMETERS);
2050 }
2051
2052 /* Copy data. */
2053 if (!memcpy_trapped(receiver_vm->mailbox.recv, FFA_MSG_PAYLOAD_MAX,
2054 sender_tx_buffer, total_size)) {
2055 dlog_error(
Karl Meakina78337f2024-12-12 23:30:06 +00002056 "%s: Failed to copy message to receiver's (%x) RX "
Karl Meakin355d5c22024-12-12 18:04:56 +00002057 "buffer.\n",
2058 __func__, receiver_vm->id);
2059 return ffa_error(FFA_ABORTED);
2060 }
2061
2062 receiver_vm->mailbox.recv_size = total_size;
2063 receiver_vm->mailbox.recv_sender = header->sender;
2064 receiver_vm->mailbox.recv_func = FFA_MSG_SEND2_32;
2065 receiver_vm->mailbox.state = MAILBOX_STATE_FULL;
2066
2067 return (struct ffa_value){.func = FFA_SUCCESS_32};
2068}
2069
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002070/**
Federico Recanati25053ee2022-03-14 15:01:53 +01002071 * Copies data from the sender's send buffer to the recipient's receive buffer
2072 * and notifies the receiver.
2073 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002074struct ffa_value api_ffa_msg_send2(ffa_id_t sender_id, uint32_t flags,
Federico Recanati25053ee2022-03-14 15:01:53 +01002075 struct vcpu *current)
2076{
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002077 struct vm *current_vm = current->vm;
2078 struct vm *receiver_vm;
2079 struct vm_locked receiver_locked;
Federico Recanati25053ee2022-03-14 15:01:53 +01002080 struct vm_locked sender_locked;
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002081 const void *sender_tx_buffer;
Federico Recanati25053ee2022-03-14 15:01:53 +01002082 struct ffa_value ret;
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002083 ffa_id_t header_sender_id;
2084 ffa_id_t header_receiver_id;
Federico Recanati25053ee2022-03-14 15:01:53 +01002085
Karl Meakina5ea9092024-05-28 15:40:33 +01002086 alignas(8) struct ffa_partition_rxtx_header header;
2087
Federico Recanati25053ee2022-03-14 15:01:53 +01002088 /* Only Hypervisor can set `sender_vm_id` when forwarding messages. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002089 if (current_vm->id != HF_HYPERVISOR_VM_ID && sender_id != 0) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002090 dlog_error("Sender VM ID must be zero.\n");
2091 return ffa_error(FFA_INVALID_PARAMETERS);
2092 }
2093
Federico Recanati25053ee2022-03-14 15:01:53 +01002094 /*
2095 * Get message sender's mailbox, which can be different to the `from` vm
2096 * when the message is forwarded.
2097 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002098 sender_id = (sender_id != 0) ? sender_id : current_vm->id;
2099 sender_locked = ffa_vm_find_locked(sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002100 if (sender_locked.vm == NULL) {
2101 dlog_error("Cannot send message from VM ID %#x, not found.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002102 sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002103 return ffa_error(FFA_DENIED);
2104 }
2105
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002106 sender_tx_buffer = sender_locked.vm->mailbox.send;
2107 if (sender_tx_buffer == NULL) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002108 dlog_error("Cannot retrieve TX buffer for VM ID %#x.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002109 sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002110 ret = ffa_error(FFA_DENIED);
2111 goto out_unlock_sender;
2112 }
2113
2114 /*
2115 * Copy message header as safety measure to avoid multiple accesses to
2116 * unsafe memory which could be 'corrupted' between safety checks and
2117 * final buffer copy.
Karl Meakina78337f2024-12-12 23:30:06 +00002118 * This includes the UUID added in v1.2. Messages that do not specify a
2119 * UUID (v1.1 or earlier) will leave the UUID unspecified, so this is
2120 * backwards compatible.
Federico Recanati25053ee2022-03-14 15:01:53 +01002121 */
Karl Meakinbf580c22024-12-12 14:31:06 +00002122 if (!memcpy_trapped(&header, sizeof(header), sender_tx_buffer,
J-Alves8a5fd9d2024-04-09 11:22:49 +01002123 FFA_RXTX_HEADER_SIZE)) {
2124 dlog_error(
2125 "%s: Failed to copy message from sender's(%x) TX "
2126 "buffer.\n",
2127 __func__, sender_locked.vm->id);
2128 ret = ffa_error(FFA_ABORTED);
2129 goto out_unlock_sender;
2130 }
2131
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002132 header_sender_id = header.sender;
2133 header_receiver_id = header.receiver;
Federico Recanati25053ee2022-03-14 15:01:53 +01002134
2135 /* Ensure Sender IDs from API and from message header match. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002136 if (sender_id != header_sender_id) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002137 dlog_error(
2138 "Message sender VM ID (%#x) doesn't match header's VM "
2139 "ID (%#x).\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002140 sender_id, header_sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002141 ret = ffa_error(FFA_INVALID_PARAMETERS);
2142 goto out_unlock_sender;
2143 }
2144
2145 /* Disallow reflexive requests as this suggests an error in the VM. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002146 if (header_receiver_id == header_sender_id) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002147 dlog_error("Sender and receive VM IDs must be different.\n");
2148 ret = ffa_error(FFA_INVALID_PARAMETERS);
2149 goto out_unlock_sender;
2150 }
2151
Federico Recanati7b39ff22022-03-14 15:01:53 +01002152 /* `flags` can be set only at secure virtual FF-A instances. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002153 if (ffa_is_vm_id(header_sender_id) && flags != 0) {
Federico Recanati7b39ff22022-03-14 15:01:53 +01002154 dlog_error("flags must be zero.\n");
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002155 ret = ffa_error(FFA_INVALID_PARAMETERS);
2156 goto out_unlock_sender;
Federico Recanati7b39ff22022-03-14 15:01:53 +01002157 }
2158
Federico Recanati25053ee2022-03-14 15:01:53 +01002159 /*
2160 * Check if the message has to be forwarded to the SPMC, in
2161 * this case return, the SPMC will handle the buffer copy.
2162 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002163 if (ffa_indirect_msg_send2_forward(header_receiver_id, header_sender_id,
2164 &ret)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002165 goto out_unlock_sender;
2166 }
2167
2168 /* Ensure the receiver VM exists. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002169 receiver_locked = ffa_vm_find_locked(header_receiver_id);
2170 receiver_vm = receiver_locked.vm;
Federico Recanati25053ee2022-03-14 15:01:53 +01002171
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002172 if (receiver_vm == NULL) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002173 dlog_error("Cannot deliver message to VM %#x, not found.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002174 header_receiver_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002175 ret = ffa_error(FFA_INVALID_PARAMETERS);
2176 goto out_unlock_sender;
2177 }
2178
2179 /*
2180 * Check sender and receiver can use indirect messages.
2181 * Sender is the VM/SP who originally sent the message, not the
2182 * hypervisor possibly relaying it.
2183 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002184 if (!ffa_indirect_msg_is_supported(sender_locked, receiver_locked)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002185 dlog_verbose("VM %#x doesn't support indirect message\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002186 header_sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002187 ret = ffa_error(FFA_DENIED);
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002188 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002189 }
2190
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002191 if (vm_is_mailbox_busy(receiver_locked)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002192 dlog_error(
2193 "Cannot deliver message to VM %#x, RX buffer not "
2194 "ready.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002195 header_receiver_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002196 ret = ffa_error(FFA_BUSY);
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002197 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002198 }
2199
Federico Recanati644f0462022-03-17 12:04:00 +01002200 /* Acquire receiver's RX buffer. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002201 if (!ffa_setup_acquire_receiver_rx(receiver_locked, &ret)) {
2202 dlog_error("Failed to acquire RX buffer for VM %#x\n",
2203 receiver_vm->id);
2204 goto out_unlock_both;
Federico Recanati644f0462022-03-17 12:04:00 +01002205 }
2206
Karl Meakina78337f2024-12-12 23:30:06 +00002207 ret = api_ffa_msg_send2_copy_data(&header, receiver_vm, sender_locked);
Karl Meakin355d5c22024-12-12 18:04:56 +00002208 if (ret.func != FFA_SUCCESS_32) {
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002209 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002210 }
2211
J-Alves3bb82592023-01-23 11:20:54 +00002212 /*
2213 * Set framework notifications, only if the SP has enabled
2214 * receipt of notifications.
2215 * If VMs have provided the RX buffer it is implied they already
2216 * support indirect messaging, and therefore framework notifications.
2217 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002218 if (ffa_is_vm_id(receiver_locked.vm->id) ||
2219 vm_are_notifications_enabled(receiver_locked.vm)) {
J-Alves3bb82592023-01-23 11:20:54 +00002220 ffa_notifications_bitmap_t rx_buffer_full =
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002221 ffa_is_vm_id(header_sender_id)
J-Alves3bb82592023-01-23 11:20:54 +00002222 ? FFA_NOTIFICATION_HYP_BUFFER_FULL_MASK
2223 : FFA_NOTIFICATION_SPM_BUFFER_FULL_MASK;
Federico Recanati25053ee2022-03-14 15:01:53 +01002224
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002225 vm_notifications_framework_set_pending(receiver_locked,
J-Alves3bb82592023-01-23 11:20:54 +00002226 rx_buffer_full);
2227
2228 if ((FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) == 0) {
2229 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
2230 vcpu_index(current));
Karl Meakin117c8082024-12-04 16:03:28 +00002231 ffa_notifications_sri_trigger_not_delayed(current->cpu);
J-Alves3bb82592023-01-23 11:20:54 +00002232 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00002233 ffa_notifications_sri_set_delayed(current->cpu);
J-Alves3bb82592023-01-23 11:20:54 +00002234 }
Federico Recanati25053ee2022-03-14 15:01:53 +01002235 }
2236
2237 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2238
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002239out_unlock_both:
2240 vm_unlock(&receiver_locked);
Federico Recanati25053ee2022-03-14 15:01:53 +01002241
2242out_unlock_sender:
2243 vm_unlock(&sender_locked);
2244
2245 return ret;
2246}
2247
2248/**
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002249 * Releases the caller's mailbox so that a new message can be received. The
2250 * caller must have copied out all data they wish to preserve as new messages
2251 * will overwrite the old and will arrive asynchronously.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002252 *
2253 * Returns:
Federico Recanati7bef0b92022-03-17 14:56:22 +01002254 * - FFA_ERROR FFA_INVALID_PARAMETERS if message is forwarded to SPMC but
2255 * there's no buffer pair mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002256 * - FFA_ERROR FFA_DENIED on failure, if the mailbox hasn't been read.
2257 * - FFA_SUCCESS on success if no further action is needed.
2258 * - FFA_RX_RELEASE if it was called by the primary VM and the primary VM now
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002259 * needs to wake up or kick waiters. Waiters should be retrieved by calling
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002260 * hf_mailbox_waiter_get.
2261 */
J-Alves19e20cf2023-08-02 12:48:55 +01002262struct ffa_value api_ffa_rx_release(ffa_id_t receiver_id, struct vcpu *current)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002263{
Federico Recanati7bef0b92022-03-17 14:56:22 +01002264 struct vm *current_vm = current->vm;
2265 struct vm *vm;
2266 struct vm_locked vm_locked;
J-Alves19e20cf2023-08-02 12:48:55 +01002267 ffa_id_t current_vm_id = current_vm->id;
2268 ffa_id_t release_vm_id;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002269 struct ffa_value ret;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002270
Federico Recanati7bef0b92022-03-17 14:56:22 +01002271 /* `receiver_id` can be set only at Non-Secure Physical interface. */
2272 if (vm_id_is_current_world(current_vm_id) && (receiver_id != 0)) {
2273 dlog_error("Invalid `receiver_id`, must be zero.\n");
2274 return ffa_error(FFA_INVALID_PARAMETERS);
2275 }
2276
2277 /*
2278 * VM ID to be released: `receiver_id` if message has been forwarded by
2279 * Hypervisor to release a VM's buffer, current VM ID otherwise.
2280 */
2281 if (vm_id_is_current_world(current_vm_id) || (receiver_id == 0)) {
2282 release_vm_id = current_vm_id;
2283 } else {
2284 release_vm_id = receiver_id;
2285 }
2286
Karl Meakin117c8082024-12-04 16:03:28 +00002287 vm_locked = ffa_vm_find_locked(release_vm_id);
Federico Recanati7bef0b92022-03-17 14:56:22 +01002288 vm = vm_locked.vm;
2289 if (vm == NULL) {
2290 dlog_error("No buffer registered for VM ID %#x.\n",
2291 release_vm_id);
2292 return ffa_error(FFA_INVALID_PARAMETERS);
2293 }
2294
Karl Meakin117c8082024-12-04 16:03:28 +00002295 if (ffa_setup_rx_release_forward(vm_locked, &ret)) {
Federico Recanati7bef0b92022-03-17 14:56:22 +01002296 goto out;
2297 }
2298
Karl Meakin1064a9c2024-06-04 17:20:43 +01002299 ret = api_release_mailbox(vm_locked);
Federico Recanati7bef0b92022-03-17 14:56:22 +01002300
2301out:
2302 vm_unlock(&vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01002303
2304 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01002305}
Andrew Walbran318f5732018-11-20 16:23:42 +00002306
2307/**
Federico Recanati644f0462022-03-17 12:04:00 +01002308 * Acquire ownership of an RX buffer before writing to it. Both
2309 * Hypervisor and SPMC are producers of VM's RX buffer, and they
2310 * could contend for the same buffer. SPMC owns VM's RX buffer after
2311 * it's mapped in its translation regime. This ABI should be
2312 * used by the Hypervisor to get the ownership of a VM's RX buffer
2313 * from the SPMC solving the aforementioned possible contention.
2314 *
2315 * Returns:
2316 * - FFA_DENIED: callee cannot relinquish ownership of RX buffer.
2317 * - FFA_INVALID_PARAMETERS: there is no buffer pair registered for the VM.
2318 * - FFA_NOT_SUPPORTED: function not implemented at the FF-A instance.
2319 */
J-Alves19e20cf2023-08-02 12:48:55 +01002320struct ffa_value api_ffa_rx_acquire(ffa_id_t receiver_id, struct vcpu *current)
Federico Recanati644f0462022-03-17 12:04:00 +01002321{
2322 struct vm_locked receiver_locked;
2323 struct vm *receiver;
2324 struct ffa_value ret;
2325
2326 if ((current->vm->id != HF_HYPERVISOR_VM_ID) ||
J-Alves661e1b72023-08-02 13:39:40 +01002327 !ffa_is_vm_id(receiver_id)) {
Federico Recanati644f0462022-03-17 12:04:00 +01002328 dlog_error(
2329 "FFA_RX_ACQUIRE not supported at this FF-A "
2330 "instance.\n");
2331 return ffa_error(FFA_NOT_SUPPORTED);
2332 }
2333
Karl Meakin117c8082024-12-04 16:03:28 +00002334 receiver_locked = ffa_vm_find_locked(receiver_id);
Federico Recanati644f0462022-03-17 12:04:00 +01002335 receiver = receiver_locked.vm;
2336
2337 if (receiver == NULL || receiver->mailbox.recv == NULL) {
2338 dlog_error("Cannot retrieve RX buffer for VM ID %#x.\n",
2339 receiver_id);
2340 ret = ffa_error(FFA_INVALID_PARAMETERS);
2341 goto out;
2342 }
2343
2344 if (receiver->mailbox.state != MAILBOX_STATE_EMPTY) {
2345 dlog_error("Mailbox busy for VM ID %#x.\n", receiver_id);
2346 ret = ffa_error(FFA_DENIED);
2347 goto out;
2348 }
2349
J-Alvese8c8c2b2022-12-16 15:34:48 +00002350 receiver->mailbox.state = MAILBOX_STATE_OTHER_WORLD_OWNED;
Federico Recanati644f0462022-03-17 12:04:00 +01002351
2352 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2353
2354out:
2355 vm_unlock(&receiver_locked);
2356
2357 return ret;
2358}
2359
J-Alvescc542042024-07-24 19:13:22 +01002360/*
2361 * Returns true if intid relates with either of those:
2362 * - NPI
2363 * - ME
2364 * - Virtual Timer.
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01002365 * - IPI
J-Alvescc542042024-07-24 19:13:22 +01002366 *
2367 * These are VIs with no expected interrupt descriptor.
2368 */
2369static bool api_is_maintenance_virtual_interrupt(uint32_t intid)
2370{
2371 return intid == HF_NOTIFICATION_PENDING_INTID ||
2372 intid == HF_MANAGED_EXIT_INTID ||
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01002373 intid == HF_VIRTUAL_TIMER_INTID || intid == HF_IPI_INTID;
J-Alvescc542042024-07-24 19:13:22 +01002374}
2375
Federico Recanati644f0462022-03-17 12:04:00 +01002376/**
Andrew Walbran318f5732018-11-20 16:23:42 +00002377 * Enables or disables a given interrupt ID for the calling vCPU.
2378 *
2379 * Returns 0 on success, or -1 if the intid is invalid.
2380 */
Manish Pandey35e452f2021-02-18 21:36:34 +00002381int64_t api_interrupt_enable(uint32_t intid, bool enable,
2382 enum interrupt_type type, struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00002383{
Manish Pandey35e452f2021-02-18 21:36:34 +00002384 struct vcpu_locked current_locked;
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002385 struct interrupts *interrupts = &current->interrupts;
J-Alvescc542042024-07-24 19:13:22 +01002386 struct interrupt_descriptor *int_desc = NULL;
2387 struct vm *vm = current->vm;
2388 struct vm_locked vm_locked;
2389
2390 int64_t ret = -1;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002391
Andrew Walbran318f5732018-11-20 16:23:42 +00002392 if (intid >= HF_NUM_INTIDS) {
2393 return -1;
2394 }
2395
J-Alvescc542042024-07-24 19:13:22 +01002396 vm_locked = vm_lock(vm);
Manish Pandey35e452f2021-02-18 21:36:34 +00002397 current_locked = vcpu_lock(current);
J-Alvescc542042024-07-24 19:13:22 +01002398
2399 int_desc = vm_interrupt_set_enable(vm_locked, intid, enable);
2400
2401 if (!api_is_maintenance_virtual_interrupt(intid)) {
2402 if (int_desc == NULL) {
2403 dlog_error("%s: invalid interrupt ID.\n", __func__);
2404 goto out;
2405 }
2406
2407 plat_interrupts_configure_interrupt(*int_desc);
2408 }
2409
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00002410 /*
2411 * The type must be set first so that the correct count is modfied.
2412 */
2413 vcpu_virt_interrupt_set_type(interrupts, intid, type);
2414 vcpu_virt_interrupt_enable(current_locked, intid, enable);
Andrew Walbran318f5732018-11-20 16:23:42 +00002415
J-Alvescc542042024-07-24 19:13:22 +01002416 ret = 0;
2417
2418out:
2419 vm_unlock(&vm_locked);
Manish Pandey35e452f2021-02-18 21:36:34 +00002420 vcpu_unlock(&current_locked);
J-Alvescc542042024-07-24 19:13:22 +01002421
2422 return ret;
Andrew Walbran318f5732018-11-20 16:23:42 +00002423}
2424
2425/**
2426 * Returns the ID of the next pending interrupt for the calling vCPU, and
2427 * acknowledges it (i.e. marks it as no longer pending). Returns
2428 * HF_INVALID_INTID if there are no pending interrupts.
2429 */
Madhukar Pappireddyc64d0642024-08-07 16:55:46 -05002430uint32_t api_interrupt_get(struct vcpu_locked current_locked)
Andrew Walbran318f5732018-11-20 16:23:42 +00002431{
Daniel Boulby5df87962025-02-06 11:15:08 +00002432 return vcpu_virt_interrupt_get_pending_and_enabled(current_locked);
Andrew Walbran318f5732018-11-20 16:23:42 +00002433}
2434
2435/**
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002436 * Negotiate the FF-A version to be used for this FF-A instance.
2437 * See section 13.2 of the FF-A v1.2 ALP1 spec.
2438 *
2439 * Returns Hafnium's version number (`FFA_VERSION_COMPILED`) on success.
2440 * Returns `FFA_NOT_SUPPORTED` on error:
2441 * - The version is invalid (highest bit set).
2442 * - The requested version is incompatible.
2443 * - The version has already been negotiated and cannot be changed.
2444 */
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002445struct ffa_value api_ffa_version(struct vcpu *current,
Karl Meakin0e617d92024-04-05 12:55:22 +01002446 enum ffa_version requested_version)
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002447{
Karl Meakin0e617d92024-04-05 12:55:22 +01002448 static_assert(sizeof(enum ffa_version) == 4,
2449 "enum ffa_version must be 4 bytes wide");
2450
Karl Meakin0dba87e2025-03-24 17:36:04 +00002451 const struct ffa_value error = {.func = FFA_NOT_SUPPORTED};
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002452 struct vm_locked current_vm_locked;
2453
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002454 uint16_t compiled_major = ffa_version_get_major(FFA_VERSION_COMPILED);
2455 uint16_t compiled_minor = ffa_version_get_minor(FFA_VERSION_COMPILED);
2456 uint16_t requested_major;
2457 uint16_t requested_minor;
2458 uint16_t vm_major;
2459 uint16_t vm_minor;
2460
Karl Meakin0e617d92024-04-05 12:55:22 +01002461 if (!ffa_version_is_valid(requested_version)) {
2462 dlog_error(
2463 "FFA_VERSION: requested version %#x is invalid "
2464 "(highest bit must be zero)\n",
2465 requested_version);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002466 return error;
Andrew Walbran9fd29072020-04-22 12:12:14 +01002467 }
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002468
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002469 requested_major = ffa_version_get_major(requested_version);
2470 requested_minor = ffa_version_get_minor(requested_version);
2471
Karl Meakin0e617d92024-04-05 12:55:22 +01002472 if (!ffa_versions_are_compatible(requested_version,
2473 FFA_VERSION_COMPILED)) {
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002474 dlog_error(
2475 "FFA_VERSION: requested version v%u.%u is not "
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002476 "compatible with compiled version v%u.%u\n",
2477 requested_major, requested_minor, compiled_major,
2478 compiled_minor);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002479 return error;
J-Alves3cc9d6f2023-07-20 16:46:15 +01002480 }
2481
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002482 current_vm_locked = vm_lock(current->vm);
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002483 vm_major = ffa_version_get_major(current_vm_locked.vm->ffa_version);
2484 vm_minor = ffa_version_get_minor(current_vm_locked.vm->ffa_version);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002485
2486 if (current_vm_locked.vm->ffa_version_negotiated &&
2487 requested_version != current_vm_locked.vm->ffa_version) {
2488 vm_unlock(&current_vm_locked);
2489 dlog_error(
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002490 "FFA_VERSION: Cannot change FF-A version from v%u.%u "
2491 "to v%u.%u after other FF-A calls have been made\n",
2492 vm_major, vm_minor, requested_major, requested_minor);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002493 return error;
2494 }
2495
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002496 current_vm_locked.vm->ffa_version = requested_version;
2497 vm_unlock(&current_vm_locked);
2498
Karl Meakin0dba87e2025-03-24 17:36:04 +00002499 return (struct ffa_value){.func = FFA_VERSION_COMPILED};
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002500}
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01002501
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002502/**
Karl Meakin49ec1e42024-05-10 13:08:24 +01002503 * Helper for success return of FFA_FEATURES.
J-Alves6f72ca82021-11-01 12:34:58 +00002504 */
2505struct ffa_value api_ffa_feature_success(uint32_t arg2)
2506{
2507 return (struct ffa_value){
Karl Meakin49ec1e42024-05-10 13:08:24 +01002508 .func = FFA_SUCCESS_32,
2509 .arg1 = 0U,
2510 .arg2 = arg2,
2511 };
J-Alves6f72ca82021-11-01 12:34:58 +00002512}
2513
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002514static struct ffa_value ffa_features_function(uint32_t func,
2515 uint32_t input_property,
2516 struct vcpu *current)
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002517{
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002518 switch (func) {
J-Alves6f72ca82021-11-01 12:34:58 +00002519 /* Check support of the given Function ID. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002520 case FFA_ERROR_32:
2521 case FFA_SUCCESS_32:
2522 case FFA_INTERRUPT_32:
2523 case FFA_VERSION_32:
2524 case FFA_FEATURES_32:
2525 case FFA_RX_RELEASE_32:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002526 case FFA_RXTX_UNMAP_32:
Fuad Tabbae4efcc32020-07-16 15:37:27 +01002527 case FFA_PARTITION_INFO_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002528 case FFA_ID_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002529 case FFA_MSG_WAIT_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002530 case FFA_RUN_32:
J-Alves95fbb312024-03-20 15:19:16 +00002531 case FFA_MEM_DONATE_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002532 case FFA_MEM_DONATE_32:
2533 case FFA_MEM_LEND_32:
J-Alves95fbb312024-03-20 15:19:16 +00002534 case FFA_MEM_LEND_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002535 case FFA_MEM_SHARE_32:
J-Alves95fbb312024-03-20 15:19:16 +00002536 case FFA_MEM_SHARE_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002537 case FFA_MEM_RETRIEVE_RESP_32:
2538 case FFA_MEM_RELINQUISH_32:
2539 case FFA_MEM_RECLAIM_32:
J-Alvesff676c12022-05-13 17:25:33 +01002540 case FFA_MEM_FRAG_RX_32:
2541 case FFA_MEM_FRAG_TX_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002542 case FFA_MSG_SEND_DIRECT_RESP_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002543 case FFA_MSG_SEND_DIRECT_RESP_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002544 case FFA_MSG_SEND_DIRECT_REQ_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002545 case FFA_MSG_SEND_DIRECT_REQ_32:
Karl Meakinf923da32025-03-27 17:06:44 +00002546 return api_ffa_feature_success(0);
Karl Meakin0e617d92024-04-05 12:55:22 +01002547
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00002548 /* FF-A v1.1 features. */
2549 case FFA_SPM_ID_GET_32:
J-Alves6f72ca82021-11-01 12:34:58 +00002550 case FFA_NOTIFICATION_BITMAP_CREATE_32:
2551 case FFA_NOTIFICATION_BITMAP_DESTROY_32:
2552 case FFA_NOTIFICATION_BIND_32:
2553 case FFA_NOTIFICATION_UNBIND_32:
2554 case FFA_NOTIFICATION_SET_32:
2555 case FFA_NOTIFICATION_GET_32:
2556 case FFA_NOTIFICATION_INFO_GET_64:
Federico Recanati25053ee2022-03-14 15:01:53 +01002557 case FFA_MSG_SEND2_32:
Karl Meakin0e617d92024-04-05 12:55:22 +01002558 if (FFA_VERSION_1_1 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002559 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002560 }
Karl Meakinf923da32025-03-27 17:06:44 +00002561 return api_ffa_feature_success(0);
Karl Meakin0e617d92024-04-05 12:55:22 +01002562
Kathleen Capellae4fe2962023-09-01 17:08:47 -04002563 /* FF-A v1.2 features. */
2564 case FFA_CONSOLE_LOG_32:
2565 case FFA_CONSOLE_LOG_64:
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -08002566 case FFA_PARTITION_INFO_GET_REGS_64:
Kathleen Capella41fea932023-06-23 17:39:28 -04002567 case FFA_MSG_SEND_DIRECT_REQ2_64:
Kathleen Capella087e5022023-09-07 18:04:15 -04002568 case FFA_MSG_SEND_DIRECT_RESP2_64:
Karl Meakin0e617d92024-04-05 12:55:22 +01002569 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002570 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002571 }
2572
Karl Meakin49ec1e42024-05-10 13:08:24 +01002573 return api_ffa_feature_success(0);
2574
Karl Meakin5a222642024-06-20 10:23:37 +01002575 /* These functions are only supported on S-EL0 partitions. */
2576 case FFA_MEM_PERM_GET_32:
2577 case FFA_MEM_PERM_SET_32:
2578 case FFA_MEM_PERM_GET_64:
2579 case FFA_MEM_PERM_SET_64:
2580 if (!(vm_id_is_current_world(current->vm->id) &&
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002581 current->vm->el0_partition)) {
Karl Meakin5a222642024-06-20 10:23:37 +01002582 dlog_verbose(
Karl Meakinf923da32025-03-27 17:06:44 +00002583 "FFA_FEATURES: %s is only supported on S-EL0 "
Karl Meakin5a222642024-06-20 10:23:37 +01002584 "partitions\n",
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002585 ffa_func_name(func));
Karl Meakin5a222642024-06-20 10:23:37 +01002586 return ffa_error(FFA_NOT_SUPPORTED);
2587 }
2588 return api_ffa_feature_success(0);
2589
Karl Meakin1a8c0cd2024-06-20 10:26:12 +01002590 case FFA_SECONDARY_EP_REGISTER_64:
2591 if (FFA_VERSION_COMPILED < FFA_VERSION_1_1) {
2592 return ffa_error(FFA_NOT_SUPPORTED);
2593 }
2594
2595 if (!(vm_id_is_current_world(current->vm->id) &&
2596 current->vm->vcpu_count > 1)) {
2597 dlog_verbose(
2598 "FFA_FEATURE: %s is only supported on SPs with "
2599 "more than 1 vCPU\n",
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002600 ffa_func_name(func));
Karl Meakin1a8c0cd2024-06-20 10:26:12 +01002601 return ffa_error(FFA_NOT_SUPPORTED);
2602 }
2603 return api_ffa_feature_success(0);
2604
Karl Meakin650cb142024-06-20 10:31:57 +01002605 case FFA_YIELD_32:
2606 if (!vm_id_is_current_world(current->vm->id)) {
2607 dlog_verbose(
2608 "FFA_FEATURES: %s is only supported at secure "
2609 "virtual FF-A instance\n",
2610 ffa_func_name(FFA_YIELD_32));
2611 return ffa_error(FFA_NOT_SUPPORTED);
2612 }
2613 return api_ffa_feature_success(0);
2614
Karl Meakin0fd67292024-02-06 17:33:05 +00002615 case FFA_RXTX_MAP_64: {
2616 uint32_t arg2 = 0;
2617 struct ffa_features_rxtx_map_params params = {
2618 .min_buf_size = FFA_RXTX_MAP_MIN_BUF_4K,
2619 .mbz = 0,
2620 .max_buf_size =
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002621 (current->vm->ffa_version >= FFA_VERSION_1_2)
Karl Meakin0fd67292024-02-06 17:33:05 +00002622 ? FFA_RXTX_MAP_MAX_BUF_PAGE_COUNT
2623 : 0,
2624 };
2625
2626 memcpy_s(&arg2, sizeof(arg2), &params, sizeof(params));
Karl Meakin49ec1e42024-05-10 13:08:24 +01002627 return api_ffa_feature_success(arg2);
Karl Meakin0fd67292024-02-06 17:33:05 +00002628 }
2629
J-Alves95fbb312024-03-20 15:19:16 +00002630 case FFA_MEM_RETRIEVE_REQ_64:
Karl Meakin49ec1e42024-05-10 13:08:24 +01002631 case FFA_MEM_RETRIEVE_REQ_32: {
2632 if (ANY_BITS_SET(input_property,
2633 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_HI_BIT,
2634 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_LO_BIT) ||
2635 IS_BIT_SET(input_property,
2636 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_BIT)) {
2637 dlog_warning(
2638 "FFA_FEATURES: Bits[%u:%u] and Bit[%u] of "
2639 "input_property should be 0 (input_property = "
2640 "%#x)\n",
2641 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_HI_BIT,
2642 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_LO_BIT,
2643 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_BIT,
Karl Meakin34b8ae92023-01-13 13:33:07 +00002644 input_property);
Karl Meakin34b8ae92023-01-13 13:33:07 +00002645 }
2646
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002647 if (current->vm->ffa_version >= FFA_VERSION_1_1 &&
Karl Meakin0e617d92024-04-05 12:55:22 +01002648 (input_property &
2649 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT) == 0U) {
Karl Meakin4e8e4792024-07-05 16:28:42 +01002650 dlog_verbose(
2651 "FFA_FEATURES: NS bit support must be 1\n");
Karl Meakin6fd6c1d2024-05-13 12:09:13 +01002652 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin34b8ae92023-01-13 13:33:07 +00002653 }
2654
2655 return api_ffa_feature_success(
2656 FFA_FEATURES_MEM_RETRIEVE_REQ_BUFFER_SUPPORT |
Karl Meakin49ec1e42024-05-10 13:08:24 +01002657 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT |
Karl Meakin34b8ae92023-01-13 13:33:07 +00002658 FFA_FEATURES_MEM_RETRIEVE_REQ_HYPERVISOR_SUPPORT);
Karl Meakin49ec1e42024-05-10 13:08:24 +01002659 }
J-Alves6f72ca82021-11-01 12:34:58 +00002660
Madhukar Pappireddy04cf9e82025-03-17 17:32:02 -05002661 /*
2662 * This function is restricted to the secure virtual FF-A instance (i.e.
2663 * only report success to SPs).
2664 */
2665 case FFA_ABORT_32:
2666 case FFA_ABORT_64:
2667 if (ffa_is_vm_id(current->vm->id)) {
2668 dlog_verbose(
2669 "FFA_FEATURES: %s is only supported at secure "
2670 "virtual FF-A instance\n",
2671 ffa_func_name(FFA_YIELD_32));
2672 return ffa_error(FFA_NOT_SUPPORTED);
2673 }
2674 return api_ffa_feature_success(0);
2675
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002676 default:
2677 return ffa_error(FFA_NOT_SUPPORTED);
2678 }
2679}
2680
2681static struct ffa_value ffa_features_feature(enum ffa_feature_id feature,
2682 uint32_t input_property,
2683 struct vcpu *current)
2684{
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002685 if (ANY_BITS_SET(feature, FFA_FEATURES_FEATURE_MBZ_HI_BIT,
2686 FFA_FEATURES_FEATURE_MBZ_LO_BIT)) {
2687 dlog_verbose(
2688 "FFA_FEATURES: feature ID %#x is invalid (bits [%u:%u] "
2689 "must be zero)\n",
2690 feature, FFA_FEATURES_FEATURE_MBZ_HI_BIT,
2691 FFA_FEATURES_FEATURE_MBZ_LO_BIT);
2692 return ffa_error(FFA_NOT_SUPPORTED);
2693 }
2694 if (input_property != 0) {
2695 dlog_verbose(
2696 "FFA_FEATURES: input_property must be 0 "
2697 "(input_property = %#x)\n",
2698 input_property);
2699 return ffa_error(FFA_NOT_SUPPORTED);
2700 }
2701
2702 switch (feature) {
J-Alves6f72ca82021-11-01 12:34:58 +00002703 /* Check support of a feature provided respective feature ID. */
Karl Meakin17c9ad32024-04-12 16:41:00 +01002704
2705 /*
2706 * For NPI and MEI, report the IDs as supported only to partitions at
2707 * the virtual FF-A instances.
2708 */
J-Alves6f72ca82021-11-01 12:34:58 +00002709 case FFA_FEATURE_NPI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002710 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002711 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002712 }
2713
Karl Meakin147a4e82025-03-27 15:12:27 +00002714 if (current->vm->el0_partition) {
Karl Meakinf1ed5f12024-02-22 15:57:36 +00002715 return ffa_error(FFA_NOT_SUPPORTED);
2716 }
Karl Meakin17c9ad32024-04-12 16:41:00 +01002717 if (!vm_id_is_current_world(current->vm->id)) {
2718 return ffa_error(FFA_NOT_SUPPORTED);
2719 }
J-Alves6f72ca82021-11-01 12:34:58 +00002720 return api_ffa_feature_success(HF_NOTIFICATION_PENDING_INTID);
Karl Meakin17c9ad32024-04-12 16:41:00 +01002721
2722 case FFA_FEATURE_MEI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002723 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002724 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002725 }
Karl Meakin147a4e82025-03-27 15:12:27 +00002726 if (current->vm->el0_partition) {
J-Alvesc4d9ae82024-05-14 10:15:03 +01002727 return ffa_error(FFA_NOT_SUPPORTED);
2728 }
Karl Meakin17c9ad32024-04-12 16:41:00 +01002729 if (!vm_id_is_current_world(current->vm->id)) {
2730 return ffa_error(FFA_NOT_SUPPORTED);
2731 }
2732 return api_ffa_feature_success(HF_MANAGED_EXIT_INTID);
2733
J-Alves6f72ca82021-11-01 12:34:58 +00002734 case FFA_FEATURE_SRI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002735 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002736 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002737 }
2738
Karl Meakincb6642c2024-02-27 14:43:45 +00002739 if (!ffa_is_vm_id(current->vm->id)) {
2740 return ffa_error(FFA_NOT_SUPPORTED);
2741 }
J-Alves6f72ca82021-11-01 12:34:58 +00002742 return api_ffa_feature_success(HF_SCHEDULE_RECEIVER_INTID);
Karl Meakin0e617d92024-04-05 12:55:22 +01002743
J-Alves6f72ca82021-11-01 12:34:58 +00002744 /* Platform specific feature support. */
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002745 default:
Karl Meakin4271ff92024-05-13 12:33:15 +01002746 return ffa_error(FFA_NOT_SUPPORTED);
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002747 }
2748}
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002749
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002750/**
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002751 * Discovery function returning information about the implementation of optional
2752 * FF-A interfaces. See section 13.3 of the FF-A v1.2 ALP1 spec.
2753 *
2754 * `function_or_feature_id` is interpreted as either a function ID or a feature
2755 * ID, depending on the value of bit 31.
2756 * When it is a feature ID, bits [30:8] MBZ and input_property MBZ.
2757 *
2758 * Returns `FFA_SUCCESS` if the interface is supported.
2759 * Returns `FFA_NOT_SUPPORTED` if the interface is not supported or the
2760 * parameters are invalid.
2761 */
2762struct ffa_value api_ffa_features(uint32_t function_or_feature_id,
2763 uint32_t input_property, struct vcpu *current)
2764{
2765 return IS_BIT_UNSET(function_or_feature_id, FFA_FEATURES_FEATURE_BIT)
2766 ? ffa_features_feature(function_or_feature_id,
2767 input_property, current)
2768 : ffa_features_function(function_or_feature_id,
2769 input_property, current);
2770}
2771
2772/**
Kathleen Capella41fea932023-06-23 17:39:28 -04002773 * FF-A specification states that x2/w2 Must Be Zero for FFA_MSG_SEND_DIRECT_REQ
2774 * and FFA_MSG_SEND_DIRECT_RESP interfaces when used for partition messages. See
2775 * FF-A v1.2 Table 16.6: FFA_MSG_SEND_DIRECT_REQ function syntax.
J-Alves645eabe2021-02-22 16:08:27 +00002776 */
2777static inline bool api_ffa_dir_msg_is_arg2_zero(struct ffa_value args)
2778{
2779 return args.arg2 == 0U;
2780}
2781
2782/**
J-Alves76d99af2021-03-10 17:42:11 +00002783 * Limits size of arguments in ffa_value structure to 32-bit.
2784 */
2785static struct ffa_value api_ffa_value_copy32(struct ffa_value args)
2786{
2787 return (struct ffa_value){
2788 .func = (uint32_t)args.func,
2789 .arg1 = (uint32_t)args.arg1,
Karl Meakin06e8b732024-09-20 18:26:49 +01002790 .arg2 = (uint32_t)args.arg2,
J-Alves76d99af2021-03-10 17:42:11 +00002791 .arg3 = (uint32_t)args.arg3,
2792 .arg4 = (uint32_t)args.arg4,
2793 .arg5 = (uint32_t)args.arg5,
2794 .arg6 = (uint32_t)args.arg6,
2795 .arg7 = (uint32_t)args.arg7,
2796 };
2797}
2798
2799/**
Kathleen Capella41fea932023-06-23 17:39:28 -04002800 * Helper to copy direct message payload, depending on SMC used, direct
Karl Meakin06e8b732024-09-20 18:26:49 +01002801 * messaging interface used, and expected registers size. Can be used for both
2802 * framework messages and standard messages.
J-Alves76d99af2021-03-10 17:42:11 +00002803 */
2804static struct ffa_value api_ffa_dir_msg_value(struct ffa_value args)
2805{
Karl Meakin06e8b732024-09-20 18:26:49 +01002806 switch (args.func) {
2807 case FFA_MSG_SEND_DIRECT_REQ_32:
2808 case FFA_MSG_SEND_DIRECT_RESP_32:
2809 args = api_ffa_value_copy32(args);
2810 if (!ffa_is_framework_msg(args)) {
2811 args.arg2 = 0;
2812 }
2813 break;
J-Alves76d99af2021-03-10 17:42:11 +00002814
Karl Meakin06e8b732024-09-20 18:26:49 +01002815 case FFA_MSG_SEND_DIRECT_REQ_64:
2816 case FFA_MSG_SEND_DIRECT_RESP_64:
2817 if (!ffa_is_framework_msg(args)) {
2818 args.arg2 = 0;
2819 }
2820 break;
Kathleen Capella41fea932023-06-23 17:39:28 -04002821
Karl Meakin06e8b732024-09-20 18:26:49 +01002822 case FFA_MSG_SEND_DIRECT_REQ2_64:
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04002823 args.extended_val.valid = true;
Karl Meakin06e8b732024-09-20 18:26:49 +01002824 break;
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04002825
Karl Meakin06e8b732024-09-20 18:26:49 +01002826 case FFA_MSG_SEND_DIRECT_RESP2_64:
Kathleen Capella087e5022023-09-07 18:04:15 -04002827 args.arg2 = 0;
2828 args.arg3 = 0;
Karl Meakin06e8b732024-09-20 18:26:49 +01002829 break;
2830 default:
2831 panic("Invalid direct message function %#x\n", args.func);
2832 break;
Kathleen Capella087e5022023-09-07 18:04:15 -04002833 }
2834
Kathleen Capella41fea932023-06-23 17:39:28 -04002835 return args;
2836}
2837
Karl Meakinfb9c2a22024-08-19 14:29:37 +01002838/**
2839 * Return a pointer to the first UUID in `uuids` that is equal to
2840 * `target_uuid`. If `target_uuid` is 0-0-0-0, it matches any UUID.
2841 */
2842static struct ffa_uuid *ffa_uuid_find(struct ffa_uuid *uuids,
2843 size_t uuids_count,
2844 struct ffa_uuid target_uuid)
2845{
2846 if (ffa_uuid_is_null(&target_uuid)) {
2847 return &uuids[0];
2848 }
2849
2850 for (size_t i = 0; i < uuids_count; i++) {
2851 if (ffa_uuid_is_null(&uuids[i])) {
2852 break;
2853 }
2854 if (ffa_uuid_equal(&target_uuid, &uuids[i])) {
2855 return &uuids[i];
2856 }
2857 }
2858 return NULL;
2859}
2860
Kathleen Capella41fea932023-06-23 17:39:28 -04002861static bool api_ffa_dir_msg_req2_is_uuid_valid(struct vm *receiver_vm,
2862 struct ffa_value args)
2863{
2864 struct ffa_uuid target_uuid;
2865
Karl Meakin9478e322024-09-23 17:47:09 +01002866 ffa_uuid_from_u64x2(args.arg2, args.arg3, &target_uuid);
Kathleen Capella41fea932023-06-23 17:39:28 -04002867
Karl Meakinfb9c2a22024-08-19 14:29:37 +01002868 return ffa_uuid_find(receiver_vm->uuids, PARTITION_MAX_UUIDS,
2869 target_uuid) != NULL;
J-Alves76d99af2021-03-10 17:42:11 +00002870}
2871
2872/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002873 * Send an FF-A direct message request.
Kathleen Capella41fea932023-06-23 17:39:28 -04002874 * This handler covers both FFA_MSG_SEND_DIRECT_REQ_32/64
2875 * and FFA_MSG_SEND_DIRECT_REQ2_64 (introduced in FF-A v1.2) with function-based
2876 * checks to accomodate for the difference between the ABIs.
2877 *
2878 * FFA_MSG_SEND_DIRECT_REQ2_64 works mostly the same as
2879 * FFA_MSG_SEND_DIRECT_REQ_32/64, but adds the ability to send a direct message
2880 * request to a specified UUID within a partition and the usage of an extended
2881 * range of registers (x4-x17, instead of x4-x7) to be used as part of the
2882 * message payload.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002883 */
Karl Meakin13f09812024-10-28 16:33:23 +00002884struct ffa_value api_ffa_msg_send_direct_req(struct ffa_value args,
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002885 struct vcpu *current,
2886 struct vcpu **next)
2887{
Karl Meakin13f09812024-10-28 16:33:23 +00002888 ffa_id_t sender_vm_id = ffa_sender(args);
2889 ffa_id_t receiver_vm_id = ffa_receiver(args);
J-Alves17228f72021-04-20 17:13:19 +01002890 struct ffa_value ret;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002891 struct vm *receiver_vm;
J-Alves6e2abc62021-12-02 14:58:56 +00002892 struct vm_locked receiver_locked;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002893 struct vcpu *receiver_vcpu;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002894 struct vcpu_locked current_locked;
2895 struct vcpu_locked receiver_vcpu_locked;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002896 struct two_vcpu_locked vcpus_locked;
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05002897 enum vcpu_state next_state = VCPU_STATE_RUNNING;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002898
Kathleen Capella41fea932023-06-23 17:39:28 -04002899 if ((args.func == FFA_MSG_SEND_DIRECT_REQ_32 ||
2900 args.func == FFA_MSG_SEND_DIRECT_REQ_64) &&
Karl Meakin06e8b732024-09-20 18:26:49 +01002901 !ffa_is_framework_msg(args) &&
Kathleen Capella41fea932023-06-23 17:39:28 -04002902 !api_ffa_dir_msg_is_arg2_zero(args)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002903 dlog_verbose("Direct messaging: w2 must be zero (w2 = %#lx)\n",
2904 args.arg2);
J-Alves645eabe2021-02-22 16:08:27 +00002905 return ffa_error(FFA_INVALID_PARAMETERS);
2906 }
2907
Karl Meakin06e8b732024-09-20 18:26:49 +01002908 if (ffa_is_framework_msg(args) &&
Madhukar Pappireddy8afab732025-02-10 09:39:36 -06002909 ffa_direct_msg_handle_framework_msg(args, &ret, current, next)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002910 return ret;
2911 }
2912
Karl Meakin117c8082024-12-04 16:03:28 +00002913 if (!ffa_direct_msg_is_direct_request_valid(current, sender_vm_id,
2914 receiver_vm_id)) {
J-Alvese0caac32022-12-19 14:37:08 +00002915 dlog_verbose("Invalid direct message request.\n");
J-Alvesaa336102021-03-01 13:02:45 +00002916 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002917 }
2918
Karl Meakin117c8082024-12-04 16:03:28 +00002919 if (ffa_direct_msg_direct_request_forward(receiver_vm_id, args, &ret)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002920 dlog_verbose("Direct message request forwarded\n");
J-Alves17228f72021-04-20 17:13:19 +01002921 return ret;
2922 }
2923
J-Alvesbd32c972024-02-02 16:20:04 +00002924 ret = api_ffa_interrupt_return(0);
J-Alves17228f72021-04-20 17:13:19 +01002925
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002926 receiver_vm = vm_find(receiver_vm_id);
2927 if (receiver_vm == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002928 dlog_verbose("Invalid Receiver!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002929 return ffa_error(FFA_INVALID_PARAMETERS);
2930 }
2931
Kathleen Capella41fea932023-06-23 17:39:28 -04002932 if (args.func == FFA_MSG_SEND_DIRECT_REQ2_64 &&
2933 !api_ffa_dir_msg_req2_is_uuid_valid(receiver_vm, args)) {
2934 dlog_verbose("UUID unrecognized for this VM\n");
2935 return ffa_error(FFA_INVALID_PARAMETERS);
2936 }
2937
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002938 /*
J-Alves439ac972021-11-18 17:32:03 +00002939 * Check if sender supports sending direct message req, and if
2940 * receiver supports receipt of direct message requests.
2941 */
Karl Meakin117c8082024-12-04 16:03:28 +00002942 if (!ffa_direct_msg_is_direct_request_supported(
2943 current->vm, receiver_vm, args.func)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002944 dlog_verbose("Direct message request not supported\n");
J-Alves439ac972021-11-18 17:32:03 +00002945 return ffa_error(FFA_DENIED);
2946 }
2947
2948 /*
Olivier Deprezc13a8692022-04-08 17:47:14 +02002949 * Per FF-A EAC spec section 4.4.1 the firmware framework supports
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002950 * UP (migratable) or MP partitions with a number of vCPUs matching the
2951 * number of PEs in the system. It further states that MP partitions
2952 * accepting direct request messages cannot migrate.
2953 */
J-Alvesad6a0432021-04-09 16:06:21 +01002954 receiver_vcpu = api_ffa_get_vm_vcpu(receiver_vm, current);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002955 if (receiver_vcpu == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002956 dlog_verbose("Invalid vCPU!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002957 return ffa_error(FFA_INVALID_PARAMETERS);
2958 }
2959
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002960 /*
2961 * If VM must be locked, it must be done before any of its vCPUs are
2962 * locked.
2963 */
J-Alves6e2abc62021-12-02 14:58:56 +00002964 receiver_locked = vm_lock(receiver_vm);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002965
2966 /* Lock both vCPUs at once to avoid deadlock. */
2967 vcpus_locked = vcpu_lock_both(current, receiver_vcpu);
2968 current_locked = vcpus_locked.vcpu1;
2969 receiver_vcpu_locked = vcpus_locked.vcpu2;
2970
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05002971 switch (vm_read_state(receiver_vm)) {
2972 case VM_STATE_NULL:
2973 ret = ffa_error(FFA_INVALID_PARAMETERS);
2974 goto out;
2975 case VM_STATE_CREATED:
2976 ret = ffa_error(FFA_BUSY);
2977 goto out;
2978 case VM_STATE_ABORTING:
2979 if (receiver_vcpu->state != VCPU_STATE_NULL &&
2980 receiver_vcpu->state != VCPU_STATE_ABORTED &&
2981 receiver_vcpu->state != VCPU_STATE_STOPPED) {
2982 dlog_verbose(
2983 "Receiver VM %#x aborted, cannot run vCPU %u\n",
2984 receiver_vcpu->vm->id,
2985 vcpu_index(receiver_vcpu));
2986 CHECK(vcpu_state_set(receiver_vcpu_locked,
2987 VCPU_STATE_ABORTED));
2988 }
2989 /* Let the subsequent checks handle further conditions. */
2990 break;
2991 case VM_STATE_RUNNING:
2992 [[fallthrough]];
2993 default:
2994 /* Let the subsequent checks handle further conditions. */
2995 break;
2996 }
2997
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002998 /*
2999 * If destination vCPU is executing or already received an
3000 * FFA_MSG_SEND_DIRECT_REQ then return to caller hinting recipient is
3001 * busy. There is a brief period of time where the vCPU state has
3002 * changed but regs_available is still false thus consider this case as
3003 * the vCPU not yet ready to receive a direct message request.
3004 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003005 if (is_ffa_direct_msg_request_ongoing(receiver_vcpu_locked) ||
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003006 receiver_vcpu->state == VCPU_STATE_RUNNING ||
3007 !receiver_vcpu->regs_available) {
J-Alves88a13542021-12-14 15:39:52 +00003008 dlog_verbose("Receiver is busy with another request.\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003009 ret = ffa_error(FFA_BUSY);
3010 goto out;
3011 }
3012
Karl Meakin117c8082024-12-04 16:03:28 +00003013 if (!ffa_cpu_cycles_check_runtime_state_transition(
J-Alves7ea3f7e2024-03-27 11:05:11 +00003014 current_locked, sender_vm_id, HF_INVALID_VM_ID,
3015 receiver_vcpu_locked, args.func, &next_state)) {
3016 ret = ffa_error(FFA_DENIED);
3017 goto out;
3018 }
3019
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003020 switch (receiver_vcpu->state) {
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003021 case VCPU_STATE_ABORTED:
3022 if (receiver_vcpu->vm->lifecycle_support) {
3023 ret = ffa_error(FFA_BUSY);
3024 } else {
3025 ret = ffa_error(FFA_ABORTED);
3026 }
3027 goto out;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003028 case VCPU_STATE_OFF:
3029 case VCPU_STATE_RUNNING:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003030 case VCPU_STATE_STARTING:
3031 case VCPU_STATE_CREATED:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003032 case VCPU_STATE_BLOCKED_INTERRUPT:
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003033 case VCPU_STATE_BLOCKED:
3034 case VCPU_STATE_PREEMPTED:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003035 case VCPU_STATE_STOPPED:
3036 case VCPU_STATE_STOPPING:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003037 ret = ffa_error(FFA_BUSY);
3038 goto out;
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003039 case VCPU_STATE_NULL:
3040 ret = ffa_error(FFA_INVALID_PARAMETERS);
3041 goto out;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003042 case VCPU_STATE_WAITING:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003043 /*
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003044 * We expect target vCPU to be in WAITING state after either
3045 * having called ffa_msg_wait or sent a direct message response.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003046 */
3047 break;
3048 }
3049
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05003050 /* Inject timer interrupt if timer has expired. */
Daniel Boulbyd49d0772025-01-15 11:19:36 +00003051 api_inject_arch_timer_interrupt(receiver_vcpu_locked);
Madhukar Pappireddy106bfc32024-09-25 15:47:11 -05003052 timer_migrate_to_other_cpu(current->cpu, receiver_vcpu_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003053
3054 /* The receiver vCPU runs upon direct message invocation */
3055 receiver_vcpu->cpu = current->cpu;
Madhukar Pappireddy5388dd92025-02-10 11:24:19 -06003056 vcpu_dir_req_set_state(receiver_vcpu_locked,
3057 (args.func == FFA_MSG_SEND_DIRECT_REQ2_64),
3058 sender_vm_id, api_ffa_dir_msg_value(args));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003059
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003060 assert(!vm_id_is_current_world(current->vm->id) ||
3061 next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05003062 CHECK(vcpu_state_set(current_locked, VCPU_STATE_BLOCKED));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003063
Karl Meakin117c8082024-12-04 16:03:28 +00003064 ffa_direct_msg_wind_call_chain_ffa_direct_req(
Raghu Krishnamurthya9ccf122023-03-27 20:42:01 -07003065 current_locked, receiver_vcpu_locked, sender_vm_id);
Madhukar Pappireddy49fe6702022-06-21 17:52:23 -05003066
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003067 /* Switch to receiver vCPU targeted to by direct msg request */
3068 *next = receiver_vcpu;
3069
J-Alves6e2abc62021-12-02 14:58:56 +00003070 if (!receiver_locked.vm->el0_partition) {
3071 /*
3072 * If the scheduler in the system is giving CPU cycles to the
3073 * receiver, due to pending notifications, inject the NPI
3074 * interrupt. Following call assumes that '*next' has been set
3075 * to receiver_vcpu.
3076 */
Karl Meakin117c8082024-12-04 16:03:28 +00003077 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00003078 receiver_vcpu_locked, receiver_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00003079 }
3080
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003081 /*
3082 * Since this flow will lead to a VM switch, the return value will not
3083 * be applied to current vCPU.
3084 */
3085
3086out:
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003087 vcpu_unlock(&receiver_vcpu_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00003088 vm_unlock(&receiver_locked);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003089 vcpu_unlock(&current_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003090
3091 return ret;
3092}
3093
3094/**
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003095 * Resume the target vCPU after the current vCPU sent a direct response.
3096 * Current vCPU moves to waiting state.
3097 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003098void api_ffa_resume_direct_resp_target(struct vcpu_locked current_locked,
3099 struct vcpu **next,
J-Alves19e20cf2023-08-02 12:48:55 +01003100 ffa_id_t receiver_vm_id,
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003101 struct ffa_value to_ret,
3102 bool is_nwd_call_chain)
3103{
Karl Meakinfa1dcb82025-02-10 16:47:50 +00003104 if (ffa_direct_msg_is_spmd_lp_id(receiver_vm_id) ||
Raghu Krishnamurthya9ccf122023-03-27 20:42:01 -07003105 !vm_id_is_current_world(receiver_vm_id)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003106 *next = api_switch_to_other_world(current_locked, to_ret,
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003107 VCPU_STATE_WAITING);
3108
3109 /* End of NWd scheduled call chain. */
3110 assert(!is_nwd_call_chain ||
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003111 (current_locked.vcpu->call_chain.prev_node == NULL));
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003112 } else if (receiver_vm_id == HF_PRIMARY_VM_ID) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003113 *next = api_switch_to_primary(current_locked, to_ret,
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003114 VCPU_STATE_WAITING);
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003115 } else if (vm_id_is_current_world(receiver_vm_id)) {
3116 /*
3117 * It is expected the receiver_vm_id to be from an SP, otherwise
Karl Meakin117c8082024-12-04 16:03:28 +00003118 * 'ffa_direct_msg_is_direct_response_valid' should have
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003119 * made function return error before getting to this point.
3120 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003121 *next = api_switch_to_vm(current_locked, to_ret,
3122 VCPU_STATE_WAITING, receiver_vm_id);
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003123 } else {
3124 panic("Invalid direct message response invocation");
3125 }
3126}
3127
Karl Meakin50ef9112024-10-28 16:41:44 +00003128static bool api_ffa_msg_send_direct_resp_validate_args(struct ffa_value args,
3129 struct vcpu *current)
3130{
3131 ffa_id_t sender_vm_id = ffa_sender(args);
3132 ffa_id_t receiver_vm_id = ffa_receiver(args);
3133
3134 /*
3135 * If using FFA_MSG_SEND_DIRECT_RESP, the caller's
3136 * - x2 MBZ for partition messages
3137 * - x8-x17 SBZ if caller's FF-A version >= FF-A v1.2
3138 */
3139 if (args.func != FFA_MSG_SEND_DIRECT_RESP2_64) {
3140 if (!ffa_is_framework_msg(args) &&
3141 !api_ffa_dir_msg_is_arg2_zero(args)) {
3142 dlog_verbose("%s: w2 Must Be Zero",
3143 ffa_func_name(args.func));
3144 return false;
3145 }
3146
3147 if (current->vm->ffa_version >= FFA_VERSION_1_2 &&
3148 !api_extended_args_are_zero(&args)) {
3149 return false;
3150 }
3151 }
3152
Karl Meakin117c8082024-12-04 16:03:28 +00003153 if (!ffa_direct_msg_is_direct_response_valid(current, sender_vm_id,
3154 receiver_vm_id)) {
Karl Meakin50ef9112024-10-28 16:41:44 +00003155 dlog_verbose("Invalid direct response call.\n");
3156 return false;
3157 }
3158
3159 return true;
3160}
3161
3162static bool api_ffa_msg_send_direct_resp_validate_ongoing_request(
3163 struct ffa_value args, struct vcpu_locked current_locked)
3164{
3165 bool req_framework =
3166 current_locked.vcpu->direct_request_origin.is_framework;
3167 bool resp_framework = ffa_is_framework_msg(args);
3168 bool received_req2 =
3169 current_locked.vcpu->direct_request_origin.is_ffa_req2;
3170
3171 if (!is_ffa_direct_msg_request_ongoing(current_locked)) {
3172 return false;
3173 }
3174
3175 if (req_framework && !resp_framework) {
3176 dlog_verbose(
3177 "Mismatch in framework message bit: request was a %s "
3178 "message, but response is a %s message\n",
3179 req_framework ? "framework" : "non-framework",
3180 resp_framework ? "framework" : "non-framework");
3181 return false;
3182 }
3183
3184 if (args.func != FFA_MSG_SEND_DIRECT_RESP2_64 && received_req2) {
3185 dlog_verbose(
3186 "FFA_MSG_SEND_DIRECT_RESP must be used with "
3187 "FFA_MSG_SEND_DIRECT_REQ\n");
3188 return false;
3189 }
3190
3191 if (args.func == FFA_MSG_SEND_DIRECT_RESP2_64 && !received_req2) {
3192 dlog_verbose(
3193 "FFA_MSG_SEND_DIRECT_RESP2 must be used with "
3194 "FFA_MSG_SEND_DIRECT_REQ2\n");
3195 return false;
3196 }
3197
3198 return true;
3199}
3200
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003201/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003202 * Send an FF-A direct message response.
Kathleen Capella087e5022023-09-07 18:04:15 -04003203 * This handler covers both FFA_MSG_SEND_DIRECT_RESP_32/64
3204 * and FFA_MSG_SEND_DIRECT_RESP2_64 (introduced in FF-A v1.2) with
3205 * function-based checks to accomodate for the difference between the ABIs.
3206 *
3207 * FFA_MSG_SEND_DIRECT_RESP2_64 is used to respond to requests sent via
3208 * FFA_MSG_SEND_DIRECT_REQ2_64 and adds the usage of an extended range
3209 * of registers (x4-x17, instead of x4-x7) to be used as part of the
3210 * message payload.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003211 */
Karl Meakin13f09812024-10-28 16:33:23 +00003212struct ffa_value api_ffa_msg_send_direct_resp(struct ffa_value args,
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003213 struct vcpu *current,
3214 struct vcpu **next)
3215{
Karl Meakin13f09812024-10-28 16:33:23 +00003216 ffa_id_t sender_vm_id = ffa_sender(args);
3217 ffa_id_t receiver_vm_id = ffa_receiver(args);
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02003218 struct vcpu_locked current_locked;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003219 struct vcpu_locked next_locked = (struct vcpu_locked){
3220 .vcpu = NULL,
3221 };
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003222 enum vcpu_state next_state = VCPU_STATE_RUNNING;
J-Alves86e883a2025-03-13 14:06:33 +00003223 /* Prepare return interrupt if caller goes back to waiting state. */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003224 struct ffa_value ret = (struct ffa_value){.func = FFA_INTERRUPT_32};
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003225 struct ffa_value to_ret = api_ffa_dir_msg_value(args);
3226 struct two_vcpu_locked vcpus_locked;
J-Alves645eabe2021-02-22 16:08:27 +00003227
Karl Meakin50ef9112024-10-28 16:41:44 +00003228 if (!api_ffa_msg_send_direct_resp_validate_args(args, current)) {
J-Alvesaa336102021-03-01 13:02:45 +00003229 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003230 }
3231
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003232 current_locked = vcpu_lock(current);
3233
Karl Meakin117c8082024-12-04 16:03:28 +00003234 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003235 current_locked, sender_vm_id, receiver_vm_id, next_locked,
3236 args.func, &next_state)) {
3237 ret = ffa_error(FFA_DENIED);
3238 goto out;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05003239 }
3240
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003241 assert(!vm_id_is_current_world(current->vm->id) ||
3242 next_state == VCPU_STATE_WAITING);
Madhukar Pappireddy469fa712022-06-21 18:53:33 -05003243
Karl Meakin50ef9112024-10-28 16:41:44 +00003244 if (!api_ffa_msg_send_direct_resp_validate_ongoing_request(
3245 args, current_locked)) {
Kathleen Capellae468c112023-12-13 17:56:28 -05003246 ret = ffa_error(FFA_DENIED);
3247 goto out;
3248 }
3249
Madhukar Pappireddy454b91d2025-02-10 13:05:46 -06003250 if (ffa_is_framework_msg(args) &&
3251 ffa_direct_msg_handle_framework_msg_resp(args, &ret, current_locked,
3252 next)) {
3253 goto out;
3254 }
3255
Manish Pandeya5f39fb2020-09-11 09:47:11 +01003256 if (api_ffa_is_managed_exit_ongoing(current_locked)) {
Madhukar Pappireddy7945bb52024-08-20 15:22:41 -05003257 CHECK(current->scheduling_mode != SPMC_MODE);
Madhukar Pappireddyed4ab942021-08-03 14:22:53 -05003258
Madhukar Pappireddy025a4512024-10-14 22:09:19 -05003259 plat_interrupts_set_priority_mask(
3260 current->prev_interrupt_priority);
Madhukar Pappireddya1019112022-06-21 18:57:44 -05003261 /*
3262 * A SP may be signaled a managed exit but actually not trap
3263 * the virtual interrupt, probably because it has virtual
3264 * interrupts masked, and emit direct resp. In this case the
3265 * managed exit operation is considered completed and it would
3266 * also need to clear the pending managed exit flag for the SP
3267 * vCPU.
3268 */
Manish Pandeya5f39fb2020-09-11 09:47:11 +01003269 current->processing_managed_exit = false;
Madhukar Pappireddya1019112022-06-21 18:57:44 -05003270
Daniel Boulbyd7992232025-03-06 17:09:49 +00003271 vcpu_virt_interrupt_clear(current_locked,
3272 HF_MANAGED_EXIT_INTID);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003273 }
3274
Kathleen Capellae468c112023-12-13 17:56:28 -05003275 /* Clear direct request origin vm_id and request type for the caller. */
3276 current->direct_request_origin.is_ffa_req2 = false;
3277 current->direct_request_origin.vm_id = HF_INVALID_VM_ID;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003278
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003279 api_ffa_resume_direct_resp_target(current_locked, next, receiver_vm_id,
3280 to_ret, false);
3281
3282 /*
3283 * Unlock current vCPU to allow it to be locked together with next
3284 * vcpu.
3285 */
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02003286 vcpu_unlock(&current_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003287
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003288 /* Lock both vCPUs at once to avoid deadlock. */
3289 vcpus_locked = vcpu_lock_both(current, *next);
3290 current_locked = vcpus_locked.vcpu1;
3291 next_locked = vcpus_locked.vcpu2;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003292
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05003293 /* Inject timer interrupt if timer has expired. */
Daniel Boulbyd49d0772025-01-15 11:19:36 +00003294 api_inject_arch_timer_interrupt(next_locked);
Karl Meakin117c8082024-12-04 16:03:28 +00003295 ffa_direct_msg_unwind_call_chain_ffa_direct_resp(current_locked,
3296 next_locked);
J-Alvesbd32c972024-02-02 16:20:04 +00003297
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05003298 /* Schedule the receiver's vCPU now. */
3299 CHECK(vcpu_state_set(next_locked, VCPU_STATE_RUNNING));
3300
J-Alvesbd32c972024-02-02 16:20:04 +00003301 /*
J-Alves4796d112025-02-12 14:39:00 +00003302 * Check if there is a pending interrupt, and if the partition
3303 * is expects to notify the scheduler or resume straight away.
3304 * Either trigger SRI for later donation of CPU cycles, or
3305 * eret `FFA_INTERRUPT` back to the caller.
J-Alvesbd32c972024-02-02 16:20:04 +00003306 */
J-Alves86e883a2025-03-13 14:06:33 +00003307 if (ffa_interrupts_intercept_call(current_locked, next_locked, &ret)) {
J-Alvesbd32c972024-02-02 16:20:04 +00003308 *next = NULL;
3309 }
3310
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003311 vcpu_unlock(&next_locked);
Madhukar Pappireddyc0fb87e2022-06-21 17:59:15 -05003312
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003313out:
3314 vcpu_unlock(&current_locked);
3315 return ret;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003316}
3317
J-Alves84658fc2021-06-17 14:37:32 +01003318static bool api_memory_region_check_flags(
3319 struct ffa_memory_region *memory_region, uint32_t share_func)
3320{
3321 switch (share_func) {
J-Alves95fbb312024-03-20 15:19:16 +00003322 case FFA_MEM_SHARE_64:
J-Alves84658fc2021-06-17 14:37:32 +01003323 case FFA_MEM_SHARE_32:
3324 if ((memory_region->flags & FFA_MEMORY_REGION_FLAG_CLEAR) !=
3325 0U) {
3326 return false;
3327 }
Karl Meakin402b1fe2025-03-20 14:52:55 +00003328 [[fallthrough]];
J-Alves95fbb312024-03-20 15:19:16 +00003329 case FFA_MEM_LEND_64:
J-Alves84658fc2021-06-17 14:37:32 +01003330 case FFA_MEM_LEND_32:
J-Alves95fbb312024-03-20 15:19:16 +00003331 case FFA_MEM_DONATE_64:
J-Alves84658fc2021-06-17 14:37:32 +01003332 case FFA_MEM_DONATE_32: {
3333 /* Bits 31:2 Must Be Zero. */
Karl Meakin0770e712025-03-20 17:57:09 +00003334 ffa_memory_region_flags_t to_mask =
J-Alves84658fc2021-06-17 14:37:32 +01003335 ~(FFA_MEMORY_REGION_FLAG_CLEAR |
3336 FFA_MEMORY_REGION_FLAG_TIME_SLICE);
3337
3338 if ((memory_region->flags & to_mask) != 0U) {
3339 return false;
3340 }
3341 break;
3342 }
3343 default:
3344 panic("Check for mem send calls only.\n");
3345 }
3346
3347 /* Last check reserved values are 0 */
3348 return true;
3349}
3350
J-Alves33c47bf2022-09-29 11:36:20 +01003351/*
3352 * Convert memory transaction descriptor from FF-A v1.0 to FF-A v1.1 EAC0.
3353 */
3354static void api_ffa_memory_region_v1_1_from_v1_0(
3355 struct ffa_memory_region_v1_0 *memory_region_v1_0,
3356 struct ffa_memory_region *memory_region_v1_1)
3357{
3358 memory_region_v1_1->sender = memory_region_v1_0->sender;
J-Alves00847062022-10-03 17:08:44 +01003359 memory_region_v1_1->handle = memory_region_v1_0->handle;
Karl Meakin84710f32023-10-12 15:14:49 +01003360 memory_region_v1_1->attributes =
3361 ffa_memory_attributes_extend(memory_region_v1_0->attributes);
J-Alves33c47bf2022-09-29 11:36:20 +01003362 memory_region_v1_1->flags = memory_region_v1_0->flags;
3363 memory_region_v1_1->tag = memory_region_v1_0->tag;
3364 memory_region_v1_1->memory_access_desc_size =
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003365 sizeof(struct ffa_memory_access_v1_0);
J-Alves33c47bf2022-09-29 11:36:20 +01003366 memory_region_v1_1->receiver_count = memory_region_v1_0->receiver_count;
Daniel Boulby41ef8ba2023-10-13 17:01:22 +01003367 memory_region_v1_1->receivers_offset = sizeof(struct ffa_memory_region);
J-Alves33c47bf2022-09-29 11:36:20 +01003368
3369 /* Zero reserved fields. */
3370 for (uint32_t i = 0; i < 3U; i++) {
3371 memory_region_v1_1->reserved[i] = 0U;
3372 }
3373}
3374
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003375/**
3376 * Updates a v1.0 transaction descriptor to v1.1. This gives us the
3377 * memory_access_desc_size field we need for forwards compatability.
3378 * Copy the receivers and composite descriptors to the new struct.
3379 * We also check the fields in the v1.0 transaction descriptor and return:
3380 * - FFA_ERROR FFA_INVALID_PARAMETERS: If any of the fields are not valid
3381 * values, eg the reserved fields are not 0, receiver_count is too large or
3382 * composite offsets are not 0 for retrieve requests or in bounds for send
3383 * requests.
3384 * - FFA ERROR FFA_NOT_SUPPORTED: If an invalid ffa_version is supplied to the
3385 * function. Or the fragment length is more than a single page.
3386 * - FFA_ERROR FFA_NO_MEMORY: If we do not have enough memory for a scratch
3387 * memory transaction descriptor.
3388 * - FFA_SUCCESS: If a successful update has occured.
J-Alves33c47bf2022-09-29 11:36:20 +01003389 */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003390static struct ffa_value api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3391 void *allocated, uint32_t *fragment_length, uint32_t *total_length,
Karl Meakin0e617d92024-04-05 12:55:22 +01003392 enum ffa_version ffa_version, bool send_transaction)
J-Alves33c47bf2022-09-29 11:36:20 +01003393{
3394 struct ffa_memory_region_v1_0 *memory_region_v1_0;
3395 struct ffa_memory_region *memory_region_v1_1 = NULL;
3396 struct ffa_composite_memory_region *composite_v1_0;
3397 struct ffa_composite_memory_region *composite_v1_1;
3398 size_t receivers_length;
3399 size_t space_left;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003400 size_t receivers_end;
J-Alves33c47bf2022-09-29 11:36:20 +01003401 size_t composite_offset_v1_1;
3402 size_t composite_offset_v1_0;
3403 size_t fragment_constituents_size;
3404 size_t fragment_length_v1_1;
3405
J-Alves33c47bf2022-09-29 11:36:20 +01003406 assert(fragment_length != NULL);
3407 assert(total_length != NULL);
3408
Karl Meakin0e617d92024-04-05 12:55:22 +01003409 if (ffa_version >= FFA_VERSION_1_1) {
J-Alves33c47bf2022-09-29 11:36:20 +01003410 return (struct ffa_value){.func = FFA_SUCCESS_32};
3411 }
3412
Karl Meakin0e617d92024-04-05 12:55:22 +01003413 if (ffa_version != FFA_VERSION_1_0) {
J-Alves33c47bf2022-09-29 11:36:20 +01003414 dlog_verbose("%s: Unsupported FF-A version %x\n", __func__,
3415 ffa_version);
3416 return ffa_error(FFA_NOT_SUPPORTED);
3417 }
3418
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003419 dlog_verbose(
J-Alves0a824e92024-04-26 16:20:12 +01003420 "Updating memory transaction descriptor from v1.0 to v1.1.\n");
J-Alves33c47bf2022-09-29 11:36:20 +01003421
3422 memory_region_v1_0 = (struct ffa_memory_region_v1_0 *)allocated;
3423
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003424 receivers_length = sizeof(struct ffa_memory_access_v1_0) *
J-Alves33c47bf2022-09-29 11:36:20 +01003425 memory_region_v1_0->receiver_count;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003426 receivers_end = sizeof(struct ffa_memory_region) + receivers_length;
J-Alves33c47bf2022-09-29 11:36:20 +01003427
3428 /*
3429 * Check the specified composite offset of v1.0 descriptor, and that all
3430 * receivers were configured with the same offset.
3431 */
3432 composite_offset_v1_0 =
3433 memory_region_v1_0->receivers[0].composite_memory_region_offset;
3434
J-Alves33c47bf2022-09-29 11:36:20 +01003435 /* Determine the composite offset for v1.1 descriptor. */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003436 if (send_transaction) {
3437 fragment_constituents_size =
3438 *fragment_length - composite_offset_v1_0 -
3439 sizeof(struct ffa_composite_memory_region);
3440 fragment_length_v1_1 =
3441 receivers_end +
3442 sizeof(struct ffa_composite_memory_region) +
3443 fragment_constituents_size;
3444 composite_offset_v1_1 = receivers_end;
3445 } else {
3446 fragment_constituents_size = 0;
3447 fragment_length_v1_1 = receivers_end;
3448 composite_offset_v1_1 = 0;
3449 }
J-Alves33c47bf2022-09-29 11:36:20 +01003450
3451 /*
3452 * Currently only support the simpler cases: memory transaction
3453 * in a single fragment that fits in a MM_PPOOL_ENTRY_SIZE.
3454 * TODO: allocate the entries needed for this fragment_length_v1_1.
3455 * - Check corner when v1.1 descriptor converted size surpasses
3456 * the size of the entry.
3457 */
3458 if (fragment_length_v1_1 > MM_PPOOL_ENTRY_SIZE) {
3459 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00003460 "Translation of FF-A v1.0 descriptors for over %lu is "
J-Alves33c47bf2022-09-29 11:36:20 +01003461 "unsupported.",
3462 MM_PPOOL_ENTRY_SIZE);
3463 return ffa_error(FFA_NOT_SUPPORTED);
3464 }
3465
3466 space_left = fragment_length_v1_1;
3467
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003468 /*
3469 * Allocate a page of memory to construct the v1.1 memory descriptor.
3470 * Earlier we checked that the fragment_length_v1_1 would not be larger
3471 * than a page.
3472 */
J-Alves33c47bf2022-09-29 11:36:20 +01003473 memory_region_v1_1 =
3474 (struct ffa_memory_region *)mpool_alloc(&api_page_pool);
3475 if (memory_region_v1_1 == NULL) {
3476 return ffa_error(FFA_NO_MEMORY);
3477 }
3478
3479 /* Translate header from v1.0 to v1.1. */
3480 api_ffa_memory_region_v1_1_from_v1_0(memory_region_v1_0,
3481 memory_region_v1_1);
3482
3483 space_left -= sizeof(struct ffa_memory_region);
3484
3485 /* Copy memory access information. */
Daniel Boulby41ef8ba2023-10-13 17:01:22 +01003486 memcpy_s((uint8_t *)memory_region_v1_1 +
3487 memory_region_v1_1->receivers_offset,
3488 space_left, memory_region_v1_0->receivers, receivers_length);
J-Alves33c47bf2022-09-29 11:36:20 +01003489
3490 /* Initialize the memory access descriptors with composite offset. */
3491 for (uint32_t i = 0; i < memory_region_v1_1->receiver_count; i++) {
3492 struct ffa_memory_access *receiver =
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003493 ffa_memory_region_get_receiver(memory_region_v1_1, i);
3494 assert(receiver != NULL);
J-Alves33c47bf2022-09-29 11:36:20 +01003495 receiver->composite_memory_region_offset =
3496 composite_offset_v1_1;
3497 }
3498
3499 space_left -= receivers_length;
3500
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003501 /* Composite memory descriptors to copy. */
3502 if (send_transaction) {
3503 /* Init v1.1 composite. */
3504 composite_v1_1 = (struct ffa_composite_memory_region
3505 *)((uint8_t *)memory_region_v1_1 +
3506 composite_offset_v1_1);
J-Alves33c47bf2022-09-29 11:36:20 +01003507
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003508 composite_v1_0 = ffa_memory_region_get_composite_v1_0(
3509 memory_region_v1_0, 0);
3510 composite_v1_1->constituent_count =
3511 composite_v1_0->constituent_count;
3512 composite_v1_1->page_count = composite_v1_0->page_count;
J-Alves33c47bf2022-09-29 11:36:20 +01003513
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003514 space_left -= sizeof(struct ffa_composite_memory_region);
J-Alves33c47bf2022-09-29 11:36:20 +01003515
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003516 /* Initialize v1.1 constituents. */
3517 memcpy_s(composite_v1_1->constituents, space_left,
3518 composite_v1_0->constituents,
3519 fragment_constituents_size);
J-Alves33c47bf2022-09-29 11:36:20 +01003520
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003521 space_left -= fragment_constituents_size;
3522 }
3523
J-Alves33c47bf2022-09-29 11:36:20 +01003524 assert(space_left == 0U);
3525
J-Alves33c47bf2022-09-29 11:36:20 +01003526 /*
3527 * Remove the v1.0 fragment size, and resultant size of v1.1 fragment.
3528 */
3529 *total_length = *total_length - *fragment_length + fragment_length_v1_1;
3530 *fragment_length = fragment_length_v1_1;
3531
3532 /*
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003533 * After successfully updating to v1.1 copy the descriptor to the
3534 * internal buffer given as a parameter (used to prevent TOCTOU attacks)
3535 * and free the scratch memory used to construct it.
J-Alves33c47bf2022-09-29 11:36:20 +01003536 */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003537 memcpy_s(allocated, MM_PPOOL_ENTRY_SIZE, memory_region_v1_1,
3538 *fragment_length);
3539 mpool_free(&api_page_pool, memory_region_v1_1);
J-Alves33c47bf2022-09-29 11:36:20 +01003540
3541 return (struct ffa_value){.func = FFA_SUCCESS_32};
3542}
3543
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003544struct ffa_value api_ffa_mem_send(uint32_t share_func, uint32_t length,
3545 uint32_t fragment_length, ipaddr_t address,
Andrew Walbran1a86aa92020-05-15 17:22:28 +01003546 uint32_t page_count, struct vcpu *current)
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003547{
3548 struct vm *from = current->vm;
3549 struct vm *to;
3550 const void *from_msg;
J-Alves33c47bf2022-09-29 11:36:20 +01003551 void *allocated_entry;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003552 struct ffa_memory_region *memory_region = NULL;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003553 struct ffa_value ret;
J-Alves363f5722022-04-25 17:37:37 +01003554 bool targets_other_world = false;
Karl Meakin0e617d92024-04-05 12:55:22 +01003555 enum ffa_version ffa_version;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003556
3557 if (ipa_addr(address) != 0 || page_count != 0) {
3558 /*
3559 * Hafnium only supports passing the descriptor in the TX
3560 * mailbox.
3561 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003562 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003563 }
3564
Andrew Walbranca808b12020-05-15 17:22:28 +01003565 if (fragment_length > length) {
3566 dlog_verbose(
3567 "Fragment length %d greater than total length %d.\n",
3568 fragment_length, length);
3569 return ffa_error(FFA_INVALID_PARAMETERS);
3570 }
J-Alves33c47bf2022-09-29 11:36:20 +01003571
3572 if (fragment_length > HF_MAILBOX_SIZE ||
3573 fragment_length > MM_PPOOL_ENTRY_SIZE) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003574 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003575 }
3576
3577 /*
3578 * Check that the sender has configured its send buffer. If the TX
3579 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
3580 * be safely accessed after releasing the lock since the TX mailbox
3581 * address can only be configured once.
3582 */
3583 sl_lock(&from->lock);
3584 from_msg = from->mailbox.send;
J-Alves33c47bf2022-09-29 11:36:20 +01003585 ffa_version = from->ffa_version;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003586 sl_unlock(&from->lock);
3587
3588 if (from_msg == NULL) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003589 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003590 }
3591
3592 /*
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003593 * Copy the memory region descriptor to a fresh page from the memory
3594 * pool. This prevents the sender from changing it underneath us, and
3595 * also lets us keep it around in the share state table if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003596 */
J-Alves33c47bf2022-09-29 11:36:20 +01003597 allocated_entry = mpool_alloc(&api_page_pool);
3598 if (allocated_entry == NULL) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003599 dlog_verbose("Failed to allocate memory region copy.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003600 return ffa_error(FFA_NO_MEMORY);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003601 }
J-Alves33c47bf2022-09-29 11:36:20 +01003602
J-Alves8f2150d2024-03-28 16:15:56 +00003603 if (!memcpy_trapped(allocated_entry, MM_PPOOL_ENTRY_SIZE, from_msg,
3604 fragment_length)) {
3605 dlog_error(
3606 "%s: Failed to copy FF-A memory region descriptor.\n",
3607 __func__);
leisened7ed3d2024-08-06 17:25:18 +08003608 ret = ffa_error(FFA_ABORTED);
3609 goto out;
J-Alves8f2150d2024-03-28 16:15:56 +00003610 }
J-Alves33c47bf2022-09-29 11:36:20 +01003611
J-Alves8bc47f32025-03-21 10:23:51 +00003612 /*
3613 * Out-of-bounds accesses should be eliminated by the sanity checks
3614 * below.
3615 */
Daniel Boulbyc7dc9322023-10-27 15:12:07 +01003616 if (!ffa_memory_region_sanity_check(allocated_entry, ffa_version,
3617 fragment_length, true)) {
3618 ret = ffa_error(FFA_INVALID_PARAMETERS);
3619 goto out;
3620 }
3621
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003622 ret = api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3623 allocated_entry, &fragment_length, &length, ffa_version, true);
J-Alves33c47bf2022-09-29 11:36:20 +01003624 if (ret.func != FFA_SUCCESS_32) {
3625 goto out;
3626 }
3627
J-Alves8bc47f32025-03-21 10:23:51 +00003628 memory_region = allocated_entry;
3629
J-Alves33c47bf2022-09-29 11:36:20 +01003630 if (fragment_length < sizeof(struct ffa_memory_region) +
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003631 memory_region->memory_access_desc_size) {
J-Alves33c47bf2022-09-29 11:36:20 +01003632 dlog_verbose(
3633 "Initial fragment length %d smaller than header size "
Karl Meakine8937d92024-03-19 16:04:25 +00003634 "%lu.\n",
J-Alves33c47bf2022-09-29 11:36:20 +01003635 fragment_length,
3636 sizeof(struct ffa_memory_region) +
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003637 memory_region->memory_access_desc_size);
3638 ret = ffa_error(FFA_INVALID_PARAMETERS);
3639 goto out;
J-Alves33c47bf2022-09-29 11:36:20 +01003640 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003641
J-Alves84658fc2021-06-17 14:37:32 +01003642 if (!api_memory_region_check_flags(memory_region, share_func)) {
3643 dlog_verbose(
3644 "Memory region reserved arguments must be zero.\n");
3645 ret = ffa_error(FFA_INVALID_PARAMETERS);
3646 goto out;
3647 }
3648
J-Alves363f5722022-04-25 17:37:37 +01003649 if (memory_region->receiver_count == 0U) {
3650 dlog_verbose("Receiver count can't be 0.\n");
3651 ret = ffa_error(FFA_INVALID_PARAMETERS);
3652 goto out;
3653 }
3654
J-Alves95fbb312024-03-20 15:19:16 +00003655 if ((share_func == FFA_MEM_DONATE_32 ||
3656 share_func == FFA_MEM_DONATE_64) &&
J-Alves363f5722022-04-25 17:37:37 +01003657 memory_region->receiver_count != 1U) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003658 dlog_verbose(
J-Alves0a824e92024-04-26 16:20:12 +01003659 "FFA_MEM_DONATE only supports one recipient. Specified "
3660 "%u\n",
J-Alves363f5722022-04-25 17:37:37 +01003661 memory_region->receiver_count);
3662 ret = ffa_error(FFA_INVALID_PARAMETERS);
3663 goto out;
3664 }
3665
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003666 /*
3667 * Ensure that the receiver VM exists and isn't the same as the sender.
J-Alves363f5722022-04-25 17:37:37 +01003668 * If there is a receiver from the other world, track it for later
3669 * forwarding if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003670 */
J-Alves363f5722022-04-25 17:37:37 +01003671 for (uint32_t i = 0U; i < memory_region->receiver_count; i++) {
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003672 struct ffa_memory_access *receiver =
3673 ffa_memory_region_get_receiver(memory_region, i);
J-Alvesc9227c82024-04-24 21:00:58 +01003674 ffa_id_t receiver_id;
3675
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003676 assert(receiver != NULL);
J-Alvesc9227c82024-04-24 21:00:58 +01003677
3678 receiver_id = receiver->receiver_permissions.receiver;
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003679
J-Alves363f5722022-04-25 17:37:37 +01003680 to = vm_find(receiver_id);
3681
J-Alves7de61af2024-03-27 10:29:46 +00003682 if ((vm_id_is_current_world(receiver_id) && to == NULL) ||
3683 to == from) {
J-Alves363f5722022-04-25 17:37:37 +01003684 dlog_verbose("%s: invalid receiver.\n", __func__);
3685 ret = ffa_error(FFA_INVALID_PARAMETERS);
3686 goto out;
3687 }
3688
Karl Meakin117c8082024-12-04 16:03:28 +00003689 if (!ffa_memory_is_send_valid(
J-Alvesc9227c82024-04-24 21:00:58 +01003690 receiver_id, from->id, share_func,
3691 memory_region->receiver_count > 1)) {
J-Alves363f5722022-04-25 17:37:37 +01003692 ret = ffa_error(FFA_DENIED);
3693 goto out;
3694 }
3695
3696 /* Capture if any of the receivers is from the other world. */
3697 if (!targets_other_world) {
3698 targets_other_world =
3699 !vm_id_is_current_world(receiver_id);
3700 }
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003701 }
3702
J-Alves363f5722022-04-25 17:37:37 +01003703 if (targets_other_world) {
Karl Meakin117c8082024-12-04 16:03:28 +00003704 ret = ffa_memory_other_world_mem_send(
J-Alves66652252022-07-06 09:49:51 +01003705 from, share_func, &memory_region, length,
3706 fragment_length, &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003707 } else {
3708 struct vm_locked from_locked = vm_lock(from);
3709
Andrew Walbran1a86aa92020-05-15 17:22:28 +01003710 ret = ffa_memory_send(from_locked, memory_region, length,
3711 fragment_length, share_func,
3712 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003713 /*
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003714 * ffa_memory_send takes ownership of the memory_region, so
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003715 * make sure we don't free it.
3716 */
3717 memory_region = NULL;
3718
3719 vm_unlock(&from_locked);
3720 }
3721
3722out:
3723 if (memory_region != NULL) {
3724 mpool_free(&api_page_pool, memory_region);
3725 }
3726
3727 return ret;
3728}
3729
J-Alvesc7270b72024-09-12 10:16:34 +01003730/**
3731 * An FFA_MEM_RETRIEVE_REQ from the hypervisor must specify the handle of the
3732 * memory transaction it is querying and all other fields must be 0.
3733 */
3734static bool api_ffa_memory_hypervisor_retrieve_request_validate(
3735 struct ffa_memory_region *request, enum ffa_version version)
3736{
3737 switch (version) {
3738 case FFA_VERSION_1_0: {
3739 struct ffa_memory_region_v1_0 *request_v1_0 =
3740 (struct ffa_memory_region_v1_0 *)request;
3741
3742 return request_v1_0->sender == 0U &&
3743 request_v1_0->attributes.shareability == 0U &&
3744 request_v1_0->attributes.cacheability == 0U &&
3745 request_v1_0->attributes.type == 0U &&
3746 request_v1_0->attributes.security == 0U &&
3747 request_v1_0->flags == 0U && request_v1_0->tag == 0U &&
3748 request_v1_0->receiver_count == 0U &&
Karl Meakin117c8082024-12-04 16:03:28 +00003749 ffa_memory_is_handle_allocated_by_current_world(
J-Alvesc7270b72024-09-12 10:16:34 +01003750 request_v1_0->handle);
3751 }
3752 default:
3753 return request->sender == 0U &&
3754 request->attributes.shareability == 0U &&
3755 request->attributes.cacheability == 0U &&
3756 request->attributes.type == 0U &&
3757 request->attributes.security == 0U &&
3758 request->flags == 0U && request->tag == 0U &&
3759 request->memory_access_desc_size == 0U &&
3760 request->receiver_count == 0U &&
3761 request->receivers_offset == 0U &&
Karl Meakin117c8082024-12-04 16:03:28 +00003762 ffa_memory_is_handle_allocated_by_current_world(
J-Alvesc7270b72024-09-12 10:16:34 +01003763 request->handle);
3764 }
3765}
3766
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003767struct ffa_value api_ffa_mem_retrieve_req(uint32_t length,
3768 uint32_t fragment_length,
3769 ipaddr_t address, uint32_t page_count,
3770 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003771{
3772 struct vm *to = current->vm;
3773 struct vm_locked to_locked;
3774 const void *to_msg;
J-Alves00847062022-10-03 17:08:44 +01003775 void *retrieve_msg;
3776 struct ffa_memory_region *retrieve_request = NULL;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003777 uint32_t message_buffer_size;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003778 struct ffa_value ret;
Karl Meakin0e617d92024-04-05 12:55:22 +01003779 enum ffa_version ffa_version;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003780
3781 if (ipa_addr(address) != 0 || page_count != 0) {
3782 /*
3783 * Hafnium only supports passing the descriptor in the TX
3784 * mailbox.
3785 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003786 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003787 }
3788
Andrew Walbrana65a1322020-04-06 19:32:32 +01003789 if (fragment_length != length) {
J-Alves33c47bf2022-09-29 11:36:20 +01003790 dlog_verbose("Fragmentation not supported.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003791 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003792 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003793
J-Alves00847062022-10-03 17:08:44 +01003794 retrieve_msg = cpu_get_buffer(current->cpu);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003795 message_buffer_size = cpu_get_buffer_size(current->cpu);
3796 if (length > HF_MAILBOX_SIZE || length > message_buffer_size) {
3797 dlog_verbose("Retrieve request too long.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003798 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003799 }
3800
3801 to_locked = vm_lock(to);
3802 to_msg = to->mailbox.send;
J-Alves00847062022-10-03 17:08:44 +01003803 ffa_version = to->ffa_version;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003804
3805 if (to_msg == NULL) {
3806 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003807 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003808 goto out;
3809 }
3810
3811 /*
3812 * Copy the retrieve request descriptor to an internal buffer, so that
3813 * the caller can't change it underneath us.
3814 */
J-Alves8f2150d2024-03-28 16:15:56 +00003815 if (!memcpy_trapped(retrieve_msg, message_buffer_size, to_msg,
3816 length)) {
3817 dlog_error(
3818 "%s: Failed to copy FF-A retrieve request "
3819 "descriptor.\n",
3820 __func__);
3821 ret = ffa_error(FFA_ABORTED);
3822 goto out;
3823 }
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003824
J-Alvese8c8c2b2022-12-16 15:34:48 +00003825 if ((vm_is_mailbox_other_world_owned(to_locked) &&
Karl Meakin117c8082024-12-04 16:03:28 +00003826 !ffa_setup_acquire_receiver_rx(to_locked, &ret)) ||
J-Alvese8c8c2b2022-12-16 15:34:48 +00003827 vm_is_mailbox_busy(to_locked)) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003828 /*
J-Alvese8c8c2b2022-12-16 15:34:48 +00003829 * Can't retrieve memory information if the mailbox is
3830 * not available.
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003831 */
J-Alves59ed0042022-07-28 18:26:41 +01003832 dlog_verbose("%s: RX buffer not ready.\n", __func__);
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003833 ret = ffa_error(FFA_BUSY);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003834 goto out;
3835 }
3836
Daniel Boulby296ee702023-11-28 13:36:55 +00003837 if (!is_ffa_hypervisor_retrieve_request(retrieve_msg)) {
J-Alves8bc47f32025-03-21 10:23:51 +00003838 /*
3839 * The checks from function below should guarantee there are no
3840 * invalid values, and the accesses that follow can't be out of
3841 * bounds.
3842 */
Daniel Boulby44e9b3b2024-01-17 12:21:44 +00003843 if (!ffa_memory_region_sanity_check(retrieve_msg, ffa_version,
3844 fragment_length, false)) {
3845 ret = ffa_error(FFA_INVALID_PARAMETERS);
3846 goto out;
3847 }
3848 /*
3849 * If required, transform the retrieve request to FF-A v1.1.
3850 */
3851 ret = api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3852 retrieve_msg, &fragment_length, &length, ffa_version,
3853 false);
Daniel Boulbyc7dc9322023-10-27 15:12:07 +01003854
Daniel Boulby44e9b3b2024-01-17 12:21:44 +00003855 if (ret.func != FFA_SUCCESS_32) {
3856 goto out;
3857 }
J-Alvesc7270b72024-09-12 10:16:34 +01003858 } else {
3859 if (!api_ffa_memory_hypervisor_retrieve_request_validate(
3860 retrieve_msg, ffa_version)) {
3861 dlog_verbose(
3862 "All fields except the handle in the "
3863 "memory access descriptor must be zero for a "
3864 "hypervisor retrieve request.\n");
3865 ret = ffa_error(FFA_INVALID_PARAMETERS);
3866 goto out;
3867 }
J-Alves00847062022-10-03 17:08:44 +01003868 }
3869
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003870 retrieve_request = retrieve_msg;
Kathleen Capella578784f2023-09-01 18:03:27 -04003871
Karl Meakin117c8082024-12-04 16:03:28 +00003872 if (ffa_memory_is_handle_allocated_by_current_world(
J-Alvesb5084cf2022-07-06 14:20:12 +01003873 retrieve_request->handle)) {
3874 ret = ffa_memory_retrieve(to_locked, retrieve_request, length,
3875 &api_page_pool);
3876 } else {
Daniel Boulbyfdd59f72023-10-19 16:43:19 +01003877 dlog_error("Invalid FF-A memory handle.\n");
3878 ret = ffa_error(FFA_INVALID_PARAMETERS);
J-Alvesb5084cf2022-07-06 14:20:12 +01003879 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003880out:
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003881 vm_unlock(&to_locked);
3882 return ret;
3883}
3884
J-Alvesa39a8442024-04-26 15:41:47 +01003885/**
3886 * Copies the memory relinquish descriptor from the partition's TX buffer, to
3887 * the buffer of the local CPU. Do it safely, and return error if:
3888 * - FFA_ABORTED: if the `memcpy_trapped` fails.
3889 * - FFA_INVALID_PARAMETERS: if the size of the full memory relinquish
3890 * descriptor doesn't fit the local CPU buffer.
3891 *
3892 * Returns FFA_SUCCESS if copying goes well, and sets 'out_relinquish'
3893 * to the address of the cpu buffer with the relinquish descriptor.
3894 */
3895static struct ffa_value api_get_ffa_mem_relinquish_descriptor(
3896 struct vcpu *current, const void *from_msg,
3897 struct ffa_mem_relinquish **out_relinquish)
3898{
3899 struct ffa_mem_relinquish *relinquish_request;
3900 uint32_t from_msg_size;
3901 uint32_t total_from_msg_size;
3902 uint32_t dst_size;
3903 vaddr_t dst;
3904 vaddr_t src;
3905
3906 assert(from_msg != NULL);
3907 assert(out_relinquish != NULL);
3908
3909 /*
3910 * Copy the relinquish descriptor to an internal buffer, so that the
3911 * caller can't change it underneath us.
3912 */
3913 relinquish_request =
3914 (struct ffa_mem_relinquish *)cpu_get_buffer(current->cpu);
3915
3916 /* Set the destination for the copy. */
3917 dst = va_from_ptr(relinquish_request);
3918 src = va_from_ptr(from_msg);
3919
3920 dst_size = cpu_get_buffer_size(current->cpu);
3921
3922 /* Only copy the size to start with. */
3923 from_msg_size = sizeof(struct ffa_mem_relinquish);
3924 total_from_msg_size = from_msg_size;
3925
3926 if (!memcpy_trapped(ptr_from_va(dst), dst_size, ptr_from_va(src),
3927 from_msg_size)) {
3928 dlog_error(
3929 "%s: Failed to copy FF-A memory relinquish "
3930 "descriptor.\n",
3931 __func__);
3932 return ffa_error(FFA_ABORTED);
3933 }
3934
3935 if (relinquish_request->endpoint_count != 1) {
3936 dlog_error("%s: relinquish descriptor must have 1 endpoint\n",
3937 __func__);
3938 return ffa_error(FFA_INVALID_PARAMETERS);
3939 }
3940
3941 /*
3942 * Increment the `dst` to the position right after the copied header.
3943 * Increment the `src` to point at the list of endpoints.
3944 *
3945 * Calculate the new `dst_size` which is the size of the allocated cpu
3946 * buffer, minus the size of the copied memory relinquish header.
3947 *
3948 * Only after the above: determine the new `from_msg_size` in accordance
3949 * to the endpoint count.
3950 */
3951 dst = va_add(dst, from_msg_size);
3952 src = va_add(src, from_msg_size);
3953
3954 /*
3955 * Check if it is safe to copy the rest of the message.
3956 * This also serves as a santiy check to 'endpoint_count'.
3957 * The size of what is left in the descriptor, based on endpoint_count,
3958 * shall not be bigger than the size of the mailbox minus the size of
3959 * the header which was previously copied in this function.
3960 */
3961 dst_size -= from_msg_size;
3962 from_msg_size = relinquish_request->endpoint_count * sizeof(ffa_id_t);
3963 total_from_msg_size += from_msg_size;
3964
3965 if (total_from_msg_size > HF_MAILBOX_SIZE ||
3966 total_from_msg_size > dst_size) {
3967 dlog_verbose(
3968 "Relinquish message too long. Endpoint count: %u\n",
3969 relinquish_request->endpoint_count);
3970 return ffa_error(FFA_INVALID_PARAMETERS);
3971 }
3972
3973 /* Copy the remaining fragment. */
3974 if (!memcpy_trapped(ptr_from_va(dst), dst_size, ptr_from_va(src),
3975 from_msg_size)) {
3976 dlog_error("%s: Failed to copy FF-A relinquish request.\n",
3977 __func__);
3978 return ffa_error(FFA_ABORTED);
3979 }
3980
3981 /*
3982 * Set the output address for the relinquish descriptor to the current
3983 * cpu's buffer.
3984 */
3985 *out_relinquish = relinquish_request;
3986
3987 return (struct ffa_value){.func = FFA_SUCCESS_32};
3988}
3989
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003990struct ffa_value api_ffa_mem_relinquish(struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003991{
3992 struct vm *from = current->vm;
3993 struct vm_locked from_locked;
3994 const void *from_msg;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003995 struct ffa_value ret;
J-Alvesa39a8442024-04-26 15:41:47 +01003996 struct ffa_mem_relinquish *relinquish_request;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003997
3998 from_locked = vm_lock(from);
3999 from_msg = from->mailbox.send;
4000
4001 if (from_msg == NULL) {
4002 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004003 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004004 goto out;
4005 }
4006
J-Alvesa39a8442024-04-26 15:41:47 +01004007 ret = api_get_ffa_mem_relinquish_descriptor(current, from_msg,
4008 &relinquish_request);
4009
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004010 /*
J-Alvesa39a8442024-04-26 15:41:47 +01004011 * If the descriptor was safely copied, continue with the handling of
4012 * the retrieve request.
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004013 */
J-Alvesa39a8442024-04-26 15:41:47 +01004014 if (ret.func == FFA_SUCCESS_32) {
4015 ret = ffa_memory_relinquish(from_locked, relinquish_request,
4016 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004017 }
J-Alves8f2150d2024-03-28 16:15:56 +00004018
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004019out:
4020 vm_unlock(&from_locked);
4021 return ret;
4022}
4023
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004024struct ffa_value api_ffa_mem_reclaim(ffa_memory_handle_t handle,
4025 ffa_memory_region_flags_t flags,
4026 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004027{
4028 struct vm *to = current->vm;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004029 struct ffa_value ret;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004030
Karl Meakin117c8082024-12-04 16:03:28 +00004031 if (ffa_memory_is_handle_allocated_by_current_world(handle)) {
Andrew Walbran290b0c92020-02-03 16:37:14 +00004032 struct vm_locked to_locked = vm_lock(to);
4033
Andrew Walbranca808b12020-05-15 17:22:28 +01004034 ret = ffa_memory_reclaim(to_locked, handle, flags,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004035 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004036
Andrew Walbran290b0c92020-02-03 16:37:14 +00004037 vm_unlock(&to_locked);
4038 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004039 ret = ffa_memory_other_world_mem_reclaim(to, handle, flags,
4040 &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01004041 }
4042
4043 return ret;
4044}
4045
4046struct ffa_value api_ffa_mem_frag_rx(ffa_memory_handle_t handle,
4047 uint32_t fragment_offset,
J-Alves19e20cf2023-08-02 12:48:55 +01004048 ffa_id_t sender_vm_id,
Andrew Walbranca808b12020-05-15 17:22:28 +01004049 struct vcpu *current)
4050{
4051 struct vm *to = current->vm;
4052 struct vm_locked to_locked;
4053 struct ffa_value ret;
4054
4055 /* Sender ID MBZ at virtual instance. */
J-Alves59ed0042022-07-28 18:26:41 +01004056 if (vm_id_is_current_world(to->id)) {
4057 if (sender_vm_id != 0) {
4058 dlog_verbose("%s: Invalid sender.\n", __func__);
4059 return ffa_error(FFA_INVALID_PARAMETERS);
4060 }
Andrew Walbranca808b12020-05-15 17:22:28 +01004061 }
4062
4063 to_locked = vm_lock(to);
4064
J-Alves122f1a12022-12-12 15:55:42 +00004065 if (vm_is_mailbox_busy(to_locked)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01004066 /*
4067 * Can't retrieve memory information if the mailbox is not
4068 * available.
4069 */
J-Alves59ed0042022-07-28 18:26:41 +01004070 dlog_verbose("%s: RX buffer not ready partition %x.\n",
4071 __func__, to_locked.vm->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01004072 ret = ffa_error(FFA_BUSY);
4073 goto out;
4074 }
4075
J-Alvesc3fd9752024-04-04 11:45:33 +01004076 /*
4077 * Whilst copying the fragments, initialize the remaining constituents
4078 * in the CPU's internal structure, and later copy from the CPU buffer
4079 * into the partition's RX buffer. In the case SPMC is doing a retrieve
4080 * request for a VM/Hypervisor in an RME enabled system, there is no
4081 * guarantee the RX buffer is in the NS PAS. Accessing the buffer with
4082 * the wrong security state attribute would then result in an GPF.
4083 * The fragment is initialized in an internal buffer, and is later
4084 * copied to the RX buffer using the 'memcpy_trapped' which allows to
4085 * smoothly terminate the operation if the access has been preempted by
4086 * a GPF exception.
4087 */
4088 ret = ffa_memory_retrieve_continue(
4089 to_locked, handle, fragment_offset, sender_vm_id,
4090 cpu_get_buffer(current->cpu), &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01004091out:
4092 vm_unlock(&to_locked);
4093 return ret;
4094}
4095
4096struct ffa_value api_ffa_mem_frag_tx(ffa_memory_handle_t handle,
4097 uint32_t fragment_length,
J-Alves19e20cf2023-08-02 12:48:55 +01004098 ffa_id_t sender_vm_id,
Andrew Walbranca808b12020-05-15 17:22:28 +01004099 struct vcpu *current)
4100{
4101 struct vm *from = current->vm;
4102 const void *from_msg;
4103 void *fragment_copy;
4104 struct ffa_value ret;
4105
4106 /* Sender ID MBZ at virtual instance. */
J-Alvesfdd29272022-07-19 13:16:31 +01004107 if (vm_id_is_current_world(from->id) && sender_vm_id != 0) {
4108 dlog_verbose("Invalid sender.");
Andrew Walbranca808b12020-05-15 17:22:28 +01004109 return ffa_error(FFA_INVALID_PARAMETERS);
4110 }
4111
4112 /*
4113 * Check that the sender has configured its send buffer. If the TX
4114 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
4115 * be safely accessed after releasing the lock since the TX mailbox
4116 * address can only be configured once.
4117 */
4118 sl_lock(&from->lock);
4119 from_msg = from->mailbox.send;
4120 sl_unlock(&from->lock);
4121
4122 if (from_msg == NULL) {
J-Alves59ed0042022-07-28 18:26:41 +01004123 dlog_verbose("Mailbox from %x is not set.\n", from->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01004124 return ffa_error(FFA_INVALID_PARAMETERS);
4125 }
4126
4127 /*
4128 * Copy the fragment to a fresh page from the memory pool. This prevents
4129 * the sender from changing it underneath us, and also lets us keep it
4130 * around in the share state table if needed.
4131 */
4132 if (fragment_length > HF_MAILBOX_SIZE ||
4133 fragment_length > MM_PPOOL_ENTRY_SIZE) {
4134 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004135 "Fragment length %d larger than mailbox size %zu.\n",
Andrew Walbranca808b12020-05-15 17:22:28 +01004136 fragment_length, HF_MAILBOX_SIZE);
4137 return ffa_error(FFA_INVALID_PARAMETERS);
4138 }
4139 if (fragment_length < sizeof(struct ffa_memory_region_constituent) ||
4140 fragment_length % sizeof(struct ffa_memory_region_constituent) !=
4141 0) {
4142 dlog_verbose("Invalid fragment length %d.\n", fragment_length);
4143 return ffa_error(FFA_INVALID_PARAMETERS);
4144 }
4145 fragment_copy = mpool_alloc(&api_page_pool);
4146 if (fragment_copy == NULL) {
4147 dlog_verbose("Failed to allocate fragment copy.\n");
4148 return ffa_error(FFA_NO_MEMORY);
4149 }
J-Alves8f2150d2024-03-28 16:15:56 +00004150
4151 if (!memcpy_trapped(fragment_copy, MM_PPOOL_ENTRY_SIZE, from_msg,
4152 fragment_length)) {
4153 dlog_error("%s: Failed to copy fragment.\n", __func__);
4154 return ffa_error(FFA_ABORTED);
4155 }
Andrew Walbranca808b12020-05-15 17:22:28 +01004156
4157 /*
4158 * Hafnium doesn't support fragmentation of memory retrieve requests
4159 * (because it doesn't support caller-specified mappings, so a request
4160 * will never be larger than a single page), so this must be part of a
4161 * memory send (i.e. donate, lend or share) request.
4162 *
4163 * We can tell from the handle whether the memory transaction is for the
J-Alvesfdd29272022-07-19 13:16:31 +01004164 * other world or not.
Andrew Walbranca808b12020-05-15 17:22:28 +01004165 */
Karl Meakin117c8082024-12-04 16:03:28 +00004166 if (ffa_memory_is_handle_allocated_by_current_world(handle)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01004167 struct vm_locked from_locked = vm_lock(from);
4168
4169 ret = ffa_memory_send_continue(from_locked, fragment_copy,
4170 fragment_length, handle,
4171 &api_page_pool);
4172 /*
4173 * `ffa_memory_send_continue` takes ownership of the
4174 * fragment_copy, so we don't need to free it here.
4175 */
4176 vm_unlock(&from_locked);
4177 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004178 ret = ffa_memory_other_world_mem_send_continue(
J-Alvesfdd29272022-07-19 13:16:31 +01004179 from, fragment_copy, fragment_length, handle,
4180 &api_page_pool);
Andrew Walbran290b0c92020-02-03 16:37:14 +00004181 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00004182
4183 return ret;
4184}
Max Shvetsov40108e72020-08-27 12:39:50 +01004185
Olivier Deprezd614d322021-06-18 15:21:00 +02004186/**
4187 * Register an entry point for a vCPU in warm boot cases.
4188 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1 FFA_SECONDARY_EP_REGISTER.
4189 */
Max Shvetsov40108e72020-08-27 12:39:50 +01004190struct ffa_value api_ffa_secondary_ep_register(ipaddr_t entry_point,
4191 struct vcpu *current)
4192{
4193 struct vm_locked vm_locked;
Olivier Deprezb2808332023-02-02 15:25:40 +01004194 struct vcpu_locked current_locked;
Max Shvetsov40108e72020-08-27 12:39:50 +01004195
Olivier Deprezd614d322021-06-18 15:21:00 +02004196 /*
4197 * Reject if interface is not supported at this FF-A instance
4198 * (DEN0077A FF-A v1.1 Beta0 Table 18.29) or the VM is UP.
4199 */
Karl Meakin117c8082024-12-04 16:03:28 +00004200 if (!ffa_setup_is_secondary_ep_register_supported() ||
Karl Meakin82041822024-05-20 11:14:34 +01004201 vm_is_up(current->vm)) {
Olivier Deprezd614d322021-06-18 15:21:00 +02004202 return ffa_error(FFA_NOT_SUPPORTED);
4203 }
4204
4205 /*
4206 * No further check is made on the address validity
4207 * (FF-A v1.1 Beta0 Table 18.29) as the VM boundaries are not known
4208 * from the VM or vCPU structure.
4209 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1.1:
4210 * For each SP [...] the Framework assumes that the same entry point
4211 * address is used for initializing any execution context during a
4212 * secondary cold boot.
4213 * If this function is invoked multiple times, then the entry point
4214 * address specified in the last valid invocation must be used by the
4215 * callee.
4216 */
Olivier Deprezb2808332023-02-02 15:25:40 +01004217 current_locked = vcpu_lock(current);
4218 if (current->rt_model != RTM_SP_INIT) {
4219 dlog_error(
4220 "FFA_SECONDARY_EP_REGISTER can only be called while "
4221 "vCPU in run-time state for initialization.\n");
4222 vcpu_unlock(&current_locked);
4223 return ffa_error(FFA_DENIED);
Olivier Deprezd614d322021-06-18 15:21:00 +02004224 }
Olivier Deprezb2808332023-02-02 15:25:40 +01004225 vcpu_unlock(&current_locked);
Olivier Deprezd614d322021-06-18 15:21:00 +02004226
Olivier Deprezb2808332023-02-02 15:25:40 +01004227 vm_locked = vm_lock(current->vm);
Max Shvetsov40108e72020-08-27 12:39:50 +01004228 vm_locked.vm->secondary_ep = entry_point;
4229 vm_unlock(&vm_locked);
4230
Olivier Deprezb2808332023-02-02 15:25:40 +01004231 return (struct ffa_value){.func = FFA_SUCCESS_32};
Max Shvetsov40108e72020-08-27 12:39:50 +01004232}
J-Alvesa0f317d2021-06-09 13:31:59 +01004233
J-Alves19e20cf2023-08-02 12:48:55 +01004234struct ffa_value api_ffa_notification_bitmap_create(ffa_id_t vm_id,
J-Alvesa0f317d2021-06-09 13:31:59 +01004235 ffa_vcpu_count_t vcpu_count,
4236 struct vcpu *current)
4237{
J-Alves7ccaccf2024-02-01 14:25:23 +00004238 const struct ffa_value ret =
Karl Meakin117c8082024-12-04 16:03:28 +00004239 ffa_notifications_is_bitmap_access_valid(current, vm_id);
J-Alves7ccaccf2024-02-01 14:25:23 +00004240
4241 if (ffa_func_id(ret) != FFA_SUCCESS_32) {
4242 dlog_verbose(
4243 "FFA_NOTIFICATION_BITMAP_CREATE to be used by "
4244 "hypervisor for valid NWd VM IDs only (%x).\n",
4245 vm_id);
4246 return ret;
J-Alvesa0f317d2021-06-09 13:31:59 +01004247 }
4248
Karl Meakin117c8082024-12-04 16:03:28 +00004249 return ffa_notifications_bitmap_create(vm_id, vcpu_count);
J-Alvesa0f317d2021-06-09 13:31:59 +01004250}
4251
J-Alves19e20cf2023-08-02 12:48:55 +01004252struct ffa_value api_ffa_notification_bitmap_destroy(ffa_id_t vm_id,
J-Alvesa0f317d2021-06-09 13:31:59 +01004253 struct vcpu *current)
4254{
J-Alves7ccaccf2024-02-01 14:25:23 +00004255 const struct ffa_value ret =
Karl Meakin117c8082024-12-04 16:03:28 +00004256 ffa_notifications_is_bitmap_access_valid(current, vm_id);
J-Alves7ccaccf2024-02-01 14:25:23 +00004257
4258 if (ffa_func_id(ret) != FFA_SUCCESS_32) {
4259 dlog_verbose(
4260 "FFA_NOTIFICATION_BITMAP_DESTROY to be used by "
4261 "hypervisor for valid NWd VM IDs only (%x).\n",
4262 vm_id);
4263 return ret;
J-Alvesa0f317d2021-06-09 13:31:59 +01004264 }
4265
Karl Meakin117c8082024-12-04 16:03:28 +00004266 return ffa_notifications_bitmap_destroy(vm_id);
J-Alvesa0f317d2021-06-09 13:31:59 +01004267}
J-Alvesc003a7a2021-03-18 13:06:53 +00004268
4269struct ffa_value api_ffa_notification_update_bindings(
J-Alves19e20cf2023-08-02 12:48:55 +01004270 ffa_id_t sender_vm_id, ffa_id_t receiver_vm_id, uint32_t flags,
J-Alvesc003a7a2021-03-18 13:06:53 +00004271 ffa_notifications_bitmap_t notifications, bool is_bind,
4272 struct vcpu *current)
4273{
4274 struct ffa_value ret = {.func = FFA_SUCCESS_32};
4275 struct vm_locked receiver_locked;
4276 const bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
J-Alves19e20cf2023-08-02 12:48:55 +01004277 const ffa_id_t id_to_update = is_bind ? sender_vm_id : HF_INVALID_VM_ID;
4278 const ffa_id_t id_to_validate =
J-Alvesc003a7a2021-03-18 13:06:53 +00004279 is_bind ? HF_INVALID_VM_ID : sender_vm_id;
J-Alves1daeaea2022-09-06 17:41:24 +01004280 const uint32_t flags_mbz =
4281 is_bind ? ~FFA_NOTIFICATIONS_FLAG_PER_VCPU : ~0U;
4282
4283 if ((flags_mbz & flags) != 0U) {
4284 return ffa_error(FFA_INVALID_PARAMETERS);
4285 }
J-Alvesc003a7a2021-03-18 13:06:53 +00004286
Karl Meakin117c8082024-12-04 16:03:28 +00004287 if (!ffa_notifications_is_bind_valid(current, sender_vm_id,
4288 receiver_vm_id)) {
J-Alvesc003a7a2021-03-18 13:06:53 +00004289 dlog_verbose("Invalid use of notifications bind interface.\n");
4290 return ffa_error(FFA_INVALID_PARAMETERS);
4291 }
4292
Karl Meakin117c8082024-12-04 16:03:28 +00004293 if (ffa_notifications_update_bindings_forward(
J-Alvesb15e9402021-09-08 11:44:42 +01004294 receiver_vm_id, sender_vm_id, flags, notifications, is_bind,
4295 &ret)) {
J-Alvesb15e9402021-09-08 11:44:42 +01004296 return ret;
4297 }
4298
J-Alvesc003a7a2021-03-18 13:06:53 +00004299 if (notifications == 0U) {
Karl Meakine8937d92024-03-19 16:04:25 +00004300 dlog_verbose("No notifications have been specified %lx.\n",
J-Alves1512acc2024-02-01 16:57:10 +00004301 notifications);
J-Alvesc003a7a2021-03-18 13:06:53 +00004302 return ffa_error(FFA_INVALID_PARAMETERS);
4303 }
4304
4305 /**
4306 * This check assumes receiver is the current VM, and has been enforced
Karl Meakin117c8082024-12-04 16:03:28 +00004307 * by 'ffa_notifications_is_bind_valid'.
J-Alvesc003a7a2021-03-18 13:06:53 +00004308 */
Karl Meakin117c8082024-12-04 16:03:28 +00004309 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesc003a7a2021-03-18 13:06:53 +00004310
4311 if (receiver_locked.vm == NULL) {
4312 dlog_verbose("Receiver doesn't exist!\n");
J-Alves7333dcf2024-02-01 17:25:10 +00004313 return ffa_error(FFA_INVALID_PARAMETERS);
J-Alvesc003a7a2021-03-18 13:06:53 +00004314 }
4315
J-Alves3e55c4d2024-10-09 14:24:07 +01004316 if (receiver_locked.vm->ffa_version < FFA_VERSION_1_1) {
4317 dlog_verbose(
4318 "%s: caller (%x) version should be GE to FF-A v1.1.\n",
4319 __func__, receiver_locked.vm->id);
4320 ret = ffa_error(FFA_NOT_SUPPORTED);
4321 goto out;
4322 }
4323
J-Alves09ff9d82021-11-02 11:55:20 +00004324 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesc003a7a2021-03-18 13:06:53 +00004325 dlog_verbose("Notifications are not enabled.\n");
4326 ret = ffa_error(FFA_NOT_SUPPORTED);
4327 goto out;
4328 }
4329
4330 if (is_bind && vm_id_is_current_world(sender_vm_id) &&
4331 vm_find(sender_vm_id) == NULL) {
4332 dlog_verbose("Sender VM does not exist!\n");
4333 ret = ffa_error(FFA_INVALID_PARAMETERS);
4334 goto out;
4335 }
4336
4337 /*
4338 * Can't bind/unbind notifications if at least one is bound to a
4339 * different sender.
4340 */
4341 if (!vm_notifications_validate_bound_sender(
J-Alves661e1b72023-08-02 13:39:40 +01004342 receiver_locked, ffa_is_vm_id(sender_vm_id), id_to_validate,
4343 notifications)) {
J-Alvesf0208142024-02-01 17:28:58 +00004344 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004345 "Sender %x not permitted to set notifications %lx to "
J-Alvesf0208142024-02-01 17:28:58 +00004346 "%x.\n",
4347 sender_vm_id, notifications, receiver_vm_id);
J-Alvesc003a7a2021-03-18 13:06:53 +00004348 ret = ffa_error(FFA_DENIED);
4349 goto out;
4350 }
4351
4352 /**
4353 * Check if there is a pending notification within those specified in
4354 * the bitmap.
4355 */
4356 if (vm_are_notifications_pending(receiver_locked,
J-Alves661e1b72023-08-02 13:39:40 +01004357 ffa_is_vm_id(sender_vm_id),
J-Alvesc003a7a2021-03-18 13:06:53 +00004358 notifications)) {
Karl Meakine8937d92024-03-19 16:04:25 +00004359 dlog_verbose("Notifications within '%lx' pending.\n",
J-Alvesc003a7a2021-03-18 13:06:53 +00004360 notifications);
4361 ret = ffa_error(FFA_DENIED);
4362 goto out;
4363 }
4364
4365 vm_notifications_update_bindings(
J-Alves661e1b72023-08-02 13:39:40 +01004366 receiver_locked, ffa_is_vm_id(sender_vm_id), id_to_update,
J-Alvesc003a7a2021-03-18 13:06:53 +00004367 notifications, is_per_vcpu && is_bind);
4368
4369out:
4370 vm_unlock(&receiver_locked);
4371 return ret;
4372}
J-Alvesaa79c012021-07-09 14:29:45 +01004373
4374struct ffa_value api_ffa_notification_set(
J-Alves19e20cf2023-08-02 12:48:55 +01004375 ffa_id_t sender_vm_id, ffa_id_t receiver_vm_id, uint32_t flags,
J-Alvesaa79c012021-07-09 14:29:45 +01004376 ffa_notifications_bitmap_t notifications, struct vcpu *current)
4377{
4378 struct ffa_value ret;
4379 struct vm_locked receiver_locked;
J-Alvesaa79c012021-07-09 14:29:45 +01004380 /*
4381 * Check if is per-vCPU or global, and extracting vCPU ID according
4382 * to table 17.19 of the FF-A v1.1 Beta 0 spec.
4383 */
4384 bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
4385 ffa_vcpu_index_t vcpu_id = (uint16_t)(flags >> 16);
J-Alves6b754a12024-02-14 14:26:30 +00004386 const uint32_t flags_mbz =
4387 ~(FFA_NOTIFICATIONS_FLAG_PER_VCPU |
4388 FFA_NOTIFICATIONS_FLAG_DELAY_SRI | (0xFFFFU << 16));
J-Alves41c5da32024-06-19 10:05:05 +01004389 const bool delay_sri = (FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) != 0U;
J-Alves6b754a12024-02-14 14:26:30 +00004390
4391 if ((flags_mbz & flags) != 0U) {
4392 dlog_verbose("%s: caller shouldn't set bits that MBZ.\n",
4393 __func__);
4394 return ffa_error(FFA_INVALID_PARAMETERS);
4395 }
J-Alvesaa79c012021-07-09 14:29:45 +01004396
J-Alves30ac91d2024-02-14 15:33:12 +00004397 /* Global notifications must target any vCPU. */
4398 if (!is_per_vcpu && vcpu_id != 0U) {
4399 dlog_verbose(
4400 "For global notifications vCPU ID MBZ in call to set "
4401 "notifications.\n");
4402 return ffa_error(FFA_INVALID_PARAMETERS);
4403 }
4404
Karl Meakin117c8082024-12-04 16:03:28 +00004405 if (!ffa_notifications_is_set_valid(current, sender_vm_id,
4406 receiver_vm_id)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004407 dlog_verbose("Invalid use of notifications set interface.\n");
4408 return ffa_error(FFA_INVALID_PARAMETERS);
4409 }
4410
4411 if (notifications == 0U) {
4412 dlog_verbose("No notifications have been specified.\n");
4413 return ffa_error(FFA_INVALID_PARAMETERS);
4414 }
4415
J-Alves41c5da32024-06-19 10:05:05 +01004416 /*
4417 * The 'Delay Schedule Receiver interrupt flag' only applies to the
4418 * secure virtual FF-A instance.
4419 */
4420 if (!vm_id_is_current_world(sender_vm_id) && delay_sri) {
4421 dlog_verbose(
4422 "The delay SRI flag can only be set at the secure "
4423 "virtual FF-A instance.\n");
4424 return ffa_error(FFA_INVALID_PARAMETERS);
4425 }
4426
Karl Meakin117c8082024-12-04 16:03:28 +00004427 if (ffa_notifications_set_forward(sender_vm_id, receiver_vm_id, flags,
4428 notifications, &ret)) {
J-Alvesde7bd2f2021-09-09 19:54:35 +01004429 return ret;
4430 }
4431
J-Alvesaa79c012021-07-09 14:29:45 +01004432 /*
4433 * This check assumes receiver is the current VM, and has been enforced
Karl Meakin117c8082024-12-04 16:03:28 +00004434 * by 'ffa_notifications_is_set_valid'.
J-Alvesaa79c012021-07-09 14:29:45 +01004435 */
Karl Meakin117c8082024-12-04 16:03:28 +00004436 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesaa79c012021-07-09 14:29:45 +01004437
4438 if (receiver_locked.vm == NULL) {
4439 dlog_verbose("Receiver ID is not valid.\n");
4440 return ffa_error(FFA_INVALID_PARAMETERS);
4441 }
4442
J-Alves09ff9d82021-11-02 11:55:20 +00004443 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004444 dlog_verbose("Receiver's notifications not enabled.\n");
4445 ret = ffa_error(FFA_DENIED);
4446 goto out;
4447 }
4448
4449 /*
J-Alves89c22132024-02-14 15:44:41 +00004450 * Check the if the notifications are bound as global if per-vCPU flag
4451 * is set, or if they are bound as per-vCPU and caller setting as
4452 * global. In either case, return FFA_INVALID_PARAMETERS.
4453 */
4454 if (vm_notifications_validate_binding(
4455 receiver_locked, ffa_is_vm_id(sender_vm_id), sender_vm_id,
4456 notifications, !is_per_vcpu)) {
Karl Meakine8937d92024-03-19 16:04:25 +00004457 dlog_verbose("Notifications in %lx are %s\n", notifications,
J-Alves89c22132024-02-14 15:44:41 +00004458 !is_per_vcpu ? "global" : "per-vCPU");
4459 ret = ffa_error(FFA_INVALID_PARAMETERS);
4460 goto out;
4461 }
4462
4463 /*
J-Alvesaa79c012021-07-09 14:29:45 +01004464 * If notifications are not bound to the sender, they wouldn't be
4465 * enabled either for the receiver.
4466 */
4467 if (!vm_notifications_validate_binding(
J-Alves661e1b72023-08-02 13:39:40 +01004468 receiver_locked, ffa_is_vm_id(sender_vm_id), sender_vm_id,
4469 notifications, is_per_vcpu)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004470 dlog_verbose("Notifications bindings not valid.\n");
4471 ret = ffa_error(FFA_DENIED);
4472 goto out;
4473 }
4474
4475 if (is_per_vcpu && vcpu_id >= receiver_locked.vm->vcpu_count) {
4476 dlog_verbose("Invalid VCPU ID!\n");
4477 ret = ffa_error(FFA_INVALID_PARAMETERS);
4478 goto out;
4479 }
4480
J-Alves7461ef22021-10-18 17:21:33 +01004481 /* Set notifications pending. */
J-Alves5a16c962022-03-25 12:32:51 +00004482 vm_notifications_partition_set_pending(
J-Alves661e1b72023-08-02 13:39:40 +01004483 receiver_locked, ffa_is_vm_id(sender_vm_id), notifications,
J-Alves5a16c962022-03-25 12:32:51 +00004484 vcpu_id, is_per_vcpu);
4485
Karl Meakine8937d92024-03-19 16:04:25 +00004486 dlog_verbose("Set the notifications: %lx.\n", notifications);
J-Alvesaa79c012021-07-09 14:29:45 +01004487
J-Alves41c5da32024-06-19 10:05:05 +01004488 if (!delay_sri) {
J-Alves13394022021-06-30 13:48:49 +01004489 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
4490 vcpu_index(current));
Karl Meakin117c8082024-12-04 16:03:28 +00004491 ffa_notifications_sri_trigger_not_delayed(current->cpu);
J-Alves13394022021-06-30 13:48:49 +01004492 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004493 ffa_notifications_sri_set_delayed(current->cpu);
J-Alves13394022021-06-30 13:48:49 +01004494 }
J-Alvesaa79c012021-07-09 14:29:45 +01004495
J-Alves13394022021-06-30 13:48:49 +01004496 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
J-Alvesaa79c012021-07-09 14:29:45 +01004497out:
4498 vm_unlock(&receiver_locked);
4499
4500 return ret;
4501}
4502
4503static struct ffa_value api_ffa_notification_get_success_return(
4504 ffa_notifications_bitmap_t from_sp, ffa_notifications_bitmap_t from_vm,
4505 ffa_notifications_bitmap_t from_framework)
4506{
4507 return (struct ffa_value){
4508 .func = FFA_SUCCESS_32,
4509 .arg1 = 0U,
4510 .arg2 = (uint32_t)from_sp,
4511 .arg3 = (uint32_t)(from_sp >> 32),
4512 .arg4 = (uint32_t)from_vm,
4513 .arg5 = (uint32_t)(from_vm >> 32),
4514 .arg6 = (uint32_t)from_framework,
4515 .arg7 = (uint32_t)(from_framework >> 32),
4516 };
4517}
4518
J-Alves19e20cf2023-08-02 12:48:55 +01004519struct ffa_value api_ffa_notification_get(ffa_id_t receiver_vm_id,
J-Alvesaa79c012021-07-09 14:29:45 +01004520 ffa_vcpu_index_t vcpu_id,
4521 uint32_t flags, struct vcpu *current)
4522{
J-Alves663682a2022-03-25 13:56:51 +00004523 ffa_notifications_bitmap_t framework_notifications = 0;
J-Alvesaa79c012021-07-09 14:29:45 +01004524 ffa_notifications_bitmap_t sp_notifications = 0;
4525 ffa_notifications_bitmap_t vm_notifications = 0;
4526 struct vm_locked receiver_locked;
4527 struct ffa_value ret;
J-Alvesfc95a302022-04-22 14:18:23 +01004528 const uint32_t flags_mbz = ~(FFA_NOTIFICATION_FLAG_BITMAP_HYP |
4529 FFA_NOTIFICATION_FLAG_BITMAP_SPM |
4530 FFA_NOTIFICATION_FLAG_BITMAP_SP |
4531 FFA_NOTIFICATION_FLAG_BITMAP_VM);
4532
4533 /* The FF-A v1.1 EAC0 specification states bits [31:4] Must Be Zero. */
4534 if ((flags & flags_mbz) != 0U) {
4535 dlog_verbose(
4536 "Invalid flags bit(s) set in notifications get. [31:4] "
4537 "MBZ(%x)\n",
4538 flags);
4539 return ffa_error(FFA_INVALID_PARAMETERS);
4540 }
J-Alvesaa79c012021-07-09 14:29:45 +01004541
4542 /*
J-Alvesfc95a302022-04-22 14:18:23 +01004543 * Following check should capture wrong uses of the interface,
4544 * depending on whether Hafnium is SPMC or hypervisor. On the
4545 * rest of the function it is assumed this condition is met.
J-Alvesaa79c012021-07-09 14:29:45 +01004546 */
Karl Meakin117c8082024-12-04 16:03:28 +00004547 if (!ffa_notifications_is_get_valid(current, receiver_vm_id, flags)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004548 dlog_verbose("Invalid use of notifications get interface.\n");
4549 return ffa_error(FFA_INVALID_PARAMETERS);
4550 }
4551
4552 /*
4553 * This check assumes receiver is the current VM, and has been enforced
Karl Meakinfa1dcb82025-02-10 16:47:50 +00004554 * by `ffa_notifications_is_get_valid`.
J-Alvesaa79c012021-07-09 14:29:45 +01004555 */
Karl Meakin117c8082024-12-04 16:03:28 +00004556 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesaa79c012021-07-09 14:29:45 +01004557
4558 /*
Karl Meakinfa1dcb82025-02-10 16:47:50 +00004559 * `ffa_notifications_is_get_valid` ensures following is never
J-Alvesaa79c012021-07-09 14:29:45 +01004560 * true.
4561 */
4562 CHECK(receiver_locked.vm != NULL);
4563
J-Alves60458812024-03-22 11:57:10 +00004564 if (receiver_locked.vm->vcpu_count <= vcpu_id) {
J-Alves1abb3342022-01-05 11:59:10 +00004565 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004566 "Invalid VCPU ID %u. vcpu count %u current core: "
4567 "%zu!\n",
J-Alves1abb3342022-01-05 11:59:10 +00004568 vcpu_id, receiver_locked.vm->vcpu_count,
4569 cpu_index(current->cpu));
J-Alvesaa79c012021-07-09 14:29:45 +01004570 ret = ffa_error(FFA_INVALID_PARAMETERS);
4571 goto out;
4572 }
4573
4574 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_SP) != 0U) {
Karl Meakin117c8082024-12-04 16:03:28 +00004575 ret = ffa_notifications_get_from_sp(receiver_locked, vcpu_id,
4576 &sp_notifications);
Karl Meakinf9c73ce2024-07-30 17:37:13 +01004577 if (ret.func == FFA_ERROR_32) {
J-Alves98ff9562021-09-09 14:39:41 +01004578 dlog_verbose("Failed to get notifications from sps.");
4579 goto out;
4580 }
J-Alvesaa79c012021-07-09 14:29:45 +01004581 }
4582
4583 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_VM) != 0U) {
J-Alves5136dda2022-03-25 12:26:38 +00004584 vm_notifications = vm_notifications_partition_get_pending(
J-Alvesaa79c012021-07-09 14:29:45 +01004585 receiver_locked, true, vcpu_id);
4586 }
4587
J-Alvesd605a092022-03-28 14:20:48 +01004588 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_HYP) != 0U ||
4589 (flags & FFA_NOTIFICATION_FLAG_BITMAP_SPM) != 0U) {
Karl Meakin117c8082024-12-04 16:03:28 +00004590 ret = ffa_notifications_get_framework_notifications(
Karl Meakinf9c73ce2024-07-30 17:37:13 +01004591 receiver_locked, &framework_notifications, flags,
4592 vcpu_id);
4593 if (ret.func == FFA_ERROR_32) {
J-Alvesd605a092022-03-28 14:20:48 +01004594 dlog_verbose(
4595 "Failed to get notifications from "
4596 "framework.\n");
4597 goto out;
4598 }
4599 }
4600
J-Alves663682a2022-03-25 13:56:51 +00004601 ret = api_ffa_notification_get_success_return(
4602 sp_notifications, vm_notifications, framework_notifications);
J-Alvesaa79c012021-07-09 14:29:45 +01004603
4604out:
4605 vm_unlock(&receiver_locked);
4606
4607 return ret;
4608}
J-Alvesc8e8a222021-06-08 17:33:52 +01004609
4610/**
4611 * Prepares successful return for FFA_NOTIFICATION_INFO_GET, as described by
4612 * the section 17.7.1 of the FF-A v1.1 Beta0 specification.
4613 */
4614static struct ffa_value api_ffa_notification_info_get_success_return(
4615 const uint16_t *ids, uint32_t ids_count, const uint32_t *lists_sizes,
J-Alvesfe23ebe2021-10-13 16:07:07 +01004616 uint32_t lists_count)
J-Alvesc8e8a222021-06-08 17:33:52 +01004617{
4618 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_64};
4619
4620 /*
4621 * Copying content of ids into ret structure. Use 5 registers (x3-x7) to
4622 * hold the list of ids.
4623 */
4624 memcpy_s(&ret.arg3,
4625 sizeof(ret.arg3) * FFA_NOTIFICATIONS_INFO_GET_REGS_RET, ids,
4626 sizeof(ids[0]) * ids_count);
4627
4628 /*
4629 * According to the spec x2 should have:
4630 * - Bit flagging if there are more notifications pending;
4631 * - The total number of elements (i.e. total list size);
4632 * - The number of VCPU IDs within each VM specific list.
4633 */
J-Alvesfe23ebe2021-10-13 16:07:07 +01004634 ret.arg2 = vm_notifications_pending_not_retrieved_by_scheduler()
4635 ? FFA_NOTIFICATIONS_INFO_GET_FLAG_MORE_PENDING
4636 : 0;
J-Alvesc8e8a222021-06-08 17:33:52 +01004637
4638 ret.arg2 |= (lists_count & FFA_NOTIFICATIONS_LISTS_COUNT_MASK)
4639 << FFA_NOTIFICATIONS_LISTS_COUNT_SHIFT;
4640
4641 for (unsigned int i = 0; i < lists_count; i++) {
4642 ret.arg2 |= (lists_sizes[i] & FFA_NOTIFICATIONS_LIST_SIZE_MASK)
4643 << FFA_NOTIFICATIONS_LIST_SHIFT(i + 1);
4644 }
4645
4646 return ret;
4647}
4648
4649struct ffa_value api_ffa_notification_info_get(struct vcpu *current)
4650{
4651 /*
4652 * Following set of variables should be populated with the return info.
4653 * At a successfull handling of this interface, they should be used
4654 * to populate the 'ret' structure in accordance to the table 17.29
4655 * of the FF-A v1.1 Beta0 specification.
4656 */
4657 uint16_t ids[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS];
4658 uint32_t lists_sizes[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS] = {0};
4659 uint32_t lists_count = 0;
4660 uint32_t ids_count = 0;
4661 bool list_is_full = false;
J-Alves13394022021-06-30 13:48:49 +01004662 struct ffa_value result;
J-Alvesc8e8a222021-06-08 17:33:52 +01004663
4664 /*
4665 * This interface can only be called at NS virtual/physical FF-A
4666 * instance by the endpoint implementing the primary scheduler and the
4667 * Hypervisor/OS kernel.
4668 * In the SPM, following check passes if call has been forwarded from
4669 * the hypervisor.
4670 */
Karl Meakin5e996992024-05-20 11:27:07 +01004671
4672 if (!vm_is_primary(current->vm)) {
J-Alvesc8e8a222021-06-08 17:33:52 +01004673 dlog_verbose(
4674 "Only the receiver's scheduler can use this "
4675 "interface\n");
4676 return ffa_error(FFA_NOT_SUPPORTED);
4677 }
4678
J-Alvesca058c22021-09-10 14:02:07 +01004679 /*
4680 * Forward call to the other world, and fill the arrays used to assemble
4681 * return.
4682 */
Karl Meakin117c8082024-12-04 16:03:28 +00004683 ffa_notifications_info_get_forward(ids, &ids_count, lists_sizes,
4684 &lists_count,
4685 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
J-Alvesca058c22021-09-10 14:02:07 +01004686
4687 list_is_full = ids_count == FFA_NOTIFICATIONS_INFO_GET_MAX_IDS;
4688
J-Alvesc8e8a222021-06-08 17:33:52 +01004689 /* Get notifications' info from this world */
4690 for (ffa_vm_count_t index = 0; index < vm_get_count() && !list_is_full;
4691 ++index) {
4692 struct vm_locked vm_locked = vm_lock(vm_find_index(index));
4693
4694 list_is_full = vm_notifications_info_get(
4695 vm_locked, ids, &ids_count, lists_sizes, &lists_count,
4696 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
4697
4698 vm_unlock(&vm_locked);
4699 }
4700
4701 if (!list_is_full) {
4702 /* Grab notifications info from other world */
Karl Meakin117c8082024-12-04 16:03:28 +00004703 ffa_vm_notifications_info_get(
J-Alvesc8e8a222021-06-08 17:33:52 +01004704 ids, &ids_count, lists_sizes, &lists_count,
4705 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
4706 }
4707
4708 if (ids_count == 0) {
J-Alvesca058c22021-09-10 14:02:07 +01004709 dlog_verbose(
4710 "Notification info get has no data to retrieve.\n");
J-Alves13394022021-06-30 13:48:49 +01004711 result = ffa_error(FFA_NO_DATA);
4712 } else {
4713 result = api_ffa_notification_info_get_success_return(
J-Alvesfe23ebe2021-10-13 16:07:07 +01004714 ids, ids_count, lists_sizes, lists_count);
J-Alvesc8e8a222021-06-08 17:33:52 +01004715 }
4716
J-Alves13394022021-06-30 13:48:49 +01004717 return result;
J-Alvesc8e8a222021-06-08 17:33:52 +01004718}
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004719
Karl Meakin04f86c92025-03-11 15:47:29 +00004720/*
4721 * Calculate the end of the memory range (`base_addr + page_count * PAGE_SIZE`)
4722 * and write the result to `*res`.
4723 * Returns whether any of the intermediate operations overflowed.
4724 */
4725static bool api_memory_range_end(vaddr_t base_addr, uint32_t page_count,
4726 vaddr_t *res)
4727{
4728 uint64_t range_size;
4729 uintvaddr_t end_addr;
4730
4731 if (mul_overflow(page_count, PAGE_SIZE, &range_size)) {
4732 return true;
4733 }
4734
4735 if (add_overflow(va_addr(base_addr), range_size, &end_addr)) {
4736 return true;
4737 }
4738
4739 *res = va_init(end_addr);
4740 return false;
4741}
4742
Karl Meakined91e992025-02-01 16:16:27 +00004743struct ffa_value api_ffa_mem_perm_get(vaddr_t base_addr, uint32_t page_count,
4744 struct vcpu *current)
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004745{
4746 struct vm_locked vm_locked;
Karl Meakincdecdba2025-02-01 15:36:58 +00004747 struct ffa_value ret;
4748 bool mode_ret;
4749 uint32_t mode;
Karl Meakined91e992025-02-01 16:16:27 +00004750 vaddr_t end_addr;
4751
4752 /**
4753 * The size of the memory region is calculated as (page_count + 1) *
4754 * granule size to ensure backwards compatability: v1.2 or earlier
4755 * callers, who leave `arg2` as 0, will get the correct behaviour
4756 * (querying a single page).
Karl Meakin04f86c92025-03-11 15:47:29 +00004757 *
4758 * Any overflow will be caught by the check against zero.
Karl Meakined91e992025-02-01 16:16:27 +00004759 */
4760 page_count += 1;
Karl Meakin04f86c92025-03-11 15:47:29 +00004761
4762 /* Empty ranges should be disallowed, as should ranges that overflow */
4763 if (page_count == 0) {
4764 dlog_error("FFA_MEM_PERM_GET: page_count was zero\n");
4765 return ffa_error(FFA_INVALID_PARAMETERS);
4766 }
4767
4768 if (api_memory_range_end(base_addr, page_count, &end_addr)) {
4769 dlog_error("FFA_MEM_PERM_GET: overflow calculating end_addr\n");
4770 return ffa_error(FFA_INVALID_PARAMETERS);
4771 }
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004772
Karl Meakin117c8082024-12-04 16:03:28 +00004773 if (!ffa_memory_is_mem_perm_get_valid(current)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004774 dlog_error("FFA_MEM_PERM_GET: not allowed\n");
J-Alves5a099172024-02-22 14:34:51 +00004775 return ffa_error(FFA_DENIED);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004776 }
4777
Karl Meakincdecdba2025-02-01 15:36:58 +00004778 if (!is_aligned(va_addr(base_addr), PAGE_SIZE)) {
4779 dlog_error(
4780 "FFA_MEM_PERM_GET: base addr %#016lx is not page "
4781 "aligned\n",
4782 va_addr(base_addr));
4783 return ffa_error(FFA_INVALID_PARAMETERS);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004784 }
4785
4786 vm_locked = vm_lock(current->vm);
4787
4788 /*
Karl Meakin9f568582025-02-20 17:12:32 +00004789 * mm_get_mode_partial is used to check if the given base_addr page is
4790 * already mapped. If the page is unmapped, return error. If the page is
4791 * mapped appropriate attributes are returned to the caller. Note that
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004792 * mm_get_mode returns true if the address is in the valid VA range as
4793 * supported by the architecture and MMU configurations, as opposed to
4794 * whether a page is mapped or not. For a page to be known as mapped,
4795 * the API must return true AND the returned mode must not have
4796 * MM_MODE_INVALID set.
4797 */
Karl Meakin9f568582025-02-20 17:12:32 +00004798 mode_ret = mm_get_mode_partial(&vm_locked.vm->ptable, base_addr,
4799 end_addr, &mode, &end_addr);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004800 if (!mode_ret || (mode & MM_MODE_INVALID)) {
Karl Meakined91e992025-02-01 16:16:27 +00004801 dlog_error(
4802 "FFA_MEM_PERM_GET: cannot find permission for range "
4803 "%#016lx - %#016lx\n",
4804 va_addr(base_addr), va_addr(end_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004805 ret = ffa_error(FFA_INVALID_PARAMETERS);
4806 goto out;
4807 }
Karl Meakin9f568582025-02-20 17:12:32 +00004808 page_count = (va_addr(end_addr) - va_addr(base_addr)) / PAGE_SIZE;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004809
4810 /* No memory should be marked RWX */
4811 CHECK((mode & (MM_MODE_R | MM_MODE_W | MM_MODE_X)) !=
4812 (MM_MODE_R | MM_MODE_W | MM_MODE_X));
4813
4814 /*
4815 * S-EL0 partitions are expected to have all their pages marked as
4816 * non-global.
4817 */
4818 CHECK((mode & (MM_MODE_NG | MM_MODE_USER)) ==
4819 (MM_MODE_NG | MM_MODE_USER));
4820
Karl Meakin80220052025-02-20 14:43:34 +00004821 ret = (struct ffa_value){
4822 .func = FFA_SUCCESS_32,
Karl Meakined91e992025-02-01 16:16:27 +00004823 /* Same logic as for the input page count. */
4824 .arg3 = page_count - 1,
Karl Meakin80220052025-02-20 14:43:34 +00004825 };
Karl Meakincdecdba2025-02-01 15:36:58 +00004826
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004827 if (mode & MM_MODE_W) {
4828 /* No memory should be writeable but not readable. */
4829 CHECK(mode & MM_MODE_R);
Karl Meakin80220052025-02-20 14:43:34 +00004830 ret.arg2 = FFA_MEM_PERM_RW;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004831 } else if (mode & MM_MODE_R) {
Karl Meakin80220052025-02-20 14:43:34 +00004832 ret.arg2 = FFA_MEM_PERM_RX;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004833 if (!(mode & MM_MODE_X)) {
Karl Meakin80220052025-02-20 14:43:34 +00004834 ret.arg2 = FFA_MEM_PERM_RO;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004835 }
4836 }
4837out:
4838 vm_unlock(&vm_locked);
4839 return ret;
4840}
4841
4842struct ffa_value api_ffa_mem_perm_set(vaddr_t base_addr, uint32_t page_count,
Karl Meakin80220052025-02-20 14:43:34 +00004843 enum ffa_mem_perm mem_perm,
4844 struct vcpu *current)
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004845{
4846 struct vm_locked vm_locked;
4847 struct ffa_value ret;
Karl Meakincdecdba2025-02-01 15:36:58 +00004848 bool mode_ret;
Karl Meakin07a69ab2025-02-07 14:53:19 +00004849 mm_mode_t original_mode;
4850 mm_mode_t new_mode;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004851 struct mpool local_page_pool;
Karl Meakin04f86c92025-03-11 15:47:29 +00004852 vaddr_t end_addr;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004853
Karl Meakin117c8082024-12-04 16:03:28 +00004854 if (!ffa_memory_is_mem_perm_set_valid(current)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004855 dlog_error("FFA_MEM_PERM_SET: not allowed\n");
J-Alves5a099172024-02-22 14:34:51 +00004856 return ffa_error(FFA_DENIED);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004857 }
4858
Karl Meakincdecdba2025-02-01 15:36:58 +00004859 if (!current->vm->el0_partition) {
4860 dlog_error("FFA_MEM_PERM_SET: VM %#x is not an EL0 partition\n",
4861 current->vm->id);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004862 return ffa_error(FFA_DENIED);
4863 }
4864
4865 if (!is_aligned(va_addr(base_addr), PAGE_SIZE)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004866 dlog_error(
4867 "FFA_MEM_PERM_SET: base addr %#016lx is not page "
4868 "aligned\n",
4869 va_addr(base_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004870 return ffa_error(FFA_INVALID_PARAMETERS);
4871 }
4872
Karl Meakin04f86c92025-03-11 15:47:29 +00004873 /* Empty ranges should be disallowed, as should ranges that overflow */
4874 if (page_count == 0) {
4875 dlog_error("FFA_MEM_PERM_SET: page_count was zero\n");
4876 return ffa_error(FFA_INVALID_PARAMETERS);
4877 }
4878
4879 if (api_memory_range_end(base_addr, page_count, &end_addr)) {
4880 dlog_error("FFA_MEM_PERM_SET: overflow calculating end_addr\n");
4881 return ffa_error(FFA_INVALID_PARAMETERS);
4882 }
4883
Karl Meakin80220052025-02-20 14:43:34 +00004884 switch (mem_perm) {
4885 case FFA_MEM_PERM_RO:
4886 new_mode = MM_MODE_R | MM_MODE_USER | MM_MODE_NG;
4887 break;
4888 case FFA_MEM_PERM_RW:
4889 new_mode = MM_MODE_R | MM_MODE_W | MM_MODE_USER | MM_MODE_NG;
4890 break;
4891 case FFA_MEM_PERM_RX:
4892 new_mode = MM_MODE_R | MM_MODE_X | MM_MODE_USER | MM_MODE_NG;
4893 break;
4894 default:
Karl Meakincdecdba2025-02-01 15:36:58 +00004895 dlog_error("FFA_MEM_PERM_SET: invalid permissions %#x\n",
4896 mem_perm);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004897 return ffa_error(FFA_INVALID_PARAMETERS);
4898 }
4899
4900 /*
4901 * Create a local pool so any freed memory can't be used by another
4902 * thread. This is to ensure the original mapping can be restored if any
4903 * stage of the process fails.
4904 */
4905 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
4906
4907 vm_locked = vm_lock(current->vm);
4908
4909 /*
4910 * All regions accessible by the partition are mapped during boot. If we
4911 * cannot get a successful translation for the page range, the request
4912 * to change permissions is rejected.
4913 * mm_get_mode is used to check if the given address range is already
4914 * mapped. If the range is unmapped, return error. If the range is
4915 * mapped appropriate attributes are returned to the caller. Note that
4916 * mm_get_mode returns true if the address is in the valid VA range as
4917 * supported by the architecture and MMU configurations, as opposed to
4918 * whether a page is mapped or not. For a page to be known as mapped,
4919 * the API must return true AND the returned mode must not have
4920 * MM_MODE_INVALID set.
4921 */
4922
4923 mode_ret = mm_get_mode(&vm_locked.vm->ptable, base_addr,
4924 va_add(base_addr, page_count * PAGE_SIZE),
4925 &original_mode);
4926 if (!mode_ret || (original_mode & MM_MODE_INVALID)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004927 dlog_error(
4928 "FFA_MEM_PERM_SET: range %#016lx - %#016lx is not "
4929 "mapped\n",
4930 va_addr(base_addr), va_addr(end_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004931 ret = ffa_error(FFA_INVALID_PARAMETERS);
4932 goto out;
4933 }
4934
4935 /* Device memory cannot be marked as executable */
4936 if ((original_mode & MM_MODE_D) && (mem_perm == FFA_MEM_PERM_RX)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004937 dlog_error(
4938 "FFA_MEM_PERM_SET: cannot set device memory as "
4939 "executable\n");
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004940 ret = ffa_error(FFA_INVALID_PARAMETERS);
4941 goto out;
4942 }
4943
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004944 /*
4945 * Safe to re-map memory, since we know the requested permissions are
4946 * valid, and the memory requested to be re-mapped is also valid.
4947 */
Karl Meakincdecdba2025-02-01 15:36:58 +00004948 if (!mm_identity_prepare(&vm_locked.vm->ptable, pa_from_va(base_addr),
4949 pa_from_va(end_addr), new_mode,
4950 &local_page_pool)) {
4951 dlog_error(
4952 "FFA_MEM_PERM_SET: remapping memory range %#016lx - "
4953 "%#016lx failed\n",
4954 va_addr(base_addr), va_addr(end_addr));
4955
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004956 /*
4957 * Defrag the table into the local page pool.
4958 * mm_identity_prepare could have allocated or freed pages to
4959 * split blocks or tables etc.
4960 */
4961 mm_stage1_defrag(&vm_locked.vm->ptable, &local_page_pool);
4962
4963 /*
4964 * Guaranteed to succeed mapping with old mode since the mapping
4965 * with old mode already existed and we have a local page pool
4966 * that should have sufficient memory to go back to the original
4967 * state.
4968 */
4969 CHECK(mm_identity_prepare(
4970 &vm_locked.vm->ptable, pa_from_va(base_addr),
Karl Meakincdecdba2025-02-01 15:36:58 +00004971 pa_from_va(end_addr), original_mode, &local_page_pool));
4972 mm_identity_commit(&vm_locked.vm->ptable, pa_from_va(base_addr),
4973 pa_from_va(end_addr), original_mode,
4974 &local_page_pool);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004975
4976 mm_stage1_defrag(&vm_locked.vm->ptable, &api_page_pool);
4977 ret = ffa_error(FFA_NO_MEMORY);
4978 goto out;
4979 }
4980
Karl Meakincdecdba2025-02-01 15:36:58 +00004981 mm_identity_commit(&vm_locked.vm->ptable, pa_from_va(base_addr),
4982 pa_from_va(end_addr), new_mode, &local_page_pool);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004983
4984 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
4985
4986out:
4987 mpool_fini(&local_page_pool);
4988 vm_unlock(&vm_locked);
4989
4990 return ret;
4991}
Maksims Svecovs71b76702022-05-20 15:32:58 +01004992
4993/**
Karl Meakinc5cebbc2024-06-17 11:30:27 +01004994 * Send the contents of the given vCPU's log buffer to the log, preceded
Karl Meakin705b56e2024-05-22 10:04:32 +01004995 * by the VM ID and followed by a newline.
4996 */
Karl Meakin6f1f1212024-07-16 10:18:16 +01004997void api_flush_log_buffer(struct vcpu_locked *vcpu_locked)
Karl Meakin705b56e2024-05-22 10:04:32 +01004998{
Karl Meakin6f1f1212024-07-16 10:18:16 +01004999 /*
5000 * NOTE: This line is parsed by `hftest.py`.
5001 * If you change the format, make sure to update
5002 * `HFTEST_CTRL_JSON_REGEX` as well.
5003 */
5004 struct vcpu *vcpu = vcpu_locked->vcpu;
5005 struct log_buffer *buffer = &vcpu->log_buffer;
5006 ffa_id_t vm_id = vcpu->vm->id;
5007 ffa_id_t vcpu_id = vcpu_index(vcpu);
5008
Karl Meakin7de26952024-06-14 14:50:19 +01005009 buffer->chars[buffer->len] = '\0';
Olivier Deprezbd432092024-07-26 14:01:12 +02005010 dlog("[%x %u] %s\n", vm_id, vcpu_id, buffer->chars);
Karl Meakin7de26952024-06-14 14:50:19 +01005011 buffer->len = 0;
Karl Meakin705b56e2024-05-22 10:04:32 +01005012}
5013
5014/**
Karl Meakin740f74f2024-02-14 18:04:48 +00005015 * Implements FF-A v1.2 FFA_CONSOLE_LOG ABI for buffered logging.
Maksims Svecovs71b76702022-05-20 15:32:58 +01005016 */
5017struct ffa_value api_ffa_console_log(const struct ffa_value args,
5018 struct vcpu *current)
5019{
Karl Meakin740f74f2024-02-14 18:04:48 +00005020 /* Maximum number of characters is 128: 16 registers of 8 bytes each. */
5021 char chars[128] = {0};
Karl Meakin0e617d92024-04-05 12:55:22 +01005022 const bool v1_2 = current->vm->ffa_version >= FFA_VERSION_1_2;
Karl Meakin740f74f2024-02-14 18:04:48 +00005023 const bool log32 = args.func == FFA_CONSOLE_LOG_32;
Maksims Svecovs71b76702022-05-20 15:32:58 +01005024
Karl Meakin740f74f2024-02-14 18:04:48 +00005025 /*
5026 * 32bit: always 6 registers
5027 * 64bit and less than v1.2: 6 registers
5028 * 64bit and v1.2 or greater: 16 registers
5029 */
Karl Meakin66a38bd2024-05-28 16:00:56 +01005030 /* NOLINTNEXTLINE(readability-avoid-nested-conditional-operator) */
Karl Meakin740f74f2024-02-14 18:04:48 +00005031 const size_t registers_max = log32 ? 6 : (v1_2 ? 16 : 6);
5032 const size_t chars_max =
5033 registers_max * (log32 ? sizeof(uint32_t) : sizeof(uint64_t));
5034 const size_t chars_count = args.arg1;
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005035 struct vcpu_locked vcpu_locked;
5036 struct log_buffer *log_buffer;
Karl Meakin740f74f2024-02-14 18:04:48 +00005037
5038 assert(args.func == FFA_CONSOLE_LOG_32 ||
5039 args.func == FFA_CONSOLE_LOG_64);
5040
5041 if (chars_count == 0 || chars_count > chars_max) {
Maksims Svecovs71b76702022-05-20 15:32:58 +01005042 return ffa_error(FFA_INVALID_PARAMETERS);
5043 }
5044
Karl Meakin740f74f2024-02-14 18:04:48 +00005045 if (log32) {
5046 uint32_t *registers = (uint32_t *)chars;
Maksims Svecovs71b76702022-05-20 15:32:58 +01005047
Karl Meakin740f74f2024-02-14 18:04:48 +00005048 registers[0] = args.arg2 & 0xffffffff;
5049 registers[1] = args.arg3 & 0xffffffff;
5050 registers[2] = args.arg4 & 0xffffffff;
5051 registers[3] = args.arg5 & 0xffffffff;
5052 registers[4] = args.arg6 & 0xffffffff;
5053 registers[5] = args.arg7 & 0xffffffff;
5054 } else {
5055 uint64_t *registers = (uint64_t *)chars;
5056
5057 registers[0] = args.arg2;
5058 registers[1] = args.arg3;
5059 registers[2] = args.arg4;
5060 registers[3] = args.arg5;
5061 registers[4] = args.arg6;
5062 registers[5] = args.arg7;
5063 if (v1_2) {
5064 registers[6] = args.extended_val.arg8;
5065 registers[7] = args.extended_val.arg9;
5066 registers[8] = args.extended_val.arg10;
5067 registers[9] = args.extended_val.arg11;
5068 registers[10] = args.extended_val.arg12;
5069 registers[11] = args.extended_val.arg13;
5070 registers[12] = args.extended_val.arg14;
5071 registers[13] = args.extended_val.arg15;
5072 registers[14] = args.extended_val.arg16;
5073 registers[15] = args.extended_val.arg17;
5074 }
5075 }
5076
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005077 vcpu_locked = vcpu_lock(current);
5078 log_buffer = &current->log_buffer;
Karl Meakin7de26952024-06-14 14:50:19 +01005079
Karl Meakin740f74f2024-02-14 18:04:48 +00005080 for (size_t i = 0; i < chars_count; i++) {
5081 bool flush = false;
5082 const char c = chars[i];
5083
5084 if (c == '\n' || c == '\0') {
5085 flush = true;
5086 } else {
J-Alves33b52f82025-03-21 10:55:31 +00005087 log_buffer->chars[log_buffer->len] = c;
5088 log_buffer->len++;
5089 assert(log_buffer->len <= LOG_BUFFER_SIZE);
Karl Meakin7de26952024-06-14 14:50:19 +01005090 flush = log_buffer->len == LOG_BUFFER_SIZE;
Karl Meakin740f74f2024-02-14 18:04:48 +00005091 }
5092
5093 if (flush) {
Karl Meakin6f1f1212024-07-16 10:18:16 +01005094 api_flush_log_buffer(&vcpu_locked);
Karl Meakin740f74f2024-02-14 18:04:48 +00005095 }
5096 }
Maksims Svecovs71b76702022-05-20 15:32:58 +01005097
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005098 vcpu_unlock(&vcpu_locked);
Maksims Svecovs71b76702022-05-20 15:32:58 +01005099 return (struct ffa_value){.func = FFA_SUCCESS_32};
5100}
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005101
5102/**
5103 * Send an IPI interrupt to a target vcpu belonging to the
5104 * sender that isn't itself.
5105 */
Daniel Boulby84d49b62024-11-04 18:25:59 +00005106int64_t api_hf_interrupt_send_ipi(uint32_t target_vcpu_id, struct vcpu *current)
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005107{
5108 struct vm *vm = current->vm;
5109 ffa_vcpu_index_t target_vcpu_index = vcpu_id_to_index(target_vcpu_id);
5110
J-Alves5dbf9322025-02-21 13:02:02 +00005111 if (target_vcpu_index >= vm->vcpu_count) {
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005112 dlog_verbose("Invalid vCPU %d for IPI.\n", target_vcpu_id);
5113 return -1;
5114 }
5115
5116 dlog_verbose("Injecting IPI to target vCPU%d for %#x\n", target_vcpu_id,
5117 vm->id);
5118
J-Alves5dbf9322025-02-21 13:02:02 +00005119 /*
5120 * If the SP is targeting the current vCPU, inject the IPI VI,
5121 * to avoid trapping into Hafnium.
5122 */
5123 if (target_vcpu_index == cpu_index(current->cpu)) {
5124 struct vcpu_locked current_locked = vcpu_lock(current);
5125
5126 vcpu_virt_interrupt_inject(current_locked, HF_IPI_INTID);
5127
5128 vcpu_unlock(&current_locked);
5129 } else {
5130 hf_ipi_send_interrupt(vm, target_vcpu_index);
5131 }
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005132
5133 return 0;
5134}