blob: ccc72d7438556cc044fa2018c237726b8d4b2a1f [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
Madhukar Pappireddy6cb80be2025-06-02 16:10:51 -0500553 if (!vm_is_discoverable(vm)) {
554 continue;
555 }
556
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100557 for (size_t uuid_idx = 0; uuid_idx < PARTITION_MAX_UUIDS;
558 uuid_idx++) {
559 struct ffa_uuid uuid = vm->uuids[uuid_idx];
560 struct ffa_partition_info *out_partition =
J-Alves90d30d02025-05-09 16:04:48 +0100561 &out_partitions[*entries_count];
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100562
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400563 /*
564 * Null UUID indicates reaching the end of a
565 * partition's array of UUIDs.
566 */
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100567 if (ffa_uuid_is_null(&uuid)) {
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400568 break;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800569 }
570
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100571 if (match_any || ffa_uuid_equal(uuid_to_find, &uuid)) {
J-Alves90d30d02025-05-09 16:04:48 +0100572 /*
573 * If the number of entries surpasses the size
574 * of `out_partitions`
575 */
J-Alves9decd782025-05-16 11:59:30 +0100576 if (*entries_count >= out_partitions_len) {
J-Alves90d30d02025-05-09 16:04:48 +0100577 return false;
578 }
579
580 (*entries_count)++;
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100581
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400582 if (count_flag) {
583 continue;
584 }
585
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100586 api_ffa_fill_partition_info(out_partition, vm,
J-Alves7fb0fdb2024-10-09 11:28:07 +0100587 caller_id);
J-Alves9decd782025-05-16 11:59:30 +0100588 /*
589 * If the ABI has specified an UUID, then do not
590 * write it
591 */
Karl Meakinfb9c2a22024-08-19 14:29:37 +0100592 if (match_any) {
593 out_partition->uuid = uuid;
J-Alves9decd782025-05-16 11:59:30 +0100594 } else {
595 out_partition->uuid =
596 (struct ffa_uuid){0};
Kathleen Capellaa1de3c52023-08-28 20:10:02 -0400597 }
Daniel Boulby48546b12025-01-08 18:22:13 +0000598
599 /*
600 * Multiple UUIDs for a partition was only
601 * introduced in FF-A v1.2, so for any version
602 * less than v1.2 return only one UUID per
603 * partition.
604 */
605 if (caller_version < FFA_VERSION_1_2) {
606 break;
607 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800608 }
609 }
610 }
611
J-Alves90d30d02025-05-09 16:04:48 +0100612 return true;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800613}
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800614
615static inline void api_ffa_pack_vmid_count_props(
J-Alves19e20cf2023-08-02 12:48:55 +0100616 uint64_t *xn, ffa_id_t vm_id, ffa_vcpu_count_t vcpu_count,
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800617 ffa_partition_properties_t properties)
618{
619 *xn = (uint64_t)vm_id;
620 *xn |= (uint64_t)vcpu_count << 16;
621 *xn |= (uint64_t)properties << 32;
622}
623
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700624/**
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700625 * This function forwards the FFA_PARTITION_INFO_GET_REGS ABI to the other world
626 * when hafnium is the hypervisor to determine the secure partitions. When
627 * hafnium is the SPMC, this function forwards the call to the SPMD to discover
628 * SPMD logical partitions. The function returns true when partition information
629 * is filled in the partitions array and false if there are errors. Note that
630 * the SPMD and SPMC may return an FF-A error code of FFA_NOT_SUPPORTED when
631 * there are no SPMD logical partitions or no secure partitions respectively,
632 * and this is not considered a failure of the forwarded call. A caller is
633 * expected to check the return value before consuming the information in the
634 * partitions array passed in and ret_count.
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700635 */
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700636static bool api_ffa_partition_info_get_regs_forward(
637 const struct ffa_uuid *uuid, const uint16_t tag,
638 struct ffa_partition_info *partitions, uint16_t partitions_len,
J-Alves90d30d02025-05-09 16:04:48 +0100639 size_t *ret_count)
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700640{
641 (void)tag;
642 struct ffa_value ret;
643 uint16_t last_index = UINT16_MAX;
644 uint16_t curr_index = 0;
645 uint16_t start_index = 0;
646
Karl Meakin117c8082024-12-04 16:03:28 +0000647 if (!ffa_setup_partition_info_get_regs_forward_allowed()) {
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700648 return true;
649 }
650
651 while (start_index <= last_index) {
652 ret = ffa_partition_info_get_regs(uuid, start_index, 0);
653 if (ffa_func_id(ret) != FFA_SUCCESS_64) {
654 /*
655 * If there are no logical partitions, SPMD returns
656 * NOT_SUPPORTED, that is not an error. If there are no
657 * secure partitions the SPMC returns NOT_SUPPORTED.
658 */
Karl Meakind0123af2025-03-17 16:46:38 +0000659 return (ffa_func_id(ret) == FFA_ERROR_32) &&
660 (ffa_error_code(ret) == FFA_NOT_SUPPORTED);
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700661 }
662
663 if (!api_ffa_fill_partition_info_from_regs(
664 ret, start_index, partitions, partitions_len,
665 ret_count)) {
666 return false;
667 }
668
669 last_index = ffa_partition_info_regs_get_last_idx(ret);
670 curr_index = ffa_partition_info_regs_get_curr_idx(ret);
671 start_index = curr_index + 1;
672 }
673 return true;
674}
675
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700676bool api_ffa_fill_partition_info_from_regs(
677 struct ffa_value ret, uint16_t start_index,
J-Alves90d30d02025-05-09 16:04:48 +0100678 struct ffa_partition_info *partitions, size_t partitions_max_len,
679 size_t *ret_count)
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700680{
J-Alves90d30d02025-05-09 16:04:48 +0100681 size_t entries_count = *ret_count;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700682 uint16_t curr_index = 0;
683 uint8_t num_entries = 0;
684 uint8_t idx = 0;
685 /* List of pointers to args in return value. */
686 uint64_t *arg_ptrs[] = {
687 &ret.arg3,
688 &ret.arg4,
689 &ret.arg5,
690 &ret.arg6,
691 &ret.arg7,
692 &ret.extended_val.arg8,
693 &ret.extended_val.arg9,
694 &ret.extended_val.arg10,
695 &ret.extended_val.arg11,
696 &ret.extended_val.arg12,
697 &ret.extended_val.arg13,
698 &ret.extended_val.arg14,
699 &ret.extended_val.arg15,
700 &ret.extended_val.arg16,
701 &ret.extended_val.arg17,
702 };
703
J-Alves90d30d02025-05-09 16:04:48 +0100704 if (entries_count > partitions_max_len) {
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700705 return false;
706 }
707
708 /*
709 * Tags are currently unused in the implementation. Expect it to be
710 * zero since the implementation does not provide a tag when calling
711 * the FFA_PARTITION_INFO_GET_REGS ABI.
712 */
713 assert(ffa_partition_info_regs_get_tag(ret) == 0);
714
715 /*
716 * Hafnium expects the size of the returned descriptor to be equal to
717 * the size of the structure in the FF-A 1.1 specification. When future
718 * enhancements are made, this assert can be relaxed.
719 */
720 assert(ffa_partition_info_regs_get_desc_size(ret) ==
721 sizeof(struct ffa_partition_info));
722
723 curr_index = ffa_partition_info_regs_get_curr_idx(ret);
724
725 /* FF-A 1.2 ALP0, section 14.9.2 Usage rule 7. */
726 assert(start_index <= curr_index);
727
728 num_entries = curr_index - start_index + 1;
J-Alves90d30d02025-05-09 16:04:48 +0100729 if (num_entries > (partitions_max_len - entries_count) ||
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700730 num_entries > MAX_INFO_REGS_ENTRIES_PER_CALL) {
731 return false;
732 }
733
734 while (num_entries) {
735 uint64_t info = *(arg_ptrs[(ptrdiff_t)(idx++)]);
736 uint64_t uuid_lo = *(arg_ptrs[(ptrdiff_t)(idx++)]);
737 uint64_t uuid_high = *(arg_ptrs[(ptrdiff_t)(idx++)]);
738
J-Alves90d30d02025-05-09 16:04:48 +0100739 partitions[entries_count].vm_id = info & 0xFFFF;
740 partitions[entries_count].vcpu_count = (info >> 16) & 0xFFFF;
741 partitions[entries_count].properties = (info >> 32);
742 partitions[entries_count].uuid.uuid[0] = uuid_lo & 0xFFFFFFFF;
743 partitions[entries_count].uuid.uuid[1] =
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700744 (uuid_lo >> 32) & 0xFFFFFFFF;
J-Alves90d30d02025-05-09 16:04:48 +0100745 partitions[entries_count].uuid.uuid[2] = uuid_high & 0xFFFFFFFF;
746 partitions[entries_count].uuid.uuid[3] =
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700747 (uuid_high >> 32) & 0xFFFFFFFF;
J-Alves90d30d02025-05-09 16:04:48 +0100748 entries_count++;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700749 num_entries--;
750 }
751
J-Alves90d30d02025-05-09 16:04:48 +0100752 *ret_count = entries_count;
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700753 return true;
754}
755
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800756struct ffa_value api_ffa_partition_info_get_regs(struct vcpu *current,
757 const struct ffa_uuid *uuid,
758 const uint16_t start_index,
759 const uint16_t tag)
760{
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800761 struct vm *current_vm = current->vm;
J-Alves90d30d02025-05-09 16:04:48 +0100762 struct ffa_partition_info *partitions;
763 size_t buffer_size;
764 size_t partitions_max_len;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800765 bool uuid_is_null = ffa_uuid_is_null(uuid);
J-Alves90d30d02025-05-09 16:04:48 +0100766 size_t entries_count = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800767 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
768 uint16_t max_idx = 0;
769 uint16_t curr_idx = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800770 uint8_t num_entries_to_ret = 0;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800771 uint8_t arg_idx = 3;
772
J-Alves90d30d02025-05-09 16:04:48 +0100773 /* List of pointers to args in return value. */
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800774 uint64_t *arg_ptrs[] = {
775 &(ret).func,
776 &(ret).arg1,
777 &(ret).arg2,
778 &(ret).arg3,
779 &(ret).arg4,
780 &(ret).arg5,
781 &(ret).arg6,
782 &(ret).arg7,
783 &(ret).extended_val.arg8,
784 &(ret).extended_val.arg9,
785 &(ret).extended_val.arg10,
786 &(ret).extended_val.arg11,
787 &(ret).extended_val.arg12,
788 &(ret).extended_val.arg13,
789 &(ret).extended_val.arg14,
790 &(ret).extended_val.arg15,
791 &(ret).extended_val.arg16,
792 &(ret).extended_val.arg17,
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800793 };
794
J-Alves90d30d02025-05-09 16:04:48 +0100795 /* Use CPU buffer to temporarily save the descriptor. */
796 partitions = (struct ffa_partition_info *)cpu_get_buffer(current->cpu);
797
798 buffer_size = cpu_get_buffer_size(current->cpu);
799
800 /* Expect size to match that of the mailbox. */
801 assert(buffer_size == PAGE_SIZE);
802 assert(partitions != NULL);
803
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800804 /* TODO: Add support for using tags */
805 if (tag != 0) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800806 dlog_error("Tag not 0. Unsupported tag. %d\n", tag);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800807 return ffa_error(FFA_RETRY);
808 }
809
J-Alves90d30d02025-05-09 16:04:48 +0100810 partitions_max_len = buffer_size / sizeof(struct ffa_partition_info);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800811
J-Alves90d30d02025-05-09 16:04:48 +0100812 if (!api_ffa_fill_partitions_info_array(
813 partitions, partitions_max_len, uuid, false, current_vm->id,
814 current_vm->ffa_version, &entries_count)) {
815 dlog_verbose(
816 "%s: No memory to hold all partition information.\n",
817 __func__);
818 return ffa_error(FFA_NO_MEMORY);
819 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800820
J-Alves90d30d02025-05-09 16:04:48 +0100821 /* If UUID is Null entries_count must not be zero at this stage. */
822 CHECK(!uuid_is_null || entries_count != 0);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800823
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800824 /*
825 * When running the Hypervisor:
826 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
827 * it to fill with secure partitions information.
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700828 * When running the SPMC, the SPMC forwards the call to the SPMD to
829 * discover any EL3 SPMD logical partitions, if the call came from an
830 * SP. Otherwise, the call is not forwarded.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800831 * TODO: Note that for this ABI, forwarding on every invocation when
832 * uuid is Null is inefficient,and if performance becomes a problem,
833 * this would be a good place to optimize using strategies such as
834 * caching info etc. For now, assuming this inefficiency is not a major
835 * issue.
J-Alves90d30d02025-05-09 16:04:48 +0100836 * - If UUID is non-Null entries_count may be zero because the UUID
837 * matches a secure partition and the query is forwarded to the SPMC.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800838 * When running the SPMC:
J-Alves90d30d02025-05-09 16:04:48 +0100839 * - If UUID is non-Null and entries_count is zero it means there is no
840 * such partition identified in the system.
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800841 */
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700842 if (vm_id_is_current_world(current_vm->id)) {
Raghu Krishnamurthye74d6532023-06-07 12:21:54 -0700843 if (!api_ffa_partition_info_get_regs_forward(
J-Alves90d30d02025-05-09 16:04:48 +0100844 uuid, tag, partitions, partitions_max_len,
845 &entries_count)) {
Raghu Krishnamurthy2d2b0f42023-04-23 09:54:45 -0700846 dlog_error(
847 "Failed to forward "
848 "ffa_partition_info_get_regs.\n");
849 return ffa_error(FFA_DENIED);
850 }
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800851 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800852
853 /*
854 * Unrecognized UUID: does not match any of the VMs (or SPs)
855 * and is not Null.
856 */
J-Alves90d30d02025-05-09 16:04:48 +0100857 if (entries_count == 0 || entries_count > partitions_max_len) {
Olivier Deprez89da0a42023-09-01 17:38:33 +0200858 dlog_verbose(
J-Alves90d30d02025-05-09 16:04:48 +0100859 "Invalid parameters. entries_count = %zu (must not be "
860 "zero or > %lu)\n",
861 entries_count, partitions_max_len);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800862 return ffa_error(FFA_INVALID_PARAMETERS);
863 }
864
J-Alves90d30d02025-05-09 16:04:48 +0100865 if (start_index >= entries_count) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800866 dlog_error(
J-Alves90d30d02025-05-09 16:04:48 +0100867 "start index = %d entries_count = %zu (start_index "
868 "must "
869 "be "
870 "less than entries_count)\n",
871 start_index, entries_count);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800872 return ffa_error(FFA_INVALID_PARAMETERS);
873 }
874
J-Alves90d30d02025-05-09 16:04:48 +0100875 max_idx = entries_count - 1;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800876 num_entries_to_ret = (max_idx - start_index) + 1;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800877 num_entries_to_ret =
878 MIN(num_entries_to_ret, MAX_INFO_REGS_ENTRIES_PER_CALL);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800879 curr_idx = start_index + num_entries_to_ret - 1;
880 assert(curr_idx <= max_idx);
881
882 ret.func = FFA_SUCCESS_64;
883 ret.arg2 = (sizeof(struct ffa_partition_info) & 0xFFFF) << 48;
J-Alves296c9012025-03-20 19:59:36 +0000884 ret.arg2 |= ((uint64_t)curr_idx) << 16;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800885 ret.arg2 |= max_idx;
886
887 if (num_entries_to_ret > 1) {
888 ret.extended_val.valid = 1;
889 }
890
891 for (uint16_t idx = start_index; idx <= curr_idx; ++idx) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800892 uint64_t *xn_0 = arg_ptrs[arg_idx++];
893 uint64_t *xn_1 = arg_ptrs[arg_idx++];
894 uint64_t *xn_2 = arg_ptrs[arg_idx++];
895
896 api_ffa_pack_vmid_count_props(xn_0, partitions[idx].vm_id,
897 partitions[idx].vcpu_count,
898 partitions[idx].properties);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800899 if (uuid_is_null) {
Karl Meakin9478e322024-09-23 17:47:09 +0100900 ffa_uuid_to_u64x2(xn_1, xn_2, &partitions[idx].uuid);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800901 }
Raghu Krishnamurthycded31b2023-04-23 15:07:35 -0700902 assert(arg_idx <= ARRAY_SIZE(arg_ptrs));
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800903 }
904
905 return ret;
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800906}
907
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100908struct ffa_value api_ffa_partition_info_get(struct vcpu *current,
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000909 const struct ffa_uuid *uuid,
910 const uint32_t flags)
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100911{
912 struct vm *current_vm = current->vm;
J-Alves90d30d02025-05-09 16:04:48 +0100913 size_t entries_count = 0;
Olivier Deprez013f4d62022-11-21 15:46:20 +0100914 bool count_flag = (flags & FFA_PARTITION_COUNT_FLAG_MASK) ==
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000915 FFA_PARTITION_COUNT_FLAG;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100916 bool uuid_is_null = ffa_uuid_is_null(uuid);
J-Alves90d30d02025-05-09 16:04:48 +0100917 struct ffa_partition_info *partitions;
918 size_t buffer_size;
919 size_t partitions_max_len;
Daniel Boulby191b5f02022-02-17 17:26:14 +0000920 struct vm_locked vm_locked;
921 struct ffa_value ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100922
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000923 /* Bits 31:1 Must Be Zero */
Olivier Deprez013f4d62022-11-21 15:46:20 +0100924 if ((flags & ~FFA_PARTITION_COUNT_FLAG_MASK) != 0) {
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000925 return ffa_error(FFA_INVALID_PARAMETERS);
926 }
927
J-Alves90d30d02025-05-09 16:04:48 +0100928 /* Use CPU buffer to temporarily save the descriptor. */
929 partitions = (struct ffa_partition_info *)cpu_get_buffer(current->cpu);
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100930
J-Alves90d30d02025-05-09 16:04:48 +0100931 buffer_size = cpu_get_buffer_size(current->cpu);
932
933 /* Expect size to match that of the mailbox. */
934 assert(buffer_size == PAGE_SIZE);
935 assert(partitions != NULL);
936
937 partitions_max_len = buffer_size / sizeof(struct ffa_partition_info);
938
939 if (!api_ffa_fill_partitions_info_array(
940 partitions, partitions_max_len, uuid, count_flag,
941 current_vm->id, current_vm->ffa_version, &entries_count)) {
942 dlog_verbose(
943 "%s: No memory to hold all partition information.\n",
944 __func__);
945 return ffa_error(FFA_NO_MEMORY);
946 }
947
948 /* If UUID is Null entries_count must not be zero at this stage. */
949 CHECK(!uuid_is_null || entries_count != 0);
Olivier Depreze562e542020-06-11 17:31:54 +0200950
951 /*
952 * When running the Hypervisor:
953 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
954 * it to fill with secure partitions information.
J-Alves90d30d02025-05-09 16:04:48 +0100955 * - If UUID is non-Null entries_count may be zero because the UUID
956 * matches a secure partition and the query is forwarded to the SPMC.
957 * - If the Partitions returned from this call can't fit in the
958 * partitions buffer, this call will only return information from VMs.
959 *
Olivier Depreze562e542020-06-11 17:31:54 +0200960 * When running the SPMC:
J-Alves90d30d02025-05-09 16:04:48 +0100961 * - If UUID is non-Null and entries_count is zero it means there is no
962 * such partition identified in the system.
Olivier Depreze562e542020-06-11 17:31:54 +0200963 */
J-Alves90d30d02025-05-09 16:04:48 +0100964 entries_count = ffa_setup_partition_info_get_forward(
965 uuid, flags, partitions, partitions_max_len, entries_count);
Olivier Depreze562e542020-06-11 17:31:54 +0200966
967 /*
968 * Unrecognized UUID: does not match any of the VMs (or SPs)
969 * and is not Null.
970 */
J-Alves90d30d02025-05-09 16:04:48 +0100971 if (entries_count == 0) {
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100972 return ffa_error(FFA_INVALID_PARAMETERS);
973 }
974
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000975 /*
976 * If the count flag is set we don't need to return the partition info
977 * descriptors.
978 */
979 if (count_flag) {
980 return (struct ffa_value){.func = FFA_SUCCESS_32,
J-Alves90d30d02025-05-09 16:04:48 +0100981 .arg2 = entries_count};
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000982 }
983
Daniel Boulby191b5f02022-02-17 17:26:14 +0000984 vm_locked = vm_lock(current_vm);
985 ret = send_versioned_partition_info_descriptors(vm_locked, partitions,
J-Alves90d30d02025-05-09 16:04:48 +0100986 entries_count);
Daniel Boulby191b5f02022-02-17 17:26:14 +0000987 vm_unlock(&vm_locked);
988 return ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100989}
990
Andrew Scull9726c252019-01-23 13:44:19 +0000991/**
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000992 * Returns the ID of the VM.
993 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100994struct ffa_value api_ffa_id_get(const struct vcpu *current)
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000995{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100996 return (struct ffa_value){.func = FFA_SUCCESS_32,
997 .arg2 = current->vm->id};
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000998}
999
1000/**
Olivier Deprez421677d2021-06-18 12:18:53 +02001001 * Returns the SPMC FF-A ID at NS virtual/physical and secure virtual
1002 * FF-A instances.
1003 * DEN0077A FF-A v1.1 Beta0 section 13.9 FFA_SPM_ID_GET.
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00001004 */
1005struct ffa_value api_ffa_spm_id_get(void)
1006{
Karl Meakin0e617d92024-04-05 12:55:22 +01001007 if (FFA_VERSION_1_1 <= FFA_VERSION_COMPILED) {
1008 /*
1009 * Return the SPMC ID that was fetched during FF-A
1010 * initialization.
1011 */
1012 return (struct ffa_value){.func = FFA_SUCCESS_32,
1013 .arg2 = arch_ffa_spmc_id_get()};
1014 }
1015
J-Alves3829fc02021-03-18 12:49:18 +00001016 return ffa_error(FFA_NOT_SUPPORTED);
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00001017}
1018
1019/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001020 * This function is called by the architecture-specific context switching
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001021 * function to indicate that register state for the given vCPU has been saved
1022 * and can therefore be used by other pCPUs.
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001023 */
1024void api_regs_state_saved(struct vcpu *vcpu)
1025{
1026 sl_lock(&vcpu->lock);
1027 vcpu->regs_available = true;
1028 sl_unlock(&vcpu->lock);
1029}
J-Alves0ffce752024-10-09 14:37:10 +01001030
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001031/**
J-Alves2ced1672022-12-12 14:35:38 +00001032 * Constructs the return value from a successful FFA_MSG_WAIT call, when used
1033 * with FFA_MSG_SEND_32.
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001034 */
J-Alves27b71962022-12-12 15:29:58 +00001035struct ffa_value ffa_msg_recv_return(const struct vm *receiver)
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001036{
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001037 switch (receiver->mailbox.recv_func) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001038 case FFA_MSG_SEND_32:
1039 return (struct ffa_value){
1040 .func = FFA_MSG_SEND_32,
J-Alves296c9012025-03-20 19:59:36 +00001041 .arg1 = ((uint64_t)(receiver->mailbox.recv_sender)
1042 << 16) |
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001043 receiver->id,
1044 .arg3 = receiver->mailbox.recv_size};
J-Alvesd9e7c8f2024-09-11 13:37:25 +01001045 default:
Federico Recanati25053ee2022-03-14 15:01:53 +01001046 return (struct ffa_value){
1047 .func = FFA_RUN_32,
1048 /*
1049 * TODO: FFA_RUN should return vCPU and VM ID in arg1.
1050 * Retrieving vCPU requires a rework of the function,
1051 * while receiver ID must be set because it's checked by
1052 * other APIs (eg: FFA_NOTIFICATION_GET).
1053 */
1054 .arg1 = receiver->id};
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001055 }
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001056}
1057
J-Alvese8c8c2b2022-12-16 15:34:48 +00001058/**
1059 * Change the state of mailbox to empty, such that the ownership is given to the
1060 * Partition manager.
Karl Meakin1064a9c2024-06-04 17:20:43 +01001061 * Returns FFA_SUCCESS if the mailbox was reset successfully, FFA_ERROR
1062 * otherwise.
J-Alvese8c8c2b2022-12-16 15:34:48 +00001063 */
Karl Meakin1064a9c2024-06-04 17:20:43 +01001064static struct ffa_value api_release_mailbox(struct vm_locked vm_locked)
J-Alvese8c8c2b2022-12-16 15:34:48 +00001065{
Karl Meakin1064a9c2024-06-04 17:20:43 +01001066 struct ffa_value ret = {.func = FFA_SUCCESS_32};
J-Alves19e20cf2023-08-02 12:48:55 +01001067 ffa_id_t vm_id = vm_locked.vm->id;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001068
1069 switch (vm_locked.vm->mailbox.state) {
1070 case MAILBOX_STATE_EMPTY:
1071 dlog_verbose("Mailbox of %x is empty.\n", vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001072 ret = ffa_error(FFA_DENIED);
J-Alves31f8bef2023-07-14 12:46:28 +01001073 break;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001074 case MAILBOX_STATE_FULL:
1075 /* Check it doesn't have pending RX full notifications. */
1076 if (vm_are_fwk_notifications_pending(vm_locked)) {
1077 dlog_verbose(
1078 "Mailbox of endpoint %x has pending "
1079 "messages.\n",
1080 vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001081 ret = ffa_error(FFA_DENIED);
J-Alvese8c8c2b2022-12-16 15:34:48 +00001082 }
1083 break;
1084 case MAILBOX_STATE_OTHER_WORLD_OWNED:
1085 /*
1086 * The SPMC shouldn't let SP's mailbox get into this state.
1087 * For the Hypervisor, the VM may call FFA_RX_RELEASE, whilst
1088 * the mailbox is in this state. In that case, we should report
1089 * error.
1090 */
1091 if (vm_id_is_current_world(vm_id)) {
1092 dlog_verbose(
Karl Meakin1064a9c2024-06-04 17:20:43 +01001093 "Mailbox of endpoint %x is in an incorrect "
1094 "state.\n",
J-Alvese8c8c2b2022-12-16 15:34:48 +00001095 vm_id);
Karl Meakin1064a9c2024-06-04 17:20:43 +01001096 ret = ffa_error(FFA_ABORTED);
J-Alvese8c8c2b2022-12-16 15:34:48 +00001097 }
1098 break;
1099 }
1100
Karl Meakin1064a9c2024-06-04 17:20:43 +01001101 if (ret.func == FFA_SUCCESS_32) {
1102 vm_locked.vm->mailbox.state = MAILBOX_STATE_EMPTY;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001103 }
1104
Karl Meakin1064a9c2024-06-04 17:20:43 +01001105 return ret;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001106}
1107
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001108/*
1109 * Helper to check if extended arguments (corresponding to regs x8-x17)
1110 * are zeroed out.
1111 */
Kathleen Capella036cc592023-11-30 18:26:15 -05001112bool api_extended_args_are_zero(struct ffa_value *args)
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001113{
Karl Meakind0123af2025-03-17 16:46:38 +00001114 return (args->extended_val.arg8 == 0U &&
1115 args->extended_val.arg9 == 0U &&
1116 args->extended_val.arg10 == 0U &&
1117 args->extended_val.arg11 == 0U &&
1118 args->extended_val.arg12 == 0U &&
1119 args->extended_val.arg13 == 0U &&
1120 args->extended_val.arg14 == 0U &&
1121 args->extended_val.arg15 == 0U &&
1122 args->extended_val.arg16 == 0U &&
1123 args->extended_val.arg17 == 0U);
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001124}
1125
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001126static void api_ffa_msg_wait_rx_release(struct vcpu *current)
1127{
1128 struct vm_locked vm_locked;
1129
Karl Meakin117c8082024-12-04 16:03:28 +00001130 vm_locked = ffa_vm_find_locked(current->vm->id);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001131 if (vm_locked.vm == NULL) {
1132 return;
1133 }
1134
1135 api_release_mailbox(vm_locked);
1136
1137 if (vm_locked.vm->mailbox.state != MAILBOX_STATE_EMPTY) {
1138 dlog_warning("Mailbox not released to producer\n");
1139 }
1140
1141 vm_unlock(&vm_locked);
1142}
1143
Kathleen Capella7253bd52024-08-14 17:36:09 -04001144static bool api_retain_rx_buffer_ownership(struct ffa_value args)
1145{
1146 return ((args.arg2 & FFA_MSG_WAIT_FLAG_RETAIN_RX) != 0U);
1147}
1148
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001149struct ffa_value api_ffa_msg_wait(struct vcpu *current, struct vcpu **next,
1150 struct ffa_value *args)
1151{
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001152 struct vcpu_locked current_locked;
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001153 enum vcpu_state next_state = VCPU_STATE_RUNNING;
J-Alvese8c8c2b2022-12-16 15:34:48 +00001154 struct ffa_value ret;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001155 struct vcpu_locked next_locked = (struct vcpu_locked){
1156 .vcpu = NULL,
1157 };
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001158
Kathleen Capella7253bd52024-08-14 17:36:09 -04001159 if (args->arg1 != 0U || args->arg3 != 0U || args->arg4 != 0U ||
1160 args->arg5 != 0U || args->arg6 != 0U || args->arg7 != 0U) {
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001161 return ffa_error(FFA_INVALID_PARAMETERS);
1162 }
1163
Kathleen Capella7253bd52024-08-14 17:36:09 -04001164 if (current->vm->ffa_version >= FFA_VERSION_1_2) {
1165 if (!api_extended_args_are_zero(args)) {
1166 return ffa_error(FFA_INVALID_PARAMETERS);
1167 }
1168 } else {
1169 if (args->arg2 != 0U) {
1170 return ffa_error(FFA_INVALID_PARAMETERS);
1171 }
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04001172 }
1173
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001174 current_locked = vcpu_lock(current);
Karl Meakin117c8082024-12-04 16:03:28 +00001175 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001176 current_locked, current->vm->id, HF_INVALID_VM_ID,
1177 next_locked, FFA_MSG_WAIT_32, &next_state)) {
1178 ret = ffa_error(FFA_DENIED);
1179 goto out;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001180 }
1181
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001182 assert(!vm_id_is_current_world(current->vm->id) ||
1183 next_state == VCPU_STATE_WAITING);
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001184
Karl Meakin117c8082024-12-04 16:03:28 +00001185 ret = ffa_cpu_cycles_msg_wait_prepare(current_locked, next);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001186
1187 /*
1188 * To maintain partial ordering of locks, release vCPU lock before
1189 * releasing the VM's RX buffer, a process which requires locking the
1190 * VM.
1191 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001192out:
1193 vcpu_unlock(&current_locked);
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001194
Kathleen Capella7253bd52024-08-14 17:36:09 -04001195 if (ret.func != FFA_ERROR_32 &&
1196 !api_retain_rx_buffer_ownership(*args)) {
Kathleen Capellabe1a0b72024-08-16 12:56:39 -04001197 api_ffa_msg_wait_rx_release(current);
1198 }
J-Alvese8c8c2b2022-12-16 15:34:48 +00001199 return ret;
Madhukar Pappireddy5522c672021-12-17 16:35:51 -06001200}
1201
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001202/**
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001203 * Inject virtual timer interrupt to next vCPU if its timer has expired.
1204 */
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001205static void api_inject_arch_timer_interrupt(struct vcpu_locked next_locked)
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001206{
1207 struct vcpu *next = next_locked.vcpu;
1208
1209 if (arch_timer_expired(&next->regs)) {
1210 /* Make virtual timer interrupt pending. */
Daniel Boulby3c1506b2025-02-25 10:49:51 +00001211 vcpu_virt_interrupt_inject(next_locked, HF_VIRTUAL_TIMER_INTID);
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05001212 }
1213}
1214
1215/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001216 * Prepares the vCPU to run by updating its state and fetching whether a return
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001217 * value needs to be forced onto the vCPU.
1218 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001219static bool api_vcpu_prepare_run(struct vcpu_locked current_locked,
1220 struct vcpu_locked vcpu_next_locked,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001221 struct ffa_value *run_ret)
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001222{
Max Shvetsov40108e72020-08-27 12:39:50 +01001223 struct vm_locked vm_locked;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001224 bool ret;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001225 uint64_t timer_remaining_ns = FFA_SLEEP_INDEFINITE;
Olivier Deprez04168ed2022-09-26 09:20:00 +02001226 bool vcpu_was_init_state = false;
J-Alves6e2abc62021-12-02 14:58:56 +00001227 bool need_vm_lock;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001228 struct two_vcpu_locked vcpus_locked;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001229
J-Alves478faac2024-10-23 10:35:57 +01001230 const struct ffa_value ffa_run_abi =
1231 (struct ffa_value){.func = FFA_RUN_32};
1232 const struct ffa_value *ffa_run_ret = NULL;
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001233 enum vm_state target_vm_state;
J-Alves478faac2024-10-23 10:35:57 +01001234
Andrew Scullb06d1752019-02-04 10:15:48 +00001235 /*
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001236 * Check that the registers are available so that the vCPU can be run.
Andrew Scullb06d1752019-02-04 10:15:48 +00001237 *
Andrew Scull4caadaf2019-07-03 13:13:47 +01001238 * The VM lock is not needed in the common case so it must only be taken
1239 * when it is going to be needed. This ensures there are no inter-vCPU
1240 * dependencies in the common run case meaning the sensitive context
1241 * switch performance is consistent.
Andrew Scullb06d1752019-02-04 10:15:48 +00001242 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001243 struct vcpu *vcpu = vcpu_next_locked.vcpu;
1244 struct vcpu *current = current_locked.vcpu;
Max Shvetsov40108e72020-08-27 12:39:50 +01001245
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001246 /* The VM needs to be locked to deliver mailbox messages. */
J-Alves6e2abc62021-12-02 14:58:56 +00001247 need_vm_lock = vcpu->state == VCPU_STATE_WAITING ||
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001248 vcpu->state == VCPU_STATE_CREATED ||
J-Alves6e2abc62021-12-02 14:58:56 +00001249 (!vcpu->vm->el0_partition &&
1250 (vcpu->state == VCPU_STATE_BLOCKED_INTERRUPT ||
1251 vcpu->state == VCPU_STATE_BLOCKED ||
1252 vcpu->state == VCPU_STATE_PREEMPTED));
1253
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001254 if (need_vm_lock) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001255 vcpu_unlock(&vcpu_next_locked);
1256 vcpu_unlock(&current_locked);
Max Shvetsov40108e72020-08-27 12:39:50 +01001257 vm_locked = vm_lock(vcpu->vm);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001258
1259 /* Lock both vCPUs at once to avoid deadlock. */
1260 vcpus_locked = vcpu_lock_both(current, vcpu);
1261 current_locked = vcpus_locked.vcpu1;
1262 vcpu_next_locked = vcpus_locked.vcpu2;
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001263 }
1264
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001265 target_vm_state = vm_read_state(vcpu->vm);
1266
1267 switch (target_vm_state) {
1268 case VM_STATE_NULL:
1269 *run_ret = ffa_error(FFA_INVALID_PARAMETERS);
1270 ret = false;
1271 goto out;
1272 case VM_STATE_CREATED:
1273 /*
1274 * An initial FFA_RUN is necessary for vCPUs of secondary VMs
1275 * to reach the message wait loop. Note that vCPU(s) of Secure
1276 * Partitions don't need it.
1277 */
1278 if (ffa_is_vm_id(vcpu->vm->id)) {
1279 break;
1280 }
1281 *run_ret = ffa_error(FFA_BUSY);
1282 ret = false;
1283 goto out;
1284 case VM_STATE_ABORTING:
1285 if (vcpu->state != VCPU_STATE_NULL &&
1286 vcpu->state != VCPU_STATE_STOPPED &&
1287 vcpu->state != VCPU_STATE_ABORTED) {
1288 dlog_verbose("VM %#x was aborted, cannot run vCPU %u\n",
1289 vcpu->vm->id, vcpu_index(vcpu));
1290 vcpu->state = VCPU_STATE_ABORTED;
1291 }
1292 [[fallthrough]];
1293 case VM_STATE_RUNNING:
1294 [[fallthrough]];
1295 default:
1296 /* Let the subsequent checks handle further conditions. */
1297 break;
1298 }
1299
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001300 /*
1301 * If the vCPU is already running somewhere then we can't run it here
1302 * simultaneously. While it is actually running then the state should be
1303 * `VCPU_STATE_RUNNING` and `regs_available` should be false. Once it
1304 * stops running but while Hafnium is in the process of switching back
1305 * to the primary there will be a brief period while the state has been
1306 * updated but `regs_available` is still false (until
1307 * `api_regs_state_saved` is called). We can't start running it again
1308 * until this has finished, so count this state as still running for the
1309 * purposes of this check.
1310 */
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001311 if (vcpu->state == VCPU_STATE_RUNNING ||
1312 vcpu->state == VCPU_STATE_STARTING || !vcpu->regs_available) {
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001313 /*
1314 * vCPU is running on another pCPU.
1315 *
1316 * It's okay not to return the sleep duration here because the
1317 * other physical CPU that is currently running this vCPU will
1318 * return the sleep duration if needed.
1319 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001320 *run_ret = ffa_error(FFA_BUSY);
Andrew Walbrand81c7d82019-11-27 18:34:46 +00001321 ret = false;
1322 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001323 }
Andrew Scull9726c252019-01-23 13:44:19 +00001324
Andrew Walbran508e63c2018-12-20 17:02:37 +00001325 switch (vcpu->state) {
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001326 case VCPU_STATE_ABORTED:
1327 if (vcpu->vm->lifecycle_support) {
1328 *run_ret = ffa_error(FFA_BUSY);
1329 } else {
1330 *run_ret = ffa_error(FFA_ABORTED);
1331 }
1332 ret = false;
1333 goto out;
1334 case VCPU_STATE_NULL:
1335 *run_ret = ffa_error(FFA_INVALID_PARAMETERS);
1336 ret = false;
1337 goto out;
1338 case VCPU_STATE_STOPPED:
1339 case VCPU_STATE_STARTING:
1340 *run_ret = ffa_error(FFA_BUSY);
1341 [[fallthrough]];
Andrew Sculld6ee1102019-04-05 22:12:42 +01001342 case VCPU_STATE_RUNNING:
1343 case VCPU_STATE_OFF:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001344 ret = false;
1345 goto out;
1346
1347 case VCPU_STATE_CREATED:
1348 /*
1349 * An initial FFA_RUN is necessary for vCPUs of secondary VMs
1350 * to reach the message wait loop. Note that vCPU(s) of Secure
1351 * Partitions don't need it.
1352 */
1353 if (ffa_is_vm_id(vcpu->vm->id)) {
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001354 size_t cpu_indx = cpu_index(current->cpu);
1355
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001356 assert(vcpu->rt_model == RTM_SP_INIT);
1357 vcpu->rt_model = RTM_NONE;
1358
1359 vcpu_was_init_state = true;
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05001360 CHECK(vcpu_state_set(vcpu_next_locked,
1361 VCPU_STATE_STARTING));
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05001362 if (cpu_indx == PRIMARY_CPU_IDX) {
1363 vm_set_state(vm_locked, VM_STATE_RUNNING);
1364 }
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001365 break;
1366 }
1367 *run_ret = ffa_error(FFA_BUSY);
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001368 ret = false;
1369 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001370
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001371 case VCPU_STATE_WAITING:
J-Alves6e2abc62021-12-02 14:58:56 +00001372 assert(need_vm_lock == true);
J-Alves478faac2024-10-23 10:35:57 +01001373 if (!vm_locked.vm->el0_partition) {
Karl Meakin117c8082024-12-04 16:03:28 +00001374 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001375 vcpu_next_locked, vm_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00001376 }
1377
J-Alves478faac2024-10-23 10:35:57 +01001378 /* Provide reference to the return value. */
1379 ffa_run_ret = &ffa_run_abi;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001380
J-Alves478faac2024-10-23 10:35:57 +01001381 break;
Andrew Sculld6ee1102019-04-05 22:12:42 +01001382 case VCPU_STATE_BLOCKED_INTERRUPT:
J-Alves6e2abc62021-12-02 14:58:56 +00001383 if (need_vm_lock &&
Karl Meakin117c8082024-12-04 16:03:28 +00001384 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001385 vcpu_next_locked, vm_locked)) {
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00001386 assert(vcpu_virt_interrupt_count_get(vcpu_next_locked) >
1387 0);
J-Alves6e2abc62021-12-02 14:58:56 +00001388 break;
1389 }
1390
Andrew Scullb06d1752019-02-04 10:15:48 +00001391 /* Allow virtual interrupts to be delivered. */
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00001392 if (vcpu_virt_interrupt_count_get(vcpu_next_locked) > 0) {
Andrew Scullb06d1752019-02-04 10:15:48 +00001393 break;
1394 }
1395
Andrew Walbran508e63c2018-12-20 17:02:37 +00001396 if (arch_timer_enabled(&vcpu->regs)) {
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001397 timer_remaining_ns =
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001398 arch_timer_remaining_ns(&vcpu->regs);
1399
1400 /*
1401 * The timer expired so allow the interrupt to be
1402 * delivered.
1403 */
1404 if (timer_remaining_ns == 0) {
1405 break;
1406 }
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001407 }
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001408
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001409 /*
1410 * The vCPU is not ready to run, return the appropriate code to
1411 * the primary which called vcpu_run.
1412 */
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001413 run_ret->func = HF_FFA_RUN_WAIT_FOR_INTERRUPT;
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001414 run_ret->arg1 = ffa_vm_vcpu(vcpu->vm->id, vcpu_index(vcpu));
1415 run_ret->arg2 = timer_remaining_ns;
Andrew Walbran508e63c2018-12-20 17:02:37 +00001416
1417 ret = false;
1418 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001419
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001420 case VCPU_STATE_BLOCKED:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05001421 /* A blocked vCPU is run unconditionally. */
1422 [[fallthrough]];
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001423 case VCPU_STATE_PREEMPTED:
J-Alves6e2abc62021-12-02 14:58:56 +00001424 /* Check NPI is to be injected here. */
1425 if (need_vm_lock) {
Karl Meakin117c8082024-12-04 16:03:28 +00001426 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00001427 vcpu_next_locked, vm_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00001428 }
Andrew Walbran508e63c2018-12-20 17:02:37 +00001429 break;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001430 default:
1431 /*
1432 * Execution not expected to reach here. Deny the request
1433 * gracefully.
1434 */
1435 *run_ret = ffa_error(FFA_DENIED);
1436 ret = false;
1437 goto out;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001438 }
1439
J-Alves5d65fe72025-02-18 16:02:32 +00001440 ffa_cpu_cycles_init_schedule_mode_ffa_run(current_locked,
1441 vcpu_next_locked);
Madhukar Pappireddy1480fce2022-06-21 18:09:25 -05001442
Madhukar Pappireddy106bfc32024-09-25 15:47:11 -05001443 timer_migrate_to_other_cpu(current_locked.vcpu->cpu, vcpu_next_locked);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001444 vcpu->cpu = current_locked.vcpu->cpu;
J-Alves478faac2024-10-23 10:35:57 +01001445
1446 vcpu_set_running(vcpu_next_locked, ffa_run_ret);
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001447
Olivier Deprez04168ed2022-09-26 09:20:00 +02001448 if (vcpu_was_init_state) {
1449 vcpu_set_phys_core_idx(vcpu);
1450 vcpu_set_boot_info_gp_reg(vcpu);
J-Alves7ac49052022-02-08 17:20:53 +00001451 }
J-Alves7ac49052022-02-08 17:20:53 +00001452
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001453 ret = true;
1454
1455out:
Andrew Scullb06d1752019-02-04 10:15:48 +00001456 if (need_vm_lock) {
Max Shvetsov40108e72020-08-27 12:39:50 +01001457 vm_unlock(&vm_locked);
Andrew Scullb06d1752019-02-04 10:15:48 +00001458 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001459 return ret;
1460}
1461
J-Alves19e20cf2023-08-02 12:48:55 +01001462struct ffa_value api_ffa_run(ffa_id_t vm_id, ffa_vcpu_index_t vcpu_idx,
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001463 struct vcpu *current, struct vcpu **next)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001464{
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001465 struct vm *vm;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001466 struct vcpu *vcpu;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001467 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001468 enum vcpu_state next_state = VCPU_STATE_RUNNING;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001469 struct vcpu_locked current_locked;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001470 struct vcpu_locked vcpu_next_locked;
1471 struct two_vcpu_locked vcpus_locked;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001472
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001473 current_locked = vcpu_lock(current);
Karl Meakin117c8082024-12-04 16:03:28 +00001474 if (!ffa_cpu_cycles_run_checks(current_locked, vm_id, vcpu_idx, &ret,
1475 next)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001476 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001477 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001478
Karl Meakin117c8082024-12-04 16:03:28 +00001479 if (ffa_cpu_cycles_run_forward(vm_id, vcpu_idx, &ret)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001480 goto out;
Raghu Krishnamurthy62f97a72021-07-27 02:14:59 -07001481 }
1482
Andrew Scull19503262018-09-20 14:48:39 +01001483 /* The requested VM must exist. */
Andrew Walbran42347a92019-05-09 13:59:03 +01001484 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +01001485 if (vm == NULL) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001486 goto out;
Andrew Scull19503262018-09-20 14:48:39 +01001487 }
1488
Fuad Tabbaed294af2019-12-20 10:43:01 +00001489 /* The requested vCPU must exist. */
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001490 if (vcpu_idx >= vm->vcpu_count) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001491 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001492 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001493
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001494 /*
1495 * Refer Figure 8.13 Scenario 1 of the FF-A v1.1 EAC spec. SPMC
1496 * bypasses the intermediate execution contexts and resumes the
1497 * SP execution context that was originally preempted.
1498 */
1499 if (*next != NULL) {
1500 vcpu = *next;
1501 } else {
1502 vcpu = vm_get_vcpu(vm, vcpu_idx);
1503 }
1504
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001505 /*
1506 * Unlock current vCPU to allow it to be locked together with next
1507 * vcpu.
1508 */
1509 vcpu_unlock(&current_locked);
1510
1511 /* Lock both vCPUs at once to avoid deadlock. */
1512 vcpus_locked = vcpu_lock_both(current, vcpu);
1513 current_locked = vcpus_locked.vcpu1;
1514 vcpu_next_locked = vcpus_locked.vcpu2;
1515
Karl Meakin117c8082024-12-04 16:03:28 +00001516 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001517 current_locked, current->vm->id, HF_INVALID_VM_ID,
1518 vcpu_next_locked, FFA_RUN_32, &next_state)) {
1519 ret = ffa_error(FFA_DENIED);
1520 goto out_vcpu;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001521 }
1522
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001523 if (!api_vcpu_prepare_run(current_locked, vcpu_next_locked, &ret)) {
1524 goto out_vcpu;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001525 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001526
Fuad Tabbaed294af2019-12-20 10:43:01 +00001527 /* Switch to the vCPU. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001528 *next = vcpu;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001529
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05001530 assert(!vm_id_is_current_world(current->vm->id) ||
1531 next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05001532 CHECK(vcpu_state_set(current_locked, VCPU_STATE_BLOCKED));
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001533
Andrew Scull33fecd32019-01-08 14:48:27 +00001534 /*
1535 * Set a placeholder return code to the scheduler. This will be
1536 * overwritten when the switch back to the primary occurs.
1537 */
J-Alvesbd32c972024-02-02 16:20:04 +00001538 ret = api_ffa_interrupt_return(0);
Andrew Scull33fecd32019-01-08 14:48:27 +00001539
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001540out_vcpu:
1541 vcpu_unlock(&vcpu_next_locked);
1542
Andrew Scull6d2db332018-10-10 15:28:17 +01001543out:
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06001544 vcpu_unlock(&current_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001545 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001546}
1547
1548/**
Andrew Scull81e85092018-12-12 12:56:20 +00001549 * Check that the mode indicates memory that is valid, owned and exclusive.
1550 */
Karl Meakin07a69ab2025-02-07 14:53:19 +00001551static bool api_mode_valid_owned_and_exclusive(mm_mode_t mode)
Andrew Scull81e85092018-12-12 12:56:20 +00001552{
Andrew Scullb5f49e02019-10-02 13:20:47 +01001553 return (mode & (MM_MODE_D | MM_MODE_INVALID | MM_MODE_UNOWNED |
1554 MM_MODE_SHARED)) == 0;
Andrew Scull81e85092018-12-12 12:56:20 +00001555}
1556
1557/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001558 * Configures the hypervisor's stage-1 view of the send and receive pages.
Andrew Sculle1322792019-07-01 17:46:10 +01001559 */
Karl Meakin738bee12024-01-12 15:19:45 +00001560static struct ffa_value api_vm_configure_stage1(
1561 struct mm_stage1_locked mm_stage1_locked, struct vm_locked vm_locked,
1562 paddr_t pa_send_begin, paddr_t pa_send_end, paddr_t pa_recv_begin,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001563 paddr_t pa_recv_end, mm_mode_t extra_mode,
Karl Meakin738bee12024-01-12 15:19:45 +00001564 struct mpool *local_page_pool)
Andrew Sculle1322792019-07-01 17:46:10 +01001565{
Karl Meakin738bee12024-01-12 15:19:45 +00001566 struct ffa_value ret;
Andrew Sculle1322792019-07-01 17:46:10 +01001567
Karl Meakin738bee12024-01-12 15:19:45 +00001568 /*
1569 * Map the send page as read-only in the SPMC/hypervisor address space.
1570 */
Andrew Sculle1322792019-07-01 17:46:10 +01001571 vm_locked.vm->mailbox.send =
1572 mm_identity_map(mm_stage1_locked, pa_send_begin, pa_send_end,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001573 MM_MODE_R | extra_mode, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001574 if (!vm_locked.vm->mailbox.send) {
Karl Meakin738bee12024-01-12 15:19:45 +00001575 ret = ffa_error(FFA_NO_MEMORY);
1576 goto out;
Andrew Sculle1322792019-07-01 17:46:10 +01001577 }
1578
1579 /*
Karl Meakin738bee12024-01-12 15:19:45 +00001580 * Map the receive page as writable in the SPMC/hypervisor address
1581 * space. On failure, unmap the send page before returning.
Andrew Sculle1322792019-07-01 17:46:10 +01001582 */
1583 vm_locked.vm->mailbox.recv =
1584 mm_identity_map(mm_stage1_locked, pa_recv_begin, pa_recv_end,
Karl Meakin07a69ab2025-02-07 14:53:19 +00001585 MM_MODE_W | extra_mode, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001586 if (!vm_locked.vm->mailbox.recv) {
Karl Meakin738bee12024-01-12 15:19:45 +00001587 ret = ffa_error(FFA_NO_MEMORY);
Andrew Sculle1322792019-07-01 17:46:10 +01001588 goto fail_undo_send;
1589 }
Karl Meakin738bee12024-01-12 15:19:45 +00001590 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
J-Alves90d30d02025-05-09 16:04:48 +01001591
Andrew Sculle1322792019-07-01 17:46:10 +01001592 goto out;
1593
1594 /*
1595 * The following mappings will not require more memory than is available
1596 * in the local pool.
1597 */
1598fail_undo_send:
1599 vm_locked.vm->mailbox.send = NULL;
Andrew Scull7e8de322019-07-02 13:00:56 +01001600 CHECK(mm_unmap(mm_stage1_locked, pa_send_begin, pa_send_end,
1601 local_page_pool));
Andrew Sculle1322792019-07-01 17:46:10 +01001602
Andrew Sculle1322792019-07-01 17:46:10 +01001603out:
Andrew Sculle1322792019-07-01 17:46:10 +01001604 return ret;
1605}
1606
1607/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001608 * Sanity checks and configures the send and receive pages in the VM stage-2
1609 * and hypervisor stage-1 page tables.
1610 *
1611 * Returns:
1612 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001613 * aligned, are the same or have invalid attributes.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001614 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
1615 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001616 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001617 * - FFA_SUCCESS on success if no further action is needed.
Andrew Sculle1322792019-07-01 17:46:10 +01001618 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001619
1620struct ffa_value api_vm_configure_pages(
1621 struct mm_stage1_locked mm_stage1_locked, struct vm_locked vm_locked,
1622 ipaddr_t send, ipaddr_t recv, uint32_t page_count,
1623 struct mpool *local_page_pool)
Andrew Sculle1322792019-07-01 17:46:10 +01001624{
Manish Pandeyd34f8892020-06-19 17:41:07 +01001625 struct ffa_value ret;
1626 paddr_t pa_send_begin;
1627 paddr_t pa_send_end;
1628 paddr_t pa_recv_begin;
1629 paddr_t pa_recv_end;
Karl Meakin07a69ab2025-02-07 14:53:19 +00001630 mm_mode_t orig_send_mode = 0;
1631 mm_mode_t orig_recv_mode = 0;
1632 mm_mode_t extra_mode;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001633
1634 /* We only allow these to be setup once. */
1635 if (vm_locked.vm->mailbox.send || vm_locked.vm->mailbox.recv) {
Karl Meakin738bee12024-01-12 15:19:45 +00001636 dlog_error("%s: Mailboxes have already been setup for VM %#x\n",
1637 __func__, vm_locked.vm->id);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001638 ret = ffa_error(FFA_DENIED);
1639 goto out;
1640 }
1641
1642 /* Hafnium only supports a fixed size of RX/TX buffers. */
1643 if (page_count != HF_MAILBOX_SIZE / FFA_PAGE_SIZE) {
Karl Meakine8937d92024-03-19 16:04:25 +00001644 dlog_error("%s: Page count must be %zu, it is %d\n", __func__,
Karl Meakin738bee12024-01-12 15:19:45 +00001645 HF_MAILBOX_SIZE / FFA_PAGE_SIZE, page_count);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001646 ret = ffa_error(FFA_INVALID_PARAMETERS);
1647 goto out;
1648 }
1649
1650 /* Fail if addresses are not page-aligned. */
1651 if (!is_aligned(ipa_addr(send), PAGE_SIZE) ||
1652 !is_aligned(ipa_addr(recv), PAGE_SIZE)) {
Karl Meakin738bee12024-01-12 15:19:45 +00001653 dlog_error("%s: Mailbox buffers not page-aligned\n", __func__);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001654 ret = ffa_error(FFA_INVALID_PARAMETERS);
1655 goto out;
1656 }
1657
1658 /* Convert to physical addresses. */
1659 pa_send_begin = pa_from_ipa(send);
1660 pa_send_end = pa_add(pa_send_begin, HF_MAILBOX_SIZE);
1661 pa_recv_begin = pa_from_ipa(recv);
1662 pa_recv_end = pa_add(pa_recv_begin, HF_MAILBOX_SIZE);
1663
1664 /* Fail if the same page is used for the send and receive pages. */
1665 if (pa_addr(pa_send_begin) == pa_addr(pa_recv_begin)) {
Karl Meakin738bee12024-01-12 15:19:45 +00001666 dlog_error("%s: Mailbox buffers overlap\n", __func__);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001667 ret = ffa_error(FFA_INVALID_PARAMETERS);
1668 goto out;
1669 }
Andrew Sculle1322792019-07-01 17:46:10 +01001670
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001671 /* Set stage 2 translation tables only for virtual FF-A instances. */
1672 if (vm_id_is_current_world(vm_locked.vm->id)) {
1673 /*
1674 * Ensure the pages are valid, owned and exclusive to the VM and
1675 * that the VM has the required access to the memory.
1676 */
1677 if (!vm_mem_get_mode(vm_locked, send, ipa_add(send, PAGE_SIZE),
1678 &orig_send_mode) ||
1679 !api_mode_valid_owned_and_exclusive(orig_send_mode) ||
1680 (orig_send_mode & MM_MODE_R) == 0 ||
1681 (orig_send_mode & MM_MODE_W) == 0) {
1682 dlog_error(
1683 "VM doesn't have required access rights to map "
1684 "TX buffer in stage 2.\n");
1685 ret = ffa_error(FFA_INVALID_PARAMETERS);
1686 goto out;
1687 }
Manish Pandeyd34f8892020-06-19 17:41:07 +01001688
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001689 if (!vm_mem_get_mode(vm_locked, recv, ipa_add(recv, PAGE_SIZE),
1690 &orig_recv_mode) ||
1691 !api_mode_valid_owned_and_exclusive(orig_recv_mode) ||
1692 (orig_recv_mode & MM_MODE_R) == 0) {
1693 dlog_error(
1694 "VM doesn't have required access rights to map "
1695 "RX buffer in stage 2.\n");
1696 ret = ffa_error(FFA_INVALID_PARAMETERS);
1697 goto out;
1698 }
Andrew Sculle1322792019-07-01 17:46:10 +01001699
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001700 /* Take memory ownership away from the VM and mark as shared. */
Karl Meakin07a69ab2025-02-07 14:53:19 +00001701 mm_mode_t mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R |
1702 MM_MODE_W;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001703 if (vm_locked.vm->el0_partition) {
1704 mode |= MM_MODE_USER | MM_MODE_NG;
1705 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001706
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001707 if (!vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
1708 mode, local_page_pool, NULL)) {
1709 dlog_error(
1710 "Cannot allocate a new entry in stage 2 "
1711 "translation table.\n");
1712 ret = ffa_error(FFA_NO_MEMORY);
1713 goto out;
1714 }
Andrew Sculle1322792019-07-01 17:46:10 +01001715
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001716 mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R;
1717 if (vm_locked.vm->el0_partition) {
1718 mode |= MM_MODE_USER | MM_MODE_NG;
1719 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001720
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001721 if (!vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
1722 mode, local_page_pool, NULL)) {
1723 /* TODO: partial defrag of failed range. */
1724 /* Recover any memory consumed in failed mapping. */
Karl Meakin738bee12024-01-12 15:19:45 +00001725 dlog_error("%s: cannot map recv page\n", __func__);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001726 vm_ptable_defrag(vm_locked, local_page_pool);
Karl Meakin738bee12024-01-12 15:19:45 +00001727 ret = ffa_error(FFA_NO_MEMORY);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001728 goto fail_undo_send;
1729 }
Karl Meakin738bee12024-01-12 15:19:45 +00001730 } else {
1731 ret = arch_other_world_vm_configure_rxtx_map(
1732 vm_locked, local_page_pool, pa_send_begin, pa_send_end,
1733 pa_recv_begin, pa_recv_end);
1734 if (ret.func != FFA_SUCCESS_32) {
1735 goto out;
1736 }
Andrew Sculle1322792019-07-01 17:46:10 +01001737 }
1738
Karl Meakin07a69ab2025-02-07 14:53:19 +00001739 /* Get extra send/recv pages mapping mode for the given VM ID. */
1740 extra_mode = arch_mm_extra_mode_from_vm(vm_locked.vm->id);
Olivier Deprez96a2a262020-06-11 17:21:38 +02001741
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001742 /*
1743 * For EL0 partitions, since both the partition and the hypervisor code
1744 * use the EL2&0 translation regime, it is critical to mark the mappings
1745 * of the send and recv buffers as non-global in the TLB. For one, if we
1746 * dont mark it as non-global, it would cause TLB conflicts since there
1747 * would be an identity mapping with non-global attribute in the
1748 * partitions page tables, but another identity mapping in the
1749 * hypervisor page tables with the global attribute. The other issue is
1750 * one of security, we dont want other partitions to be able to access
1751 * other partitions buffers through cached translations.
1752 */
1753 if (vm_locked.vm->el0_partition) {
Karl Meakin07a69ab2025-02-07 14:53:19 +00001754 extra_mode |= MM_MODE_NG;
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001755 }
1756
Karl Meakin07a69ab2025-02-07 14:53:19 +00001757 ret = api_vm_configure_stage1(mm_stage1_locked, vm_locked,
1758 pa_send_begin, pa_send_end, pa_recv_begin,
1759 pa_recv_end, extra_mode, local_page_pool);
Karl Meakin738bee12024-01-12 15:19:45 +00001760 if (ret.func != FFA_SUCCESS_32) {
Andrew Sculle1322792019-07-01 17:46:10 +01001761 goto fail_undo_send_and_recv;
1762 }
1763
Manish Pandeyd34f8892020-06-19 17:41:07 +01001764 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Sculle1322792019-07-01 17:46:10 +01001765 goto out;
1766
Andrew Sculle1322792019-07-01 17:46:10 +01001767fail_undo_send_and_recv:
Andrew Scull3c257452019-11-26 13:32:50 +00001768 CHECK(vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001769 orig_recv_mode, local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +01001770
1771fail_undo_send:
Andrew Scull3c257452019-11-26 13:32:50 +00001772 CHECK(vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
Manish Pandeyd34f8892020-06-19 17:41:07 +01001773 orig_send_mode, local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +01001774
1775out:
Andrew Sculle1322792019-07-01 17:46:10 +01001776 return ret;
1777}
1778
Karl Meakinb9705e22024-04-05 13:58:28 +01001779/**
1780 * Read the buffer addresses and VM ID of an FFA_RXTX_MAP request. Handles
1781 * forwarded messages by reading from the hypervisor's TX buffer.
1782 *
1783 * Returns the VM/SP ID on success.
1784 *
1785 * Returns `HF_INVALID_VM_ID` when the arguments provided via the ABI
1786 * FFA_RXTX_MAP indicate the SPMC should retrieve the RXTX description from the
1787 * Hypervisor RXTX buffers, and the hypervisor hasn't given its own RXTX buffers
1788 * for the SPMC to map.
1789 */
1790static ffa_id_t api_get_rxtx_description(struct vm *current_vm, ipaddr_t *send,
1791 ipaddr_t *recv, uint32_t *page_count)
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001792{
Karl Meakinb9705e22024-04-05 13:58:28 +01001793 bool forwarded;
1794 struct vm_locked vm_locked;
1795 ffa_id_t owner_vm_id;
1796 struct ffa_endpoint_rx_tx_descriptor *endpoint_desc;
1797 struct ffa_composite_memory_region *rx_region;
1798 struct ffa_composite_memory_region *tx_region;
1799
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001800 /*
1801 * If the message has been forwarded the effective addresses are in
1802 * hypervisor's TX buffer.
1803 */
Karl Meakinb9705e22024-04-05 13:58:28 +01001804 forwarded = (current_vm->id == HF_OTHER_WORLD_ID) &&
1805 (ipa_addr(*send) == 0) && (ipa_addr(*recv) == 0) &&
1806 (*page_count == 0);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001807
1808 if (forwarded) {
Karl Meakinb9705e22024-04-05 13:58:28 +01001809 vm_locked = vm_lock(current_vm);
1810 endpoint_desc = (struct ffa_endpoint_rx_tx_descriptor *)
1811 vm_locked.vm->mailbox.send;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001812
Karl Meakinb9705e22024-04-05 13:58:28 +01001813 if (endpoint_desc == NULL) {
1814 dlog_error(
1815 "Trying to access RXTX description, but "
1816 "hypervisor has not provided RXTX buffers\n");
1817 vm_unlock(&vm_locked);
1818 return HF_INVALID_VM_ID;
1819 }
1820
1821 rx_region = ffa_endpoint_get_rx_memory_region(endpoint_desc);
1822 tx_region = ffa_endpoint_get_tx_memory_region(endpoint_desc);
1823
1824 owner_vm_id = endpoint_desc->endpoint_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001825 *recv = ipa_init(rx_region->constituents[0].address);
1826 *send = ipa_init(tx_region->constituents[0].address);
1827 *page_count = rx_region->constituents[0].page_count;
J-Alves28ad9b42022-12-08 12:19:43 +00001828
1829 vm_unlock(&vm_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001830 } else {
Karl Meakinb9705e22024-04-05 13:58:28 +01001831 owner_vm_id = current_vm->id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001832 }
Karl Meakinb9705e22024-04-05 13:58:28 +01001833
1834 return owner_vm_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001835}
Karl Meakinb9705e22024-04-05 13:58:28 +01001836
Andrew Sculle1322792019-07-01 17:46:10 +01001837/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001838 * Configures the VM to send/receive data through the specified pages. The pages
Manish Pandeyd34f8892020-06-19 17:41:07 +01001839 * must not be shared. Locking of the page tables combined with a local memory
1840 * pool ensures there will always be enough memory to recover from any errors
1841 * that arise. The stage-1 page tables must be locked so memory cannot be taken
1842 * by another core which could result in this transaction being unable to roll
1843 * back in the case of an error.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001844 *
1845 * Returns:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001846 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001847 * aligned, are the same or have invalid attributes.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001848 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001849 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001850 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001851 * - FFA_SUCCESS on success if no further action is needed.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001852 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001853struct ffa_value api_ffa_rxtx_map(ipaddr_t send, ipaddr_t recv,
Federico Recanati9f1b6532022-04-14 13:15:28 +02001854 uint32_t page_count, struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001855{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001856 struct ffa_value ret;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001857 struct vm_locked owner_vm_locked;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001858 struct mm_stage1_locked mm_stage1_locked;
1859 struct mpool local_page_pool;
J-Alves19e20cf2023-08-02 12:48:55 +01001860 ffa_id_t owner_vm_id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001861
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001862 /*
1863 * Get the original buffer addresses and VM ID in case of forwarded
1864 * message.
1865 */
Karl Meakinb9705e22024-04-05 13:58:28 +01001866 owner_vm_id = api_get_rxtx_description(current->vm, &send, &recv,
1867 &page_count);
1868 if (owner_vm_id == HF_INVALID_VM_ID) {
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001869 dlog_error("Cannot map RX/TX for invalid VM ID %#x.\n",
1870 owner_vm_id);
Karl Meakinb9705e22024-04-05 13:58:28 +01001871 return ffa_error(FFA_INVALID_PARAMETERS);
1872 }
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001873
Karl Meakin117c8082024-12-04 16:03:28 +00001874 owner_vm_locked = ffa_vm_find_locked_create(owner_vm_id);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001875 if (owner_vm_locked.vm == NULL) {
1876 dlog_error("Cannot map RX/TX for VM ID %#x, not found.\n",
1877 owner_vm_id);
1878 return ffa_error(FFA_DENIED);
1879 }
Andrew Scull220e6212018-12-21 18:09:00 +00001880
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001881 /*
Manish Pandeyd34f8892020-06-19 17:41:07 +01001882 * Create a local pool so any freed memory can't be used by another
1883 * thread. This is to ensure the original mapping can be restored if any
1884 * stage of the process fails.
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001885 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001886 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
1887
Manish Pandeyd34f8892020-06-19 17:41:07 +01001888 mm_stage1_locked = mm_lock_stage1();
Andrew Scull220e6212018-12-21 18:09:00 +00001889
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001890 ret = api_vm_configure_pages(mm_stage1_locked, owner_vm_locked, send,
1891 recv, page_count, &local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001892 if (ret.func != FFA_SUCCESS_32) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001893 goto exit;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001894 }
1895
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001896 /* Forward buffer mapping to SPMC if coming from a VM. */
Karl Meakin117c8082024-12-04 16:03:28 +00001897 ffa_setup_rxtx_map_forward(owner_vm_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001898
Federico Recanati9f1b6532022-04-14 13:15:28 +02001899 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Scull220e6212018-12-21 18:09:00 +00001900
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001901exit:
Manish Pandeyd34f8892020-06-19 17:41:07 +01001902 mpool_fini(&local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001903 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001904 vm_unlock(&owner_vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001905
1906 return ret;
1907}
1908
1909/**
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001910 * Unmaps the RX/TX buffer pair with a partition or partition manager from the
1911 * translation regime of the caller. Unmap the region for the hypervisor and
1912 * set the memory region to owned and exclusive for the component. Since the
1913 * memory region mapped in the page table, when the buffers were originally
1914 * created we can safely remap it.
1915 *
1916 * Returns:
1917 * - FFA_ERROR FFA_INVALID_PARAMETERS if there is no buffer pair registered on
1918 * behalf of the caller.
1919 * - FFA_SUCCESS on success if no further action is needed.
1920 */
J-Alves19e20cf2023-08-02 12:48:55 +01001921struct ffa_value api_ffa_rxtx_unmap(ffa_id_t allocator_id, struct vcpu *current)
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001922{
1923 struct vm *vm = current->vm;
1924 struct vm_locked vm_locked;
J-Alves19e20cf2023-08-02 12:48:55 +01001925 ffa_id_t owner_vm_id;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001926 struct mm_stage1_locked mm_stage1_locked;
1927 paddr_t send_pa_begin;
1928 paddr_t send_pa_end;
1929 paddr_t recv_pa_begin;
1930 paddr_t recv_pa_end;
Federico Recanati8da9e332022-02-10 11:00:17 +01001931 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001932
J-Alves661e1b72023-08-02 13:39:40 +01001933 if (vm->id == HF_HYPERVISOR_VM_ID && !ffa_is_vm_id(allocator_id)) {
Olivier Deprez106c8ce2024-02-08 11:49:02 +01001934 dlog_verbose(
J-Alves9bd324a2023-01-12 10:52:52 +00001935 "The Hypervisor must specify a valid VM ID in register "
1936 "W1, if FFA_RXTX_UNMAP call forwarded to SPM.\n");
1937 return ffa_error(FFA_INVALID_PARAMETERS);
1938 }
1939
Federico Recanati8da9e332022-02-10 11:00:17 +01001940 /* Ensure `allocator_id` is set only at Non-Secure Physical instance. */
1941 if (vm_id_is_current_world(vm->id) && (allocator_id != 0)) {
J-Alves9bd324a2023-01-12 10:52:52 +00001942 dlog_error(
1943 "The register W1 (containing ID) must be 0 at virtual "
1944 "instances.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001945 return ffa_error(FFA_INVALID_PARAMETERS);
1946 }
1947
1948 /* VM ID of which buffers have to be unmapped. */
1949 owner_vm_id = (allocator_id != 0) ? allocator_id : vm->id;
1950
Karl Meakin117c8082024-12-04 16:03:28 +00001951 vm_locked = ffa_vm_find_locked(owner_vm_id);
Federico Recanati8da9e332022-02-10 11:00:17 +01001952 vm = vm_locked.vm;
1953 if (vm == NULL) {
1954 dlog_error("Cannot unmap RX/TX for VM ID %#x, not found.\n",
1955 owner_vm_id);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001956 return ffa_error(FFA_INVALID_PARAMETERS);
1957 }
1958
1959 /* Get send and receive buffers. */
1960 if (vm->mailbox.send == NULL || vm->mailbox.recv == NULL) {
Olivier Deprez86d87ae2021-08-19 14:27:46 +02001961 dlog_verbose(
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001962 "No buffer pair registered on behalf of the caller.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001963 ret = ffa_error(FFA_INVALID_PARAMETERS);
1964 goto out;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001965 }
1966
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001967 vm_unmap_rxtx(vm_locked, &api_page_pool);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001968
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001969 if (!vm_id_is_current_world(owner_vm_id)) {
1970 send_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.send));
1971 send_pa_end = pa_add(send_pa_begin, HF_MAILBOX_SIZE);
1972 recv_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.recv));
1973 recv_pa_end = pa_add(recv_pa_begin, HF_MAILBOX_SIZE);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001974
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001975 mm_stage1_locked = mm_lock_stage1();
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001976
Karl Meakin738bee12024-01-12 15:19:45 +00001977 ret = arch_other_world_vm_configure_rxtx_unmap(
1978 vm_locked, &api_page_pool, send_pa_begin, send_pa_end,
1979 recv_pa_begin, recv_pa_end);
1980 if (ret.func != FFA_SUCCESS_32) {
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001981 mm_unlock_stage1(&mm_stage1_locked);
Karl Meakin738bee12024-01-12 15:19:45 +00001982 goto out;
1983 }
Madhukar Pappireddy507c9972025-05-08 17:25:03 -05001984
1985 /* Unmap the buffers in the partition manager. */
1986 CHECK(mm_unmap(mm_stage1_locked, send_pa_begin, send_pa_end,
1987 &api_page_pool));
1988 CHECK(mm_unmap(mm_stage1_locked, recv_pa_begin, recv_pa_end,
1989 &api_page_pool));
1990
1991 vm->mailbox.send = NULL;
1992 vm->mailbox.recv = NULL;
1993
1994 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01001995 }
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001996
Madhukar Pappireddycbb836c2025-05-08 17:16:42 -05001997 ffa_vm_nwd_free(vm_locked);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001998
Federico Recanati8da9e332022-02-10 11:00:17 +01001999 /* Forward buffer unmapping to SPMC if coming from a VM. */
Karl Meakin117c8082024-12-04 16:03:28 +00002000 ffa_setup_rxtx_unmap_forward(vm_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01002001
Federico Recanati8da9e332022-02-10 11:00:17 +01002002out:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002003 vm_unlock(&vm_locked);
2004
Federico Recanati8da9e332022-02-10 11:00:17 +01002005 return ret;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002006}
2007
Karl Meakin355d5c22024-12-12 18:04:56 +00002008static struct ffa_value api_ffa_msg_send2_copy_data(
2009 struct ffa_partition_rxtx_header *header, struct vm *receiver_vm,
Karl Meakina78337f2024-12-12 23:30:06 +00002010 struct vm_locked sender_locked)
Karl Meakin355d5c22024-12-12 18:04:56 +00002011{
Karl Meakina78337f2024-12-12 23:30:06 +00002012 const void *sender_tx_buffer = sender_locked.vm->mailbox.send;
Karl Meakin355d5c22024-12-12 18:04:56 +00002013 uint32_t total_size;
Karl Meakina78337f2024-12-12 23:30:06 +00002014 uint32_t min_offset;
Karl Meakin355d5c22024-12-12 18:04:56 +00002015
Karl Meakina78337f2024-12-12 23:30:06 +00002016 switch (sender_locked.vm->ffa_version) {
2017 case FFA_VERSION_1_0:
2018 dlog_verbose("Indirect messaging not supported in v1.0\n");
2019 return ffa_error(FFA_NOT_SUPPORTED);
2020 case FFA_VERSION_1_1:
2021 min_offset = FFA_RXTX_HEADER_SIZE_V1_1;
2022 break;
2023 default:
2024 min_offset = FFA_RXTX_HEADER_SIZE;
2025 break;
2026 }
2027
2028 if (header->offset < min_offset) {
2029 dlog_error(
2030 "Indirect message payload overlaps with header (%u < "
2031 "%u, version = %#x)\n",
2032 header->offset, min_offset,
2033 sender_locked.vm->ffa_version);
Karl Meakin355d5c22024-12-12 18:04:56 +00002034 return ffa_error(FFA_INVALID_PARAMETERS);
2035 }
2036
Karl Meakina78337f2024-12-12 23:30:06 +00002037 /*
2038 * Check the size of transfer.
2039 * Check for overflow in the sum so that very large offsets and/or sizes
2040 * do not pass the check.
2041 */
2042 if (add_overflow(header->offset, header->size, &total_size)) {
2043 dlog_error(
2044 "Overflow calculating message size (offset = %u, size "
2045 "= %u)\n",
2046 header->offset, header->size);
2047 return ffa_error(FFA_INVALID_PARAMETERS);
2048 }
2049
2050 if (total_size > FFA_MSG_PAYLOAD_MAX) {
2051 dlog_error("Message is too big (%u > %zu)\n", total_size,
2052 FFA_MSG_PAYLOAD_MAX);
Karl Meakin355d5c22024-12-12 18:04:56 +00002053 return ffa_error(FFA_INVALID_PARAMETERS);
2054 }
2055
2056 /* Copy data. */
2057 if (!memcpy_trapped(receiver_vm->mailbox.recv, FFA_MSG_PAYLOAD_MAX,
2058 sender_tx_buffer, total_size)) {
2059 dlog_error(
Karl Meakina78337f2024-12-12 23:30:06 +00002060 "%s: Failed to copy message to receiver's (%x) RX "
Karl Meakin355d5c22024-12-12 18:04:56 +00002061 "buffer.\n",
2062 __func__, receiver_vm->id);
2063 return ffa_error(FFA_ABORTED);
2064 }
2065
2066 receiver_vm->mailbox.recv_size = total_size;
2067 receiver_vm->mailbox.recv_sender = header->sender;
2068 receiver_vm->mailbox.recv_func = FFA_MSG_SEND2_32;
2069 receiver_vm->mailbox.state = MAILBOX_STATE_FULL;
2070
2071 return (struct ffa_value){.func = FFA_SUCCESS_32};
2072}
2073
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002074/**
Federico Recanati25053ee2022-03-14 15:01:53 +01002075 * Copies data from the sender's send buffer to the recipient's receive buffer
2076 * and notifies the receiver.
2077 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002078struct ffa_value api_ffa_msg_send2(ffa_id_t sender_id, uint32_t flags,
Federico Recanati25053ee2022-03-14 15:01:53 +01002079 struct vcpu *current)
2080{
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002081 struct vm *current_vm = current->vm;
2082 struct vm *receiver_vm;
2083 struct vm_locked receiver_locked;
Federico Recanati25053ee2022-03-14 15:01:53 +01002084 struct vm_locked sender_locked;
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002085 const void *sender_tx_buffer;
Federico Recanati25053ee2022-03-14 15:01:53 +01002086 struct ffa_value ret;
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002087 ffa_id_t header_sender_id;
2088 ffa_id_t header_receiver_id;
Federico Recanati25053ee2022-03-14 15:01:53 +01002089
Karl Meakina5ea9092024-05-28 15:40:33 +01002090 alignas(8) struct ffa_partition_rxtx_header header;
2091
Federico Recanati25053ee2022-03-14 15:01:53 +01002092 /* Only Hypervisor can set `sender_vm_id` when forwarding messages. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002093 if (current_vm->id != HF_HYPERVISOR_VM_ID && sender_id != 0) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002094 dlog_error("Sender VM ID must be zero.\n");
2095 return ffa_error(FFA_INVALID_PARAMETERS);
2096 }
2097
Federico Recanati25053ee2022-03-14 15:01:53 +01002098 /*
2099 * Get message sender's mailbox, which can be different to the `from` vm
2100 * when the message is forwarded.
2101 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002102 sender_id = (sender_id != 0) ? sender_id : current_vm->id;
2103 sender_locked = ffa_vm_find_locked(sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002104 if (sender_locked.vm == NULL) {
2105 dlog_error("Cannot send message from VM ID %#x, not found.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002106 sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002107 return ffa_error(FFA_DENIED);
2108 }
2109
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002110 sender_tx_buffer = sender_locked.vm->mailbox.send;
2111 if (sender_tx_buffer == NULL) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002112 dlog_error("Cannot retrieve TX buffer for VM ID %#x.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002113 sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002114 ret = ffa_error(FFA_DENIED);
2115 goto out_unlock_sender;
2116 }
2117
2118 /*
2119 * Copy message header as safety measure to avoid multiple accesses to
2120 * unsafe memory which could be 'corrupted' between safety checks and
2121 * final buffer copy.
Karl Meakina78337f2024-12-12 23:30:06 +00002122 * This includes the UUID added in v1.2. Messages that do not specify a
2123 * UUID (v1.1 or earlier) will leave the UUID unspecified, so this is
2124 * backwards compatible.
Federico Recanati25053ee2022-03-14 15:01:53 +01002125 */
Karl Meakinbf580c22024-12-12 14:31:06 +00002126 if (!memcpy_trapped(&header, sizeof(header), sender_tx_buffer,
J-Alves8a5fd9d2024-04-09 11:22:49 +01002127 FFA_RXTX_HEADER_SIZE)) {
2128 dlog_error(
2129 "%s: Failed to copy message from sender's(%x) TX "
2130 "buffer.\n",
2131 __func__, sender_locked.vm->id);
2132 ret = ffa_error(FFA_ABORTED);
2133 goto out_unlock_sender;
2134 }
2135
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002136 header_sender_id = header.sender;
2137 header_receiver_id = header.receiver;
Federico Recanati25053ee2022-03-14 15:01:53 +01002138
2139 /* Ensure Sender IDs from API and from message header match. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002140 if (sender_id != header_sender_id) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002141 dlog_error(
2142 "Message sender VM ID (%#x) doesn't match header's VM "
2143 "ID (%#x).\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002144 sender_id, header_sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002145 ret = ffa_error(FFA_INVALID_PARAMETERS);
2146 goto out_unlock_sender;
2147 }
2148
2149 /* Disallow reflexive requests as this suggests an error in the VM. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002150 if (header_receiver_id == header_sender_id) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002151 dlog_error("Sender and receive VM IDs must be different.\n");
2152 ret = ffa_error(FFA_INVALID_PARAMETERS);
2153 goto out_unlock_sender;
2154 }
2155
Federico Recanati7b39ff22022-03-14 15:01:53 +01002156 /* `flags` can be set only at secure virtual FF-A instances. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002157 if (ffa_is_vm_id(header_sender_id) && flags != 0) {
Federico Recanati7b39ff22022-03-14 15:01:53 +01002158 dlog_error("flags must be zero.\n");
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002159 ret = ffa_error(FFA_INVALID_PARAMETERS);
2160 goto out_unlock_sender;
Federico Recanati7b39ff22022-03-14 15:01:53 +01002161 }
2162
Federico Recanati25053ee2022-03-14 15:01:53 +01002163 /*
2164 * Check if the message has to be forwarded to the SPMC, in
2165 * this case return, the SPMC will handle the buffer copy.
2166 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002167 if (ffa_indirect_msg_send2_forward(header_receiver_id, header_sender_id,
2168 &ret)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002169 goto out_unlock_sender;
2170 }
2171
2172 /* Ensure the receiver VM exists. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002173 receiver_locked = ffa_vm_find_locked(header_receiver_id);
2174 receiver_vm = receiver_locked.vm;
Federico Recanati25053ee2022-03-14 15:01:53 +01002175
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002176 if (receiver_vm == NULL) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002177 dlog_error("Cannot deliver message to VM %#x, not found.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002178 header_receiver_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002179 ret = ffa_error(FFA_INVALID_PARAMETERS);
2180 goto out_unlock_sender;
2181 }
2182
2183 /*
2184 * Check sender and receiver can use indirect messages.
2185 * Sender is the VM/SP who originally sent the message, not the
2186 * hypervisor possibly relaying it.
2187 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002188 if (!ffa_indirect_msg_is_supported(sender_locked, receiver_locked)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002189 dlog_verbose("VM %#x doesn't support indirect message\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002190 header_sender_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002191 ret = ffa_error(FFA_DENIED);
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002192 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002193 }
2194
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002195 if (vm_is_mailbox_busy(receiver_locked)) {
Federico Recanati25053ee2022-03-14 15:01:53 +01002196 dlog_error(
2197 "Cannot deliver message to VM %#x, RX buffer not "
2198 "ready.\n",
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002199 header_receiver_id);
Federico Recanati25053ee2022-03-14 15:01:53 +01002200 ret = ffa_error(FFA_BUSY);
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002201 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002202 }
2203
Federico Recanati644f0462022-03-17 12:04:00 +01002204 /* Acquire receiver's RX buffer. */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002205 if (!ffa_setup_acquire_receiver_rx(receiver_locked, &ret)) {
2206 dlog_error("Failed to acquire RX buffer for VM %#x\n",
2207 receiver_vm->id);
2208 goto out_unlock_both;
Federico Recanati644f0462022-03-17 12:04:00 +01002209 }
2210
Karl Meakina78337f2024-12-12 23:30:06 +00002211 ret = api_ffa_msg_send2_copy_data(&header, receiver_vm, sender_locked);
Karl Meakin355d5c22024-12-12 18:04:56 +00002212 if (ret.func != FFA_SUCCESS_32) {
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002213 goto out_unlock_both;
Federico Recanati25053ee2022-03-14 15:01:53 +01002214 }
2215
J-Alves3bb82592023-01-23 11:20:54 +00002216 /*
2217 * Set framework notifications, only if the SP has enabled
2218 * receipt of notifications.
2219 * If VMs have provided the RX buffer it is implied they already
2220 * support indirect messaging, and therefore framework notifications.
2221 */
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002222 if (ffa_is_vm_id(receiver_locked.vm->id) ||
2223 vm_are_notifications_enabled(receiver_locked.vm)) {
J-Alves3bb82592023-01-23 11:20:54 +00002224 ffa_notifications_bitmap_t rx_buffer_full =
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002225 ffa_is_vm_id(header_sender_id)
J-Alves3bb82592023-01-23 11:20:54 +00002226 ? FFA_NOTIFICATION_HYP_BUFFER_FULL_MASK
2227 : FFA_NOTIFICATION_SPM_BUFFER_FULL_MASK;
Federico Recanati25053ee2022-03-14 15:01:53 +01002228
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002229 vm_notifications_framework_set_pending(receiver_locked,
J-Alves3bb82592023-01-23 11:20:54 +00002230 rx_buffer_full);
2231
2232 if ((FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) == 0) {
2233 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
2234 vcpu_index(current));
Karl Meakin117c8082024-12-04 16:03:28 +00002235 ffa_notifications_sri_trigger_not_delayed(current->cpu);
J-Alves3bb82592023-01-23 11:20:54 +00002236 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00002237 ffa_notifications_sri_set_delayed(current->cpu);
J-Alves3bb82592023-01-23 11:20:54 +00002238 }
Federico Recanati25053ee2022-03-14 15:01:53 +01002239 }
2240
2241 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2242
Karl Meakin8e3d7bc2024-12-12 15:52:19 +00002243out_unlock_both:
2244 vm_unlock(&receiver_locked);
Federico Recanati25053ee2022-03-14 15:01:53 +01002245
2246out_unlock_sender:
2247 vm_unlock(&sender_locked);
2248
2249 return ret;
2250}
2251
2252/**
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002253 * Releases the caller's mailbox so that a new message can be received. The
2254 * caller must have copied out all data they wish to preserve as new messages
2255 * will overwrite the old and will arrive asynchronously.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002256 *
2257 * Returns:
Federico Recanati7bef0b92022-03-17 14:56:22 +01002258 * - FFA_ERROR FFA_INVALID_PARAMETERS if message is forwarded to SPMC but
2259 * there's no buffer pair mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002260 * - FFA_ERROR FFA_DENIED on failure, if the mailbox hasn't been read.
2261 * - FFA_SUCCESS on success if no further action is needed.
2262 * - FFA_RX_RELEASE if it was called by the primary VM and the primary VM now
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002263 * needs to wake up or kick waiters. Waiters should be retrieved by calling
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002264 * hf_mailbox_waiter_get.
2265 */
J-Alves19e20cf2023-08-02 12:48:55 +01002266struct ffa_value api_ffa_rx_release(ffa_id_t receiver_id, struct vcpu *current)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002267{
Federico Recanati7bef0b92022-03-17 14:56:22 +01002268 struct vm *current_vm = current->vm;
2269 struct vm *vm;
2270 struct vm_locked vm_locked;
J-Alves19e20cf2023-08-02 12:48:55 +01002271 ffa_id_t current_vm_id = current_vm->id;
2272 ffa_id_t release_vm_id;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002273 struct ffa_value ret;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002274
Federico Recanati7bef0b92022-03-17 14:56:22 +01002275 /* `receiver_id` can be set only at Non-Secure Physical interface. */
2276 if (vm_id_is_current_world(current_vm_id) && (receiver_id != 0)) {
2277 dlog_error("Invalid `receiver_id`, must be zero.\n");
2278 return ffa_error(FFA_INVALID_PARAMETERS);
2279 }
2280
2281 /*
2282 * VM ID to be released: `receiver_id` if message has been forwarded by
2283 * Hypervisor to release a VM's buffer, current VM ID otherwise.
2284 */
2285 if (vm_id_is_current_world(current_vm_id) || (receiver_id == 0)) {
2286 release_vm_id = current_vm_id;
2287 } else {
2288 release_vm_id = receiver_id;
2289 }
2290
Karl Meakin117c8082024-12-04 16:03:28 +00002291 vm_locked = ffa_vm_find_locked(release_vm_id);
Federico Recanati7bef0b92022-03-17 14:56:22 +01002292 vm = vm_locked.vm;
2293 if (vm == NULL) {
2294 dlog_error("No buffer registered for VM ID %#x.\n",
2295 release_vm_id);
2296 return ffa_error(FFA_INVALID_PARAMETERS);
2297 }
2298
Karl Meakin117c8082024-12-04 16:03:28 +00002299 if (ffa_setup_rx_release_forward(vm_locked, &ret)) {
Federico Recanati7bef0b92022-03-17 14:56:22 +01002300 goto out;
2301 }
2302
Karl Meakin1064a9c2024-06-04 17:20:43 +01002303 ret = api_release_mailbox(vm_locked);
Federico Recanati7bef0b92022-03-17 14:56:22 +01002304
2305out:
2306 vm_unlock(&vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01002307
2308 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01002309}
Andrew Walbran318f5732018-11-20 16:23:42 +00002310
2311/**
Federico Recanati644f0462022-03-17 12:04:00 +01002312 * Acquire ownership of an RX buffer before writing to it. Both
2313 * Hypervisor and SPMC are producers of VM's RX buffer, and they
2314 * could contend for the same buffer. SPMC owns VM's RX buffer after
2315 * it's mapped in its translation regime. This ABI should be
2316 * used by the Hypervisor to get the ownership of a VM's RX buffer
2317 * from the SPMC solving the aforementioned possible contention.
2318 *
2319 * Returns:
2320 * - FFA_DENIED: callee cannot relinquish ownership of RX buffer.
2321 * - FFA_INVALID_PARAMETERS: there is no buffer pair registered for the VM.
2322 * - FFA_NOT_SUPPORTED: function not implemented at the FF-A instance.
2323 */
J-Alves19e20cf2023-08-02 12:48:55 +01002324struct ffa_value api_ffa_rx_acquire(ffa_id_t receiver_id, struct vcpu *current)
Federico Recanati644f0462022-03-17 12:04:00 +01002325{
2326 struct vm_locked receiver_locked;
2327 struct vm *receiver;
2328 struct ffa_value ret;
2329
2330 if ((current->vm->id != HF_HYPERVISOR_VM_ID) ||
J-Alves661e1b72023-08-02 13:39:40 +01002331 !ffa_is_vm_id(receiver_id)) {
Federico Recanati644f0462022-03-17 12:04:00 +01002332 dlog_error(
2333 "FFA_RX_ACQUIRE not supported at this FF-A "
2334 "instance.\n");
2335 return ffa_error(FFA_NOT_SUPPORTED);
2336 }
2337
Karl Meakin117c8082024-12-04 16:03:28 +00002338 receiver_locked = ffa_vm_find_locked(receiver_id);
Federico Recanati644f0462022-03-17 12:04:00 +01002339 receiver = receiver_locked.vm;
2340
2341 if (receiver == NULL || receiver->mailbox.recv == NULL) {
2342 dlog_error("Cannot retrieve RX buffer for VM ID %#x.\n",
2343 receiver_id);
2344 ret = ffa_error(FFA_INVALID_PARAMETERS);
2345 goto out;
2346 }
2347
2348 if (receiver->mailbox.state != MAILBOX_STATE_EMPTY) {
2349 dlog_error("Mailbox busy for VM ID %#x.\n", receiver_id);
2350 ret = ffa_error(FFA_DENIED);
2351 goto out;
2352 }
2353
J-Alvese8c8c2b2022-12-16 15:34:48 +00002354 receiver->mailbox.state = MAILBOX_STATE_OTHER_WORLD_OWNED;
Federico Recanati644f0462022-03-17 12:04:00 +01002355
2356 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2357
2358out:
2359 vm_unlock(&receiver_locked);
2360
2361 return ret;
2362}
2363
J-Alvescc542042024-07-24 19:13:22 +01002364/*
2365 * Returns true if intid relates with either of those:
2366 * - NPI
2367 * - ME
2368 * - Virtual Timer.
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01002369 * - IPI
J-Alvescc542042024-07-24 19:13:22 +01002370 *
2371 * These are VIs with no expected interrupt descriptor.
2372 */
2373static bool api_is_maintenance_virtual_interrupt(uint32_t intid)
2374{
2375 return intid == HF_NOTIFICATION_PENDING_INTID ||
2376 intid == HF_MANAGED_EXIT_INTID ||
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01002377 intid == HF_VIRTUAL_TIMER_INTID || intid == HF_IPI_INTID;
J-Alvescc542042024-07-24 19:13:22 +01002378}
2379
Federico Recanati644f0462022-03-17 12:04:00 +01002380/**
Andrew Walbran318f5732018-11-20 16:23:42 +00002381 * Enables or disables a given interrupt ID for the calling vCPU.
2382 *
2383 * Returns 0 on success, or -1 if the intid is invalid.
2384 */
Manish Pandey35e452f2021-02-18 21:36:34 +00002385int64_t api_interrupt_enable(uint32_t intid, bool enable,
2386 enum interrupt_type type, struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00002387{
Manish Pandey35e452f2021-02-18 21:36:34 +00002388 struct vcpu_locked current_locked;
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002389 struct interrupts *interrupts = &current->interrupts;
J-Alvescc542042024-07-24 19:13:22 +01002390 struct interrupt_descriptor *int_desc = NULL;
2391 struct vm *vm = current->vm;
2392 struct vm_locked vm_locked;
2393
2394 int64_t ret = -1;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002395
Andrew Walbran318f5732018-11-20 16:23:42 +00002396 if (intid >= HF_NUM_INTIDS) {
2397 return -1;
2398 }
2399
J-Alvescc542042024-07-24 19:13:22 +01002400 vm_locked = vm_lock(vm);
Manish Pandey35e452f2021-02-18 21:36:34 +00002401 current_locked = vcpu_lock(current);
J-Alvescc542042024-07-24 19:13:22 +01002402
2403 int_desc = vm_interrupt_set_enable(vm_locked, intid, enable);
2404
2405 if (!api_is_maintenance_virtual_interrupt(intid)) {
2406 if (int_desc == NULL) {
2407 dlog_error("%s: invalid interrupt ID.\n", __func__);
2408 goto out;
2409 }
2410
2411 plat_interrupts_configure_interrupt(*int_desc);
2412 }
2413
Daniel Boulbyd21e9b32025-02-13 15:53:21 +00002414 /*
2415 * The type must be set first so that the correct count is modfied.
2416 */
2417 vcpu_virt_interrupt_set_type(interrupts, intid, type);
2418 vcpu_virt_interrupt_enable(current_locked, intid, enable);
Andrew Walbran318f5732018-11-20 16:23:42 +00002419
J-Alvescc542042024-07-24 19:13:22 +01002420 ret = 0;
2421
2422out:
2423 vm_unlock(&vm_locked);
Manish Pandey35e452f2021-02-18 21:36:34 +00002424 vcpu_unlock(&current_locked);
J-Alvescc542042024-07-24 19:13:22 +01002425
2426 return ret;
Andrew Walbran318f5732018-11-20 16:23:42 +00002427}
2428
2429/**
2430 * Returns the ID of the next pending interrupt for the calling vCPU, and
2431 * acknowledges it (i.e. marks it as no longer pending). Returns
2432 * HF_INVALID_INTID if there are no pending interrupts.
2433 */
Madhukar Pappireddyc64d0642024-08-07 16:55:46 -05002434uint32_t api_interrupt_get(struct vcpu_locked current_locked)
Andrew Walbran318f5732018-11-20 16:23:42 +00002435{
Daniel Boulby5df87962025-02-06 11:15:08 +00002436 return vcpu_virt_interrupt_get_pending_and_enabled(current_locked);
Andrew Walbran318f5732018-11-20 16:23:42 +00002437}
2438
2439/**
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002440 * Negotiate the FF-A version to be used for this FF-A instance.
2441 * See section 13.2 of the FF-A v1.2 ALP1 spec.
2442 *
2443 * Returns Hafnium's version number (`FFA_VERSION_COMPILED`) on success.
2444 * Returns `FFA_NOT_SUPPORTED` on error:
2445 * - The version is invalid (highest bit set).
2446 * - The requested version is incompatible.
2447 * - The version has already been negotiated and cannot be changed.
2448 */
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002449struct ffa_value api_ffa_version(struct vcpu *current,
Karl Meakin0e617d92024-04-05 12:55:22 +01002450 enum ffa_version requested_version)
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002451{
Karl Meakin0e617d92024-04-05 12:55:22 +01002452 static_assert(sizeof(enum ffa_version) == 4,
2453 "enum ffa_version must be 4 bytes wide");
2454
Karl Meakin0dba87e2025-03-24 17:36:04 +00002455 const struct ffa_value error = {.func = FFA_NOT_SUPPORTED};
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002456 struct vm_locked current_vm_locked;
2457
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002458 uint16_t compiled_major = ffa_version_get_major(FFA_VERSION_COMPILED);
2459 uint16_t compiled_minor = ffa_version_get_minor(FFA_VERSION_COMPILED);
2460 uint16_t requested_major;
2461 uint16_t requested_minor;
2462 uint16_t vm_major;
2463 uint16_t vm_minor;
2464
Karl Meakin0e617d92024-04-05 12:55:22 +01002465 if (!ffa_version_is_valid(requested_version)) {
2466 dlog_error(
2467 "FFA_VERSION: requested version %#x is invalid "
2468 "(highest bit must be zero)\n",
2469 requested_version);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002470 return error;
Andrew Walbran9fd29072020-04-22 12:12:14 +01002471 }
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002472
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002473 requested_major = ffa_version_get_major(requested_version);
2474 requested_minor = ffa_version_get_minor(requested_version);
2475
Karl Meakin0e617d92024-04-05 12:55:22 +01002476 if (!ffa_versions_are_compatible(requested_version,
2477 FFA_VERSION_COMPILED)) {
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002478 dlog_error(
2479 "FFA_VERSION: requested version v%u.%u is not "
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002480 "compatible with compiled version v%u.%u\n",
2481 requested_major, requested_minor, compiled_major,
2482 compiled_minor);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002483 return error;
J-Alves3cc9d6f2023-07-20 16:46:15 +01002484 }
2485
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002486 current_vm_locked = vm_lock(current->vm);
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002487 vm_major = ffa_version_get_major(current_vm_locked.vm->ffa_version);
2488 vm_minor = ffa_version_get_minor(current_vm_locked.vm->ffa_version);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002489
2490 if (current_vm_locked.vm->ffa_version_negotiated &&
2491 requested_version != current_vm_locked.vm->ffa_version) {
2492 vm_unlock(&current_vm_locked);
2493 dlog_error(
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002494 "FFA_VERSION: Cannot change FF-A version from v%u.%u "
2495 "to v%u.%u after other FF-A calls have been made\n",
2496 vm_major, vm_minor, requested_major, requested_minor);
Karl Meakin6eeec8e2024-03-07 18:07:20 +00002497 return error;
2498 }
2499
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002500 current_vm_locked.vm->ffa_version = requested_version;
2501 vm_unlock(&current_vm_locked);
2502
Karl Meakin0dba87e2025-03-24 17:36:04 +00002503 return (struct ffa_value){.func = FFA_VERSION_COMPILED};
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002504}
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01002505
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002506/**
Karl Meakin49ec1e42024-05-10 13:08:24 +01002507 * Helper for success return of FFA_FEATURES.
J-Alves6f72ca82021-11-01 12:34:58 +00002508 */
2509struct ffa_value api_ffa_feature_success(uint32_t arg2)
2510{
2511 return (struct ffa_value){
Karl Meakin49ec1e42024-05-10 13:08:24 +01002512 .func = FFA_SUCCESS_32,
2513 .arg1 = 0U,
2514 .arg2 = arg2,
2515 };
J-Alves6f72ca82021-11-01 12:34:58 +00002516}
2517
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002518static struct ffa_value ffa_features_function(uint32_t func,
2519 uint32_t input_property,
2520 struct vcpu *current)
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002521{
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002522 switch (func) {
J-Alves6f72ca82021-11-01 12:34:58 +00002523 /* Check support of the given Function ID. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002524 case FFA_ERROR_32:
2525 case FFA_SUCCESS_32:
2526 case FFA_INTERRUPT_32:
2527 case FFA_VERSION_32:
2528 case FFA_FEATURES_32:
2529 case FFA_RX_RELEASE_32:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002530 case FFA_RXTX_UNMAP_32:
Fuad Tabbae4efcc32020-07-16 15:37:27 +01002531 case FFA_PARTITION_INFO_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002532 case FFA_ID_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002533 case FFA_MSG_WAIT_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002534 case FFA_RUN_32:
J-Alves95fbb312024-03-20 15:19:16 +00002535 case FFA_MEM_DONATE_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002536 case FFA_MEM_DONATE_32:
2537 case FFA_MEM_LEND_32:
J-Alves95fbb312024-03-20 15:19:16 +00002538 case FFA_MEM_LEND_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002539 case FFA_MEM_SHARE_32:
J-Alves95fbb312024-03-20 15:19:16 +00002540 case FFA_MEM_SHARE_64:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002541 case FFA_MEM_RETRIEVE_RESP_32:
2542 case FFA_MEM_RELINQUISH_32:
2543 case FFA_MEM_RECLAIM_32:
J-Alvesff676c12022-05-13 17:25:33 +01002544 case FFA_MEM_FRAG_RX_32:
2545 case FFA_MEM_FRAG_TX_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002546 case FFA_MSG_SEND_DIRECT_RESP_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002547 case FFA_MSG_SEND_DIRECT_RESP_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002548 case FFA_MSG_SEND_DIRECT_REQ_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002549 case FFA_MSG_SEND_DIRECT_REQ_32:
Karl Meakinf923da32025-03-27 17:06:44 +00002550 return api_ffa_feature_success(0);
Karl Meakin0e617d92024-04-05 12:55:22 +01002551
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00002552 /* FF-A v1.1 features. */
2553 case FFA_SPM_ID_GET_32:
J-Alves6f72ca82021-11-01 12:34:58 +00002554 case FFA_NOTIFICATION_BITMAP_CREATE_32:
2555 case FFA_NOTIFICATION_BITMAP_DESTROY_32:
2556 case FFA_NOTIFICATION_BIND_32:
2557 case FFA_NOTIFICATION_UNBIND_32:
2558 case FFA_NOTIFICATION_SET_32:
2559 case FFA_NOTIFICATION_GET_32:
2560 case FFA_NOTIFICATION_INFO_GET_64:
Federico Recanati25053ee2022-03-14 15:01:53 +01002561 case FFA_MSG_SEND2_32:
Karl Meakin0e617d92024-04-05 12:55:22 +01002562 if (FFA_VERSION_1_1 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002563 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002564 }
Karl Meakinf923da32025-03-27 17:06:44 +00002565 return api_ffa_feature_success(0);
Karl Meakin0e617d92024-04-05 12:55:22 +01002566
Kathleen Capellae4fe2962023-09-01 17:08:47 -04002567 /* FF-A v1.2 features. */
2568 case FFA_CONSOLE_LOG_32:
2569 case FFA_CONSOLE_LOG_64:
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -08002570 case FFA_PARTITION_INFO_GET_REGS_64:
Kathleen Capella41fea932023-06-23 17:39:28 -04002571 case FFA_MSG_SEND_DIRECT_REQ2_64:
Kathleen Capella087e5022023-09-07 18:04:15 -04002572 case FFA_MSG_SEND_DIRECT_RESP2_64:
Karl Meakin0e617d92024-04-05 12:55:22 +01002573 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002574 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002575 }
2576
Karl Meakin49ec1e42024-05-10 13:08:24 +01002577 return api_ffa_feature_success(0);
2578
Karl Meakin5a222642024-06-20 10:23:37 +01002579 /* These functions are only supported on S-EL0 partitions. */
2580 case FFA_MEM_PERM_GET_32:
2581 case FFA_MEM_PERM_SET_32:
2582 case FFA_MEM_PERM_GET_64:
2583 case FFA_MEM_PERM_SET_64:
2584 if (!(vm_id_is_current_world(current->vm->id) &&
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002585 current->vm->el0_partition)) {
Karl Meakin5a222642024-06-20 10:23:37 +01002586 dlog_verbose(
Karl Meakinf923da32025-03-27 17:06:44 +00002587 "FFA_FEATURES: %s is only supported on S-EL0 "
Karl Meakin5a222642024-06-20 10:23:37 +01002588 "partitions\n",
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002589 ffa_func_name(func));
Karl Meakin5a222642024-06-20 10:23:37 +01002590 return ffa_error(FFA_NOT_SUPPORTED);
2591 }
2592 return api_ffa_feature_success(0);
2593
Karl Meakin1a8c0cd2024-06-20 10:26:12 +01002594 case FFA_SECONDARY_EP_REGISTER_64:
2595 if (FFA_VERSION_COMPILED < FFA_VERSION_1_1) {
2596 return ffa_error(FFA_NOT_SUPPORTED);
2597 }
2598
2599 if (!(vm_id_is_current_world(current->vm->id) &&
2600 current->vm->vcpu_count > 1)) {
2601 dlog_verbose(
2602 "FFA_FEATURE: %s is only supported on SPs with "
2603 "more than 1 vCPU\n",
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002604 ffa_func_name(func));
Karl Meakin1a8c0cd2024-06-20 10:26:12 +01002605 return ffa_error(FFA_NOT_SUPPORTED);
2606 }
2607 return api_ffa_feature_success(0);
2608
Karl Meakin650cb142024-06-20 10:31:57 +01002609 case FFA_YIELD_32:
2610 if (!vm_id_is_current_world(current->vm->id)) {
2611 dlog_verbose(
2612 "FFA_FEATURES: %s is only supported at secure "
2613 "virtual FF-A instance\n",
2614 ffa_func_name(FFA_YIELD_32));
2615 return ffa_error(FFA_NOT_SUPPORTED);
2616 }
2617 return api_ffa_feature_success(0);
2618
Karl Meakin0fd67292024-02-06 17:33:05 +00002619 case FFA_RXTX_MAP_64: {
2620 uint32_t arg2 = 0;
2621 struct ffa_features_rxtx_map_params params = {
2622 .min_buf_size = FFA_RXTX_MAP_MIN_BUF_4K,
2623 .mbz = 0,
2624 .max_buf_size =
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002625 (current->vm->ffa_version >= FFA_VERSION_1_2)
Karl Meakin0fd67292024-02-06 17:33:05 +00002626 ? FFA_RXTX_MAP_MAX_BUF_PAGE_COUNT
2627 : 0,
2628 };
2629
2630 memcpy_s(&arg2, sizeof(arg2), &params, sizeof(params));
Karl Meakin49ec1e42024-05-10 13:08:24 +01002631 return api_ffa_feature_success(arg2);
Karl Meakin0fd67292024-02-06 17:33:05 +00002632 }
2633
J-Alves95fbb312024-03-20 15:19:16 +00002634 case FFA_MEM_RETRIEVE_REQ_64:
Karl Meakin49ec1e42024-05-10 13:08:24 +01002635 case FFA_MEM_RETRIEVE_REQ_32: {
2636 if (ANY_BITS_SET(input_property,
2637 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_HI_BIT,
2638 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_LO_BIT) ||
2639 IS_BIT_SET(input_property,
2640 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_BIT)) {
2641 dlog_warning(
2642 "FFA_FEATURES: Bits[%u:%u] and Bit[%u] of "
2643 "input_property should be 0 (input_property = "
2644 "%#x)\n",
2645 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_HI_BIT,
2646 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_LO_BIT,
2647 FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_BIT,
Karl Meakin34b8ae92023-01-13 13:33:07 +00002648 input_property);
Karl Meakin34b8ae92023-01-13 13:33:07 +00002649 }
2650
Karl Meakin5be8dfa2025-03-27 14:58:43 +00002651 if (current->vm->ffa_version >= FFA_VERSION_1_1 &&
Karl Meakin0e617d92024-04-05 12:55:22 +01002652 (input_property &
2653 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT) == 0U) {
Karl Meakin4e8e4792024-07-05 16:28:42 +01002654 dlog_verbose(
2655 "FFA_FEATURES: NS bit support must be 1\n");
Karl Meakin6fd6c1d2024-05-13 12:09:13 +01002656 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin34b8ae92023-01-13 13:33:07 +00002657 }
2658
2659 return api_ffa_feature_success(
2660 FFA_FEATURES_MEM_RETRIEVE_REQ_BUFFER_SUPPORT |
Karl Meakin49ec1e42024-05-10 13:08:24 +01002661 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT |
Karl Meakin34b8ae92023-01-13 13:33:07 +00002662 FFA_FEATURES_MEM_RETRIEVE_REQ_HYPERVISOR_SUPPORT);
Karl Meakin49ec1e42024-05-10 13:08:24 +01002663 }
J-Alves6f72ca82021-11-01 12:34:58 +00002664
Madhukar Pappireddy04cf9e82025-03-17 17:32:02 -05002665 /*
2666 * This function is restricted to the secure virtual FF-A instance (i.e.
2667 * only report success to SPs).
2668 */
2669 case FFA_ABORT_32:
2670 case FFA_ABORT_64:
2671 if (ffa_is_vm_id(current->vm->id)) {
2672 dlog_verbose(
2673 "FFA_FEATURES: %s is only supported at secure "
2674 "virtual FF-A instance\n",
2675 ffa_func_name(FFA_YIELD_32));
2676 return ffa_error(FFA_NOT_SUPPORTED);
2677 }
2678 return api_ffa_feature_success(0);
2679
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002680 default:
2681 return ffa_error(FFA_NOT_SUPPORTED);
2682 }
2683}
2684
2685static struct ffa_value ffa_features_feature(enum ffa_feature_id feature,
2686 uint32_t input_property,
2687 struct vcpu *current)
2688{
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002689 if (ANY_BITS_SET(feature, FFA_FEATURES_FEATURE_MBZ_HI_BIT,
2690 FFA_FEATURES_FEATURE_MBZ_LO_BIT)) {
2691 dlog_verbose(
2692 "FFA_FEATURES: feature ID %#x is invalid (bits [%u:%u] "
2693 "must be zero)\n",
2694 feature, FFA_FEATURES_FEATURE_MBZ_HI_BIT,
2695 FFA_FEATURES_FEATURE_MBZ_LO_BIT);
2696 return ffa_error(FFA_NOT_SUPPORTED);
2697 }
2698 if (input_property != 0) {
2699 dlog_verbose(
2700 "FFA_FEATURES: input_property must be 0 "
2701 "(input_property = %#x)\n",
2702 input_property);
2703 return ffa_error(FFA_NOT_SUPPORTED);
2704 }
2705
2706 switch (feature) {
J-Alves6f72ca82021-11-01 12:34:58 +00002707 /* Check support of a feature provided respective feature ID. */
Karl Meakin17c9ad32024-04-12 16:41:00 +01002708
2709 /*
2710 * For NPI and MEI, report the IDs as supported only to partitions at
2711 * the virtual FF-A instances.
2712 */
J-Alves6f72ca82021-11-01 12:34:58 +00002713 case FFA_FEATURE_NPI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002714 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002715 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002716 }
2717
Karl Meakin147a4e82025-03-27 15:12:27 +00002718 if (current->vm->el0_partition) {
Karl Meakinf1ed5f12024-02-22 15:57:36 +00002719 return ffa_error(FFA_NOT_SUPPORTED);
2720 }
Karl Meakin17c9ad32024-04-12 16:41:00 +01002721 if (!vm_id_is_current_world(current->vm->id)) {
2722 return ffa_error(FFA_NOT_SUPPORTED);
2723 }
J-Alves6f72ca82021-11-01 12:34:58 +00002724 return api_ffa_feature_success(HF_NOTIFICATION_PENDING_INTID);
Karl Meakin17c9ad32024-04-12 16:41:00 +01002725
2726 case FFA_FEATURE_MEI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002727 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002728 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002729 }
Karl Meakin147a4e82025-03-27 15:12:27 +00002730 if (current->vm->el0_partition) {
J-Alvesc4d9ae82024-05-14 10:15:03 +01002731 return ffa_error(FFA_NOT_SUPPORTED);
2732 }
Karl Meakin17c9ad32024-04-12 16:41:00 +01002733 if (!vm_id_is_current_world(current->vm->id)) {
2734 return ffa_error(FFA_NOT_SUPPORTED);
2735 }
2736 return api_ffa_feature_success(HF_MANAGED_EXIT_INTID);
2737
J-Alves6f72ca82021-11-01 12:34:58 +00002738 case FFA_FEATURE_SRI:
Karl Meakin0e617d92024-04-05 12:55:22 +01002739 if (FFA_VERSION_1_2 > FFA_VERSION_COMPILED) {
Karl Meakin4271ff92024-05-13 12:33:15 +01002740 return ffa_error(FFA_NOT_SUPPORTED);
Karl Meakin0e617d92024-04-05 12:55:22 +01002741 }
2742
Karl Meakincb6642c2024-02-27 14:43:45 +00002743 if (!ffa_is_vm_id(current->vm->id)) {
2744 return ffa_error(FFA_NOT_SUPPORTED);
2745 }
J-Alves6f72ca82021-11-01 12:34:58 +00002746 return api_ffa_feature_success(HF_SCHEDULE_RECEIVER_INTID);
Karl Meakin0e617d92024-04-05 12:55:22 +01002747
J-Alves6f72ca82021-11-01 12:34:58 +00002748 /* Platform specific feature support. */
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002749 default:
Karl Meakin4271ff92024-05-13 12:33:15 +01002750 return ffa_error(FFA_NOT_SUPPORTED);
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002751 }
2752}
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002753
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002754/**
Karl Meakin9c5b1d32024-06-24 12:10:36 +01002755 * Discovery function returning information about the implementation of optional
2756 * FF-A interfaces. See section 13.3 of the FF-A v1.2 ALP1 spec.
2757 *
2758 * `function_or_feature_id` is interpreted as either a function ID or a feature
2759 * ID, depending on the value of bit 31.
2760 * When it is a feature ID, bits [30:8] MBZ and input_property MBZ.
2761 *
2762 * Returns `FFA_SUCCESS` if the interface is supported.
2763 * Returns `FFA_NOT_SUPPORTED` if the interface is not supported or the
2764 * parameters are invalid.
2765 */
2766struct ffa_value api_ffa_features(uint32_t function_or_feature_id,
2767 uint32_t input_property, struct vcpu *current)
2768{
2769 return IS_BIT_UNSET(function_or_feature_id, FFA_FEATURES_FEATURE_BIT)
2770 ? ffa_features_feature(function_or_feature_id,
2771 input_property, current)
2772 : ffa_features_function(function_or_feature_id,
2773 input_property, current);
2774}
2775
2776/**
Kathleen Capella41fea932023-06-23 17:39:28 -04002777 * FF-A specification states that x2/w2 Must Be Zero for FFA_MSG_SEND_DIRECT_REQ
2778 * and FFA_MSG_SEND_DIRECT_RESP interfaces when used for partition messages. See
2779 * FF-A v1.2 Table 16.6: FFA_MSG_SEND_DIRECT_REQ function syntax.
J-Alves645eabe2021-02-22 16:08:27 +00002780 */
2781static inline bool api_ffa_dir_msg_is_arg2_zero(struct ffa_value args)
2782{
2783 return args.arg2 == 0U;
2784}
2785
2786/**
J-Alves76d99af2021-03-10 17:42:11 +00002787 * Limits size of arguments in ffa_value structure to 32-bit.
2788 */
2789static struct ffa_value api_ffa_value_copy32(struct ffa_value args)
2790{
2791 return (struct ffa_value){
2792 .func = (uint32_t)args.func,
2793 .arg1 = (uint32_t)args.arg1,
Karl Meakin06e8b732024-09-20 18:26:49 +01002794 .arg2 = (uint32_t)args.arg2,
J-Alves76d99af2021-03-10 17:42:11 +00002795 .arg3 = (uint32_t)args.arg3,
2796 .arg4 = (uint32_t)args.arg4,
2797 .arg5 = (uint32_t)args.arg5,
2798 .arg6 = (uint32_t)args.arg6,
2799 .arg7 = (uint32_t)args.arg7,
2800 };
2801}
2802
2803/**
Kathleen Capella41fea932023-06-23 17:39:28 -04002804 * Helper to copy direct message payload, depending on SMC used, direct
Karl Meakin06e8b732024-09-20 18:26:49 +01002805 * messaging interface used, and expected registers size. Can be used for both
2806 * framework messages and standard messages.
J-Alves76d99af2021-03-10 17:42:11 +00002807 */
2808static struct ffa_value api_ffa_dir_msg_value(struct ffa_value args)
2809{
Karl Meakin06e8b732024-09-20 18:26:49 +01002810 switch (args.func) {
2811 case FFA_MSG_SEND_DIRECT_REQ_32:
2812 case FFA_MSG_SEND_DIRECT_RESP_32:
2813 args = api_ffa_value_copy32(args);
2814 if (!ffa_is_framework_msg(args)) {
2815 args.arg2 = 0;
2816 }
2817 break;
J-Alves76d99af2021-03-10 17:42:11 +00002818
Karl Meakin06e8b732024-09-20 18:26:49 +01002819 case FFA_MSG_SEND_DIRECT_REQ_64:
2820 case FFA_MSG_SEND_DIRECT_RESP_64:
2821 if (!ffa_is_framework_msg(args)) {
2822 args.arg2 = 0;
2823 }
2824 break;
Kathleen Capella41fea932023-06-23 17:39:28 -04002825
Karl Meakin06e8b732024-09-20 18:26:49 +01002826 case FFA_MSG_SEND_DIRECT_REQ2_64:
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04002827 args.extended_val.valid = true;
Karl Meakin06e8b732024-09-20 18:26:49 +01002828 break;
Kathleen Capelladb6a08b2023-10-04 13:42:39 -04002829
Karl Meakin06e8b732024-09-20 18:26:49 +01002830 case FFA_MSG_SEND_DIRECT_RESP2_64:
Kathleen Capella087e5022023-09-07 18:04:15 -04002831 args.arg2 = 0;
2832 args.arg3 = 0;
Karl Meakin06e8b732024-09-20 18:26:49 +01002833 break;
2834 default:
2835 panic("Invalid direct message function %#x\n", args.func);
2836 break;
Kathleen Capella087e5022023-09-07 18:04:15 -04002837 }
2838
Kathleen Capella41fea932023-06-23 17:39:28 -04002839 return args;
2840}
2841
Karl Meakinfb9c2a22024-08-19 14:29:37 +01002842/**
2843 * Return a pointer to the first UUID in `uuids` that is equal to
2844 * `target_uuid`. If `target_uuid` is 0-0-0-0, it matches any UUID.
2845 */
2846static struct ffa_uuid *ffa_uuid_find(struct ffa_uuid *uuids,
2847 size_t uuids_count,
2848 struct ffa_uuid target_uuid)
2849{
2850 if (ffa_uuid_is_null(&target_uuid)) {
2851 return &uuids[0];
2852 }
2853
2854 for (size_t i = 0; i < uuids_count; i++) {
2855 if (ffa_uuid_is_null(&uuids[i])) {
2856 break;
2857 }
2858 if (ffa_uuid_equal(&target_uuid, &uuids[i])) {
2859 return &uuids[i];
2860 }
2861 }
2862 return NULL;
2863}
2864
Kathleen Capella41fea932023-06-23 17:39:28 -04002865static bool api_ffa_dir_msg_req2_is_uuid_valid(struct vm *receiver_vm,
2866 struct ffa_value args)
2867{
2868 struct ffa_uuid target_uuid;
2869
Karl Meakin9478e322024-09-23 17:47:09 +01002870 ffa_uuid_from_u64x2(args.arg2, args.arg3, &target_uuid);
Kathleen Capella41fea932023-06-23 17:39:28 -04002871
Karl Meakinfb9c2a22024-08-19 14:29:37 +01002872 return ffa_uuid_find(receiver_vm->uuids, PARTITION_MAX_UUIDS,
2873 target_uuid) != NULL;
J-Alves76d99af2021-03-10 17:42:11 +00002874}
2875
2876/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002877 * Send an FF-A direct message request.
Kathleen Capella41fea932023-06-23 17:39:28 -04002878 * This handler covers both FFA_MSG_SEND_DIRECT_REQ_32/64
2879 * and FFA_MSG_SEND_DIRECT_REQ2_64 (introduced in FF-A v1.2) with function-based
2880 * checks to accomodate for the difference between the ABIs.
2881 *
2882 * FFA_MSG_SEND_DIRECT_REQ2_64 works mostly the same as
2883 * FFA_MSG_SEND_DIRECT_REQ_32/64, but adds the ability to send a direct message
2884 * request to a specified UUID within a partition and the usage of an extended
2885 * range of registers (x4-x17, instead of x4-x7) to be used as part of the
2886 * message payload.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002887 */
Karl Meakin13f09812024-10-28 16:33:23 +00002888struct ffa_value api_ffa_msg_send_direct_req(struct ffa_value args,
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002889 struct vcpu *current,
2890 struct vcpu **next)
2891{
Karl Meakin13f09812024-10-28 16:33:23 +00002892 ffa_id_t sender_vm_id = ffa_sender(args);
2893 ffa_id_t receiver_vm_id = ffa_receiver(args);
J-Alves17228f72021-04-20 17:13:19 +01002894 struct ffa_value ret;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002895 struct vm *receiver_vm;
J-Alves6e2abc62021-12-02 14:58:56 +00002896 struct vm_locked receiver_locked;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002897 struct vcpu *receiver_vcpu;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002898 struct vcpu_locked current_locked;
2899 struct vcpu_locked receiver_vcpu_locked;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002900 struct two_vcpu_locked vcpus_locked;
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05002901 enum vcpu_state next_state = VCPU_STATE_RUNNING;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002902
Kathleen Capella41fea932023-06-23 17:39:28 -04002903 if ((args.func == FFA_MSG_SEND_DIRECT_REQ_32 ||
2904 args.func == FFA_MSG_SEND_DIRECT_REQ_64) &&
Karl Meakin06e8b732024-09-20 18:26:49 +01002905 !ffa_is_framework_msg(args) &&
Kathleen Capella41fea932023-06-23 17:39:28 -04002906 !api_ffa_dir_msg_is_arg2_zero(args)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002907 dlog_verbose("Direct messaging: w2 must be zero (w2 = %#lx)\n",
2908 args.arg2);
J-Alves645eabe2021-02-22 16:08:27 +00002909 return ffa_error(FFA_INVALID_PARAMETERS);
2910 }
2911
Karl Meakin06e8b732024-09-20 18:26:49 +01002912 if (ffa_is_framework_msg(args) &&
Madhukar Pappireddy8afab732025-02-10 09:39:36 -06002913 ffa_direct_msg_handle_framework_msg(args, &ret, current, next)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002914 return ret;
2915 }
2916
Karl Meakin117c8082024-12-04 16:03:28 +00002917 if (!ffa_direct_msg_is_direct_request_valid(current, sender_vm_id,
2918 receiver_vm_id)) {
J-Alvese0caac32022-12-19 14:37:08 +00002919 dlog_verbose("Invalid direct message request.\n");
J-Alvesaa336102021-03-01 13:02:45 +00002920 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002921 }
2922
Karl Meakin117c8082024-12-04 16:03:28 +00002923 if (ffa_direct_msg_direct_request_forward(receiver_vm_id, args, &ret)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002924 dlog_verbose("Direct message request forwarded\n");
J-Alves17228f72021-04-20 17:13:19 +01002925 return ret;
2926 }
2927
J-Alvesbd32c972024-02-02 16:20:04 +00002928 ret = api_ffa_interrupt_return(0);
J-Alves17228f72021-04-20 17:13:19 +01002929
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002930 receiver_vm = vm_find(receiver_vm_id);
2931 if (receiver_vm == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002932 dlog_verbose("Invalid Receiver!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002933 return ffa_error(FFA_INVALID_PARAMETERS);
2934 }
2935
Kathleen Capella41fea932023-06-23 17:39:28 -04002936 if (args.func == FFA_MSG_SEND_DIRECT_REQ2_64 &&
2937 !api_ffa_dir_msg_req2_is_uuid_valid(receiver_vm, args)) {
2938 dlog_verbose("UUID unrecognized for this VM\n");
2939 return ffa_error(FFA_INVALID_PARAMETERS);
2940 }
2941
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002942 /*
J-Alves439ac972021-11-18 17:32:03 +00002943 * Check if sender supports sending direct message req, and if
2944 * receiver supports receipt of direct message requests.
2945 */
Karl Meakin117c8082024-12-04 16:03:28 +00002946 if (!ffa_direct_msg_is_direct_request_supported(
2947 current->vm, receiver_vm, args.func)) {
Karl Meakin06e8b732024-09-20 18:26:49 +01002948 dlog_verbose("Direct message request not supported\n");
J-Alves439ac972021-11-18 17:32:03 +00002949 return ffa_error(FFA_DENIED);
2950 }
2951
2952 /*
Olivier Deprezc13a8692022-04-08 17:47:14 +02002953 * Per FF-A EAC spec section 4.4.1 the firmware framework supports
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002954 * UP (migratable) or MP partitions with a number of vCPUs matching the
2955 * number of PEs in the system. It further states that MP partitions
2956 * accepting direct request messages cannot migrate.
2957 */
J-Alvesad6a0432021-04-09 16:06:21 +01002958 receiver_vcpu = api_ffa_get_vm_vcpu(receiver_vm, current);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002959 if (receiver_vcpu == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002960 dlog_verbose("Invalid vCPU!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002961 return ffa_error(FFA_INVALID_PARAMETERS);
2962 }
2963
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002964 /*
2965 * If VM must be locked, it must be done before any of its vCPUs are
2966 * locked.
2967 */
J-Alves6e2abc62021-12-02 14:58:56 +00002968 receiver_locked = vm_lock(receiver_vm);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06002969
2970 /* Lock both vCPUs at once to avoid deadlock. */
2971 vcpus_locked = vcpu_lock_both(current, receiver_vcpu);
2972 current_locked = vcpus_locked.vcpu1;
2973 receiver_vcpu_locked = vcpus_locked.vcpu2;
2974
Madhukar Pappireddye624cb12025-06-27 15:42:07 -05002975 switch (vm_read_state(receiver_vm)) {
2976 case VM_STATE_NULL:
2977 ret = ffa_error(FFA_INVALID_PARAMETERS);
2978 goto out;
2979 case VM_STATE_CREATED:
2980 ret = ffa_error(FFA_BUSY);
2981 goto out;
2982 case VM_STATE_ABORTING:
2983 if (receiver_vcpu->state != VCPU_STATE_NULL &&
2984 receiver_vcpu->state != VCPU_STATE_ABORTED &&
2985 receiver_vcpu->state != VCPU_STATE_STOPPED) {
2986 dlog_verbose(
2987 "Receiver VM %#x aborted, cannot run vCPU %u\n",
2988 receiver_vcpu->vm->id,
2989 vcpu_index(receiver_vcpu));
2990 CHECK(vcpu_state_set(receiver_vcpu_locked,
2991 VCPU_STATE_ABORTED));
2992 }
2993 /* Let the subsequent checks handle further conditions. */
2994 break;
2995 case VM_STATE_RUNNING:
2996 [[fallthrough]];
2997 default:
2998 /* Let the subsequent checks handle further conditions. */
2999 break;
3000 }
3001
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003002 /*
3003 * If destination vCPU is executing or already received an
3004 * FFA_MSG_SEND_DIRECT_REQ then return to caller hinting recipient is
3005 * busy. There is a brief period of time where the vCPU state has
3006 * changed but regs_available is still false thus consider this case as
3007 * the vCPU not yet ready to receive a direct message request.
3008 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003009 if (is_ffa_direct_msg_request_ongoing(receiver_vcpu_locked) ||
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003010 receiver_vcpu->state == VCPU_STATE_RUNNING ||
3011 !receiver_vcpu->regs_available) {
J-Alves88a13542021-12-14 15:39:52 +00003012 dlog_verbose("Receiver is busy with another request.\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003013 ret = ffa_error(FFA_BUSY);
3014 goto out;
3015 }
3016
Karl Meakin117c8082024-12-04 16:03:28 +00003017 if (!ffa_cpu_cycles_check_runtime_state_transition(
J-Alves7ea3f7e2024-03-27 11:05:11 +00003018 current_locked, sender_vm_id, HF_INVALID_VM_ID,
3019 receiver_vcpu_locked, args.func, &next_state)) {
3020 ret = ffa_error(FFA_DENIED);
3021 goto out;
3022 }
3023
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003024 switch (receiver_vcpu->state) {
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003025 case VCPU_STATE_ABORTED:
3026 if (receiver_vcpu->vm->lifecycle_support) {
3027 ret = ffa_error(FFA_BUSY);
3028 } else {
3029 ret = ffa_error(FFA_ABORTED);
3030 }
3031 goto out;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003032 case VCPU_STATE_OFF:
3033 case VCPU_STATE_RUNNING:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003034 case VCPU_STATE_STARTING:
3035 case VCPU_STATE_CREATED:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003036 case VCPU_STATE_BLOCKED_INTERRUPT:
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003037 case VCPU_STATE_BLOCKED:
3038 case VCPU_STATE_PREEMPTED:
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003039 case VCPU_STATE_STOPPED:
3040 case VCPU_STATE_STOPPING:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003041 ret = ffa_error(FFA_BUSY);
3042 goto out;
Madhukar Pappireddyd6c055d2025-05-08 15:35:46 -05003043 case VCPU_STATE_NULL:
3044 ret = ffa_error(FFA_INVALID_PARAMETERS);
3045 goto out;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003046 case VCPU_STATE_WAITING:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003047 /*
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05003048 * We expect target vCPU to be in WAITING state after either
3049 * having called ffa_msg_wait or sent a direct message response.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003050 */
3051 break;
3052 }
3053
Madhukar Pappireddy32424db2024-09-25 15:06:19 -05003054 /* Inject timer interrupt if timer has expired. */
Daniel Boulbyd49d0772025-01-15 11:19:36 +00003055 api_inject_arch_timer_interrupt(receiver_vcpu_locked);
Madhukar Pappireddy106bfc32024-09-25 15:47:11 -05003056 timer_migrate_to_other_cpu(current->cpu, receiver_vcpu_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003057
3058 /* The receiver vCPU runs upon direct message invocation */
3059 receiver_vcpu->cpu = current->cpu;
Madhukar Pappireddy5388dd92025-02-10 11:24:19 -06003060 vcpu_dir_req_set_state(receiver_vcpu_locked,
3061 (args.func == FFA_MSG_SEND_DIRECT_REQ2_64),
3062 sender_vm_id, api_ffa_dir_msg_value(args));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003063
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003064 assert(!vm_id_is_current_world(current->vm->id) ||
3065 next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05003066 CHECK(vcpu_state_set(current_locked, VCPU_STATE_BLOCKED));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003067
Karl Meakin117c8082024-12-04 16:03:28 +00003068 ffa_direct_msg_wind_call_chain_ffa_direct_req(
Raghu Krishnamurthya9ccf122023-03-27 20:42:01 -07003069 current_locked, receiver_vcpu_locked, sender_vm_id);
Madhukar Pappireddy49fe6702022-06-21 17:52:23 -05003070
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003071 /* Switch to receiver vCPU targeted to by direct msg request */
3072 *next = receiver_vcpu;
3073
J-Alves6e2abc62021-12-02 14:58:56 +00003074 if (!receiver_locked.vm->el0_partition) {
3075 /*
3076 * If the scheduler in the system is giving CPU cycles to the
3077 * receiver, due to pending notifications, inject the NPI
3078 * interrupt. Following call assumes that '*next' has been set
3079 * to receiver_vcpu.
3080 */
Karl Meakin117c8082024-12-04 16:03:28 +00003081 ffa_interrupts_inject_notification_pending_interrupt(
Daniel Boulbyd49d0772025-01-15 11:19:36 +00003082 receiver_vcpu_locked, receiver_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00003083 }
3084
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003085 /*
3086 * Since this flow will lead to a VM switch, the return value will not
3087 * be applied to current vCPU.
3088 */
3089
3090out:
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003091 vcpu_unlock(&receiver_vcpu_locked);
J-Alves6e2abc62021-12-02 14:58:56 +00003092 vm_unlock(&receiver_locked);
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003093 vcpu_unlock(&current_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003094
3095 return ret;
3096}
3097
3098/**
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003099 * Resume the target vCPU after the current vCPU sent a direct response.
3100 * Current vCPU moves to waiting state.
3101 */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003102void api_ffa_resume_direct_resp_target(struct vcpu_locked current_locked,
3103 struct vcpu **next,
J-Alves19e20cf2023-08-02 12:48:55 +01003104 ffa_id_t receiver_vm_id,
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003105 struct ffa_value to_ret,
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003106 bool is_nwd_call_chain,
3107 enum vcpu_state to_state)
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003108{
Karl Meakinfa1dcb82025-02-10 16:47:50 +00003109 if (ffa_direct_msg_is_spmd_lp_id(receiver_vm_id) ||
Raghu Krishnamurthya9ccf122023-03-27 20:42:01 -07003110 !vm_id_is_current_world(receiver_vm_id)) {
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003111 *next = api_switch_to_other_world(current_locked, to_ret,
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003112 to_state);
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003113
3114 /* End of NWd scheduled call chain. */
3115 assert(!is_nwd_call_chain ||
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003116 (current_locked.vcpu->call_chain.prev_node == NULL));
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003117 } else if (receiver_vm_id == HF_PRIMARY_VM_ID) {
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003118 *next = api_switch_to_primary(current_locked, to_ret, to_state);
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003119 } else if (vm_id_is_current_world(receiver_vm_id)) {
3120 /*
3121 * It is expected the receiver_vm_id to be from an SP, otherwise
Karl Meakin117c8082024-12-04 16:03:28 +00003122 * 'ffa_direct_msg_is_direct_response_valid' should have
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003123 * made function return error before getting to this point.
3124 */
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003125 *next = api_switch_to_vm(current_locked, to_ret, to_state,
3126 receiver_vm_id);
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003127 } else {
3128 panic("Invalid direct message response invocation");
3129 }
3130}
3131
Karl Meakin50ef9112024-10-28 16:41:44 +00003132static bool api_ffa_msg_send_direct_resp_validate_args(struct ffa_value args,
3133 struct vcpu *current)
3134{
3135 ffa_id_t sender_vm_id = ffa_sender(args);
3136 ffa_id_t receiver_vm_id = ffa_receiver(args);
3137
3138 /*
3139 * If using FFA_MSG_SEND_DIRECT_RESP, the caller's
3140 * - x2 MBZ for partition messages
3141 * - x8-x17 SBZ if caller's FF-A version >= FF-A v1.2
3142 */
3143 if (args.func != FFA_MSG_SEND_DIRECT_RESP2_64) {
3144 if (!ffa_is_framework_msg(args) &&
3145 !api_ffa_dir_msg_is_arg2_zero(args)) {
3146 dlog_verbose("%s: w2 Must Be Zero",
3147 ffa_func_name(args.func));
3148 return false;
3149 }
3150
3151 if (current->vm->ffa_version >= FFA_VERSION_1_2 &&
3152 !api_extended_args_are_zero(&args)) {
3153 return false;
3154 }
3155 }
3156
Karl Meakin117c8082024-12-04 16:03:28 +00003157 if (!ffa_direct_msg_is_direct_response_valid(current, sender_vm_id,
3158 receiver_vm_id)) {
Karl Meakin50ef9112024-10-28 16:41:44 +00003159 dlog_verbose("Invalid direct response call.\n");
3160 return false;
3161 }
3162
3163 return true;
3164}
3165
3166static bool api_ffa_msg_send_direct_resp_validate_ongoing_request(
3167 struct ffa_value args, struct vcpu_locked current_locked)
3168{
3169 bool req_framework =
3170 current_locked.vcpu->direct_request_origin.is_framework;
3171 bool resp_framework = ffa_is_framework_msg(args);
3172 bool received_req2 =
3173 current_locked.vcpu->direct_request_origin.is_ffa_req2;
3174
3175 if (!is_ffa_direct_msg_request_ongoing(current_locked)) {
3176 return false;
3177 }
3178
3179 if (req_framework && !resp_framework) {
3180 dlog_verbose(
3181 "Mismatch in framework message bit: request was a %s "
3182 "message, but response is a %s message\n",
3183 req_framework ? "framework" : "non-framework",
3184 resp_framework ? "framework" : "non-framework");
3185 return false;
3186 }
3187
3188 if (args.func != FFA_MSG_SEND_DIRECT_RESP2_64 && received_req2) {
3189 dlog_verbose(
3190 "FFA_MSG_SEND_DIRECT_RESP must be used with "
3191 "FFA_MSG_SEND_DIRECT_REQ\n");
3192 return false;
3193 }
3194
3195 if (args.func == FFA_MSG_SEND_DIRECT_RESP2_64 && !received_req2) {
3196 dlog_verbose(
3197 "FFA_MSG_SEND_DIRECT_RESP2 must be used with "
3198 "FFA_MSG_SEND_DIRECT_REQ2\n");
3199 return false;
3200 }
3201
3202 return true;
3203}
3204
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05003205/**
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003206 * Unwind a direct message call chain and resume the target vCPU when sending a
3207 * direct response.
3208 */
3209void api_direct_resp_unwind_call_chain_resume_target(
3210 struct vcpu_locked *current_locked, struct vcpu **next,
3211 struct vcpu_locked *next_locked, struct ffa_value to_ret,
3212 enum vcpu_state to_state)
3213{
3214 struct two_vcpu_locked vcpus_locked;
3215 struct vcpu *current;
3216
3217 /* Ensure caller and callee vCPUs are valid */
3218 assert(current_locked != NULL && next_locked != NULL && next != NULL);
3219
3220 current = current_locked->vcpu;
3221 assert(current->direct_request_origin.vm_id != HF_INVALID_VM_ID);
3222
3223 api_ffa_resume_direct_resp_target(*current_locked, next,
3224 current->direct_request_origin.vm_id,
3225 to_ret, false, to_state);
3226
3227 /* Clear direct request origin vm_id and request type for the caller. */
3228 current->direct_request_origin.is_ffa_req2 = false;
3229 current->direct_request_origin.vm_id = HF_INVALID_VM_ID;
3230
3231 /*
3232 * Unlock current vCPU to allow it to be locked together with next
3233 * vcpu.
3234 */
3235 vcpu_unlock(current_locked);
3236
3237 /* Lock both vCPUs at once to avoid deadlock. */
3238 vcpus_locked = vcpu_lock_both(current, *next);
3239 *current_locked = vcpus_locked.vcpu1;
3240 *next_locked = vcpus_locked.vcpu2;
3241
3242 /* Inject timer interrupt if timer has expired. */
3243 api_inject_arch_timer_interrupt(*next_locked);
3244 ffa_direct_msg_unwind_call_chain_ffa_direct_resp(*current_locked,
3245 *next_locked);
3246
3247 /* Schedule the receiver's vCPU now. */
3248 CHECK(vcpu_state_set(*next_locked, VCPU_STATE_RUNNING));
3249}
3250
3251/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003252 * Send an FF-A direct message response.
Kathleen Capella087e5022023-09-07 18:04:15 -04003253 * This handler covers both FFA_MSG_SEND_DIRECT_RESP_32/64
3254 * and FFA_MSG_SEND_DIRECT_RESP2_64 (introduced in FF-A v1.2) with
3255 * function-based checks to accomodate for the difference between the ABIs.
3256 *
3257 * FFA_MSG_SEND_DIRECT_RESP2_64 is used to respond to requests sent via
3258 * FFA_MSG_SEND_DIRECT_REQ2_64 and adds the usage of an extended range
3259 * of registers (x4-x17, instead of x4-x7) to be used as part of the
3260 * message payload.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003261 */
Karl Meakin13f09812024-10-28 16:33:23 +00003262struct ffa_value api_ffa_msg_send_direct_resp(struct ffa_value args,
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003263 struct vcpu *current,
3264 struct vcpu **next)
3265{
Karl Meakin13f09812024-10-28 16:33:23 +00003266 ffa_id_t sender_vm_id = ffa_sender(args);
3267 ffa_id_t receiver_vm_id = ffa_receiver(args);
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02003268 struct vcpu_locked current_locked;
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003269 struct vcpu_locked next_locked = (struct vcpu_locked){
3270 .vcpu = NULL,
3271 };
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003272 enum vcpu_state next_state = VCPU_STATE_RUNNING;
J-Alves86e883a2025-03-13 14:06:33 +00003273 /* Prepare return interrupt if caller goes back to waiting state. */
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003274 struct ffa_value ret = (struct ffa_value){.func = FFA_INTERRUPT_32};
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003275 struct ffa_value to_ret = api_ffa_dir_msg_value(args);
J-Alves645eabe2021-02-22 16:08:27 +00003276
Karl Meakin50ef9112024-10-28 16:41:44 +00003277 if (!api_ffa_msg_send_direct_resp_validate_args(args, current)) {
J-Alvesaa336102021-03-01 13:02:45 +00003278 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003279 }
3280
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003281 current_locked = vcpu_lock(current);
3282
Karl Meakin117c8082024-12-04 16:03:28 +00003283 if (!ffa_cpu_cycles_check_runtime_state_transition(
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003284 current_locked, sender_vm_id, receiver_vm_id, next_locked,
3285 args.func, &next_state)) {
3286 ret = ffa_error(FFA_DENIED);
3287 goto out;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05003288 }
3289
Madhukar Pappireddyd456ac22023-06-26 15:29:34 -05003290 assert(!vm_id_is_current_world(current->vm->id) ||
3291 next_state == VCPU_STATE_WAITING);
Madhukar Pappireddy469fa712022-06-21 18:53:33 -05003292
Karl Meakin50ef9112024-10-28 16:41:44 +00003293 if (!api_ffa_msg_send_direct_resp_validate_ongoing_request(
3294 args, current_locked)) {
Kathleen Capellae468c112023-12-13 17:56:28 -05003295 ret = ffa_error(FFA_DENIED);
3296 goto out;
3297 }
3298
Madhukar Pappireddy454b91d2025-02-10 13:05:46 -06003299 if (ffa_is_framework_msg(args) &&
3300 ffa_direct_msg_handle_framework_msg_resp(args, &ret, current_locked,
3301 next)) {
3302 goto out;
3303 }
3304
Manish Pandeya5f39fb2020-09-11 09:47:11 +01003305 if (api_ffa_is_managed_exit_ongoing(current_locked)) {
Madhukar Pappireddy7945bb52024-08-20 15:22:41 -05003306 CHECK(current->scheduling_mode != SPMC_MODE);
Madhukar Pappireddyed4ab942021-08-03 14:22:53 -05003307
Madhukar Pappireddy025a4512024-10-14 22:09:19 -05003308 plat_interrupts_set_priority_mask(
3309 current->prev_interrupt_priority);
Madhukar Pappireddya1019112022-06-21 18:57:44 -05003310 /*
3311 * A SP may be signaled a managed exit but actually not trap
3312 * the virtual interrupt, probably because it has virtual
3313 * interrupts masked, and emit direct resp. In this case the
3314 * managed exit operation is considered completed and it would
3315 * also need to clear the pending managed exit flag for the SP
3316 * vCPU.
3317 */
Manish Pandeya5f39fb2020-09-11 09:47:11 +01003318 current->processing_managed_exit = false;
Madhukar Pappireddya1019112022-06-21 18:57:44 -05003319
Daniel Boulbyd7992232025-03-06 17:09:49 +00003320 vcpu_virt_interrupt_clear(current_locked,
3321 HF_MANAGED_EXIT_INTID);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003322 }
3323
Madhukar Pappireddy7e7847c2025-05-09 17:28:18 -05003324 api_direct_resp_unwind_call_chain_resume_target(&current_locked, next,
3325 &next_locked, to_ret,
3326 VCPU_STATE_WAITING);
Madhukar Pappireddy199a3b12025-05-08 15:59:26 -05003327
J-Alvesbd32c972024-02-02 16:20:04 +00003328 /*
J-Alves4796d112025-02-12 14:39:00 +00003329 * Check if there is a pending interrupt, and if the partition
3330 * is expects to notify the scheduler or resume straight away.
3331 * Either trigger SRI for later donation of CPU cycles, or
3332 * eret `FFA_INTERRUPT` back to the caller.
J-Alvesbd32c972024-02-02 16:20:04 +00003333 */
J-Alves86e883a2025-03-13 14:06:33 +00003334 if (ffa_interrupts_intercept_call(current_locked, next_locked, &ret)) {
J-Alvesbd32c972024-02-02 16:20:04 +00003335 *next = NULL;
3336 }
3337
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003338 vcpu_unlock(&next_locked);
Madhukar Pappireddyc0fb87e2022-06-21 17:59:15 -05003339
Madhukar Pappireddybd10e572023-03-06 16:39:49 -06003340out:
3341 vcpu_unlock(&current_locked);
3342 return ret;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00003343}
3344
J-Alves84658fc2021-06-17 14:37:32 +01003345static bool api_memory_region_check_flags(
3346 struct ffa_memory_region *memory_region, uint32_t share_func)
3347{
3348 switch (share_func) {
J-Alves95fbb312024-03-20 15:19:16 +00003349 case FFA_MEM_SHARE_64:
J-Alves84658fc2021-06-17 14:37:32 +01003350 case FFA_MEM_SHARE_32:
3351 if ((memory_region->flags & FFA_MEMORY_REGION_FLAG_CLEAR) !=
3352 0U) {
3353 return false;
3354 }
Karl Meakin402b1fe2025-03-20 14:52:55 +00003355 [[fallthrough]];
J-Alves95fbb312024-03-20 15:19:16 +00003356 case FFA_MEM_LEND_64:
J-Alves84658fc2021-06-17 14:37:32 +01003357 case FFA_MEM_LEND_32:
J-Alves95fbb312024-03-20 15:19:16 +00003358 case FFA_MEM_DONATE_64:
J-Alves84658fc2021-06-17 14:37:32 +01003359 case FFA_MEM_DONATE_32: {
3360 /* Bits 31:2 Must Be Zero. */
Karl Meakin0770e712025-03-20 17:57:09 +00003361 ffa_memory_region_flags_t to_mask =
J-Alves84658fc2021-06-17 14:37:32 +01003362 ~(FFA_MEMORY_REGION_FLAG_CLEAR |
3363 FFA_MEMORY_REGION_FLAG_TIME_SLICE);
3364
3365 if ((memory_region->flags & to_mask) != 0U) {
3366 return false;
3367 }
3368 break;
3369 }
3370 default:
3371 panic("Check for mem send calls only.\n");
3372 }
3373
3374 /* Last check reserved values are 0 */
3375 return true;
3376}
3377
J-Alves33c47bf2022-09-29 11:36:20 +01003378/*
3379 * Convert memory transaction descriptor from FF-A v1.0 to FF-A v1.1 EAC0.
3380 */
3381static void api_ffa_memory_region_v1_1_from_v1_0(
3382 struct ffa_memory_region_v1_0 *memory_region_v1_0,
3383 struct ffa_memory_region *memory_region_v1_1)
3384{
3385 memory_region_v1_1->sender = memory_region_v1_0->sender;
J-Alves00847062022-10-03 17:08:44 +01003386 memory_region_v1_1->handle = memory_region_v1_0->handle;
Karl Meakin84710f32023-10-12 15:14:49 +01003387 memory_region_v1_1->attributes =
3388 ffa_memory_attributes_extend(memory_region_v1_0->attributes);
J-Alves33c47bf2022-09-29 11:36:20 +01003389 memory_region_v1_1->flags = memory_region_v1_0->flags;
3390 memory_region_v1_1->tag = memory_region_v1_0->tag;
3391 memory_region_v1_1->memory_access_desc_size =
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003392 sizeof(struct ffa_memory_access_v1_0);
J-Alves33c47bf2022-09-29 11:36:20 +01003393 memory_region_v1_1->receiver_count = memory_region_v1_0->receiver_count;
Daniel Boulby41ef8ba2023-10-13 17:01:22 +01003394 memory_region_v1_1->receivers_offset = sizeof(struct ffa_memory_region);
J-Alves33c47bf2022-09-29 11:36:20 +01003395
3396 /* Zero reserved fields. */
3397 for (uint32_t i = 0; i < 3U; i++) {
3398 memory_region_v1_1->reserved[i] = 0U;
3399 }
3400}
3401
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003402/**
3403 * Updates a v1.0 transaction descriptor to v1.1. This gives us the
3404 * memory_access_desc_size field we need for forwards compatability.
3405 * Copy the receivers and composite descriptors to the new struct.
3406 * We also check the fields in the v1.0 transaction descriptor and return:
3407 * - FFA_ERROR FFA_INVALID_PARAMETERS: If any of the fields are not valid
3408 * values, eg the reserved fields are not 0, receiver_count is too large or
3409 * composite offsets are not 0 for retrieve requests or in bounds for send
3410 * requests.
3411 * - FFA ERROR FFA_NOT_SUPPORTED: If an invalid ffa_version is supplied to the
3412 * function. Or the fragment length is more than a single page.
3413 * - FFA_ERROR FFA_NO_MEMORY: If we do not have enough memory for a scratch
3414 * memory transaction descriptor.
3415 * - FFA_SUCCESS: If a successful update has occured.
J-Alves33c47bf2022-09-29 11:36:20 +01003416 */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003417static struct ffa_value api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3418 void *allocated, uint32_t *fragment_length, uint32_t *total_length,
Karl Meakin0e617d92024-04-05 12:55:22 +01003419 enum ffa_version ffa_version, bool send_transaction)
J-Alves33c47bf2022-09-29 11:36:20 +01003420{
3421 struct ffa_memory_region_v1_0 *memory_region_v1_0;
3422 struct ffa_memory_region *memory_region_v1_1 = NULL;
3423 struct ffa_composite_memory_region *composite_v1_0;
3424 struct ffa_composite_memory_region *composite_v1_1;
3425 size_t receivers_length;
3426 size_t space_left;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003427 size_t receivers_end;
J-Alves33c47bf2022-09-29 11:36:20 +01003428 size_t composite_offset_v1_1;
3429 size_t composite_offset_v1_0;
3430 size_t fragment_constituents_size;
3431 size_t fragment_length_v1_1;
3432
J-Alves33c47bf2022-09-29 11:36:20 +01003433 assert(fragment_length != NULL);
3434 assert(total_length != NULL);
3435
Karl Meakin0e617d92024-04-05 12:55:22 +01003436 if (ffa_version >= FFA_VERSION_1_1) {
J-Alves33c47bf2022-09-29 11:36:20 +01003437 return (struct ffa_value){.func = FFA_SUCCESS_32};
3438 }
3439
Karl Meakin0e617d92024-04-05 12:55:22 +01003440 if (ffa_version != FFA_VERSION_1_0) {
J-Alves33c47bf2022-09-29 11:36:20 +01003441 dlog_verbose("%s: Unsupported FF-A version %x\n", __func__,
3442 ffa_version);
3443 return ffa_error(FFA_NOT_SUPPORTED);
3444 }
3445
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003446 dlog_verbose(
J-Alves0a824e92024-04-26 16:20:12 +01003447 "Updating memory transaction descriptor from v1.0 to v1.1.\n");
J-Alves33c47bf2022-09-29 11:36:20 +01003448
3449 memory_region_v1_0 = (struct ffa_memory_region_v1_0 *)allocated;
3450
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003451 receivers_length = sizeof(struct ffa_memory_access_v1_0) *
J-Alves33c47bf2022-09-29 11:36:20 +01003452 memory_region_v1_0->receiver_count;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003453 receivers_end = sizeof(struct ffa_memory_region) + receivers_length;
J-Alves33c47bf2022-09-29 11:36:20 +01003454
3455 /*
3456 * Check the specified composite offset of v1.0 descriptor, and that all
3457 * receivers were configured with the same offset.
3458 */
3459 composite_offset_v1_0 =
3460 memory_region_v1_0->receivers[0].composite_memory_region_offset;
3461
J-Alves33c47bf2022-09-29 11:36:20 +01003462 /* Determine the composite offset for v1.1 descriptor. */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003463 if (send_transaction) {
3464 fragment_constituents_size =
3465 *fragment_length - composite_offset_v1_0 -
3466 sizeof(struct ffa_composite_memory_region);
3467 fragment_length_v1_1 =
3468 receivers_end +
3469 sizeof(struct ffa_composite_memory_region) +
3470 fragment_constituents_size;
3471 composite_offset_v1_1 = receivers_end;
3472 } else {
3473 fragment_constituents_size = 0;
3474 fragment_length_v1_1 = receivers_end;
3475 composite_offset_v1_1 = 0;
3476 }
J-Alves33c47bf2022-09-29 11:36:20 +01003477
3478 /*
3479 * Currently only support the simpler cases: memory transaction
3480 * in a single fragment that fits in a MM_PPOOL_ENTRY_SIZE.
3481 * TODO: allocate the entries needed for this fragment_length_v1_1.
3482 * - Check corner when v1.1 descriptor converted size surpasses
3483 * the size of the entry.
3484 */
3485 if (fragment_length_v1_1 > MM_PPOOL_ENTRY_SIZE) {
3486 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00003487 "Translation of FF-A v1.0 descriptors for over %lu is "
J-Alves33c47bf2022-09-29 11:36:20 +01003488 "unsupported.",
3489 MM_PPOOL_ENTRY_SIZE);
3490 return ffa_error(FFA_NOT_SUPPORTED);
3491 }
3492
3493 space_left = fragment_length_v1_1;
3494
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003495 /*
3496 * Allocate a page of memory to construct the v1.1 memory descriptor.
3497 * Earlier we checked that the fragment_length_v1_1 would not be larger
3498 * than a page.
3499 */
J-Alves33c47bf2022-09-29 11:36:20 +01003500 memory_region_v1_1 =
3501 (struct ffa_memory_region *)mpool_alloc(&api_page_pool);
3502 if (memory_region_v1_1 == NULL) {
3503 return ffa_error(FFA_NO_MEMORY);
3504 }
3505
3506 /* Translate header from v1.0 to v1.1. */
3507 api_ffa_memory_region_v1_1_from_v1_0(memory_region_v1_0,
3508 memory_region_v1_1);
3509
3510 space_left -= sizeof(struct ffa_memory_region);
3511
3512 /* Copy memory access information. */
Daniel Boulby41ef8ba2023-10-13 17:01:22 +01003513 memcpy_s((uint8_t *)memory_region_v1_1 +
3514 memory_region_v1_1->receivers_offset,
3515 space_left, memory_region_v1_0->receivers, receivers_length);
J-Alves33c47bf2022-09-29 11:36:20 +01003516
3517 /* Initialize the memory access descriptors with composite offset. */
3518 for (uint32_t i = 0; i < memory_region_v1_1->receiver_count; i++) {
3519 struct ffa_memory_access *receiver =
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003520 ffa_memory_region_get_receiver(memory_region_v1_1, i);
3521 assert(receiver != NULL);
J-Alves33c47bf2022-09-29 11:36:20 +01003522 receiver->composite_memory_region_offset =
3523 composite_offset_v1_1;
3524 }
3525
3526 space_left -= receivers_length;
3527
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003528 /* Composite memory descriptors to copy. */
3529 if (send_transaction) {
3530 /* Init v1.1 composite. */
3531 composite_v1_1 = (struct ffa_composite_memory_region
3532 *)((uint8_t *)memory_region_v1_1 +
3533 composite_offset_v1_1);
J-Alves33c47bf2022-09-29 11:36:20 +01003534
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003535 composite_v1_0 = ffa_memory_region_get_composite_v1_0(
3536 memory_region_v1_0, 0);
3537 composite_v1_1->constituent_count =
3538 composite_v1_0->constituent_count;
3539 composite_v1_1->page_count = composite_v1_0->page_count;
J-Alves33c47bf2022-09-29 11:36:20 +01003540
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003541 space_left -= sizeof(struct ffa_composite_memory_region);
J-Alves33c47bf2022-09-29 11:36:20 +01003542
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003543 /* Initialize v1.1 constituents. */
3544 memcpy_s(composite_v1_1->constituents, space_left,
3545 composite_v1_0->constituents,
3546 fragment_constituents_size);
J-Alves33c47bf2022-09-29 11:36:20 +01003547
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003548 space_left -= fragment_constituents_size;
3549 }
3550
J-Alves33c47bf2022-09-29 11:36:20 +01003551 assert(space_left == 0U);
3552
J-Alves33c47bf2022-09-29 11:36:20 +01003553 /*
3554 * Remove the v1.0 fragment size, and resultant size of v1.1 fragment.
3555 */
3556 *total_length = *total_length - *fragment_length + fragment_length_v1_1;
3557 *fragment_length = fragment_length_v1_1;
3558
3559 /*
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003560 * After successfully updating to v1.1 copy the descriptor to the
3561 * internal buffer given as a parameter (used to prevent TOCTOU attacks)
3562 * and free the scratch memory used to construct it.
J-Alves33c47bf2022-09-29 11:36:20 +01003563 */
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003564 memcpy_s(allocated, MM_PPOOL_ENTRY_SIZE, memory_region_v1_1,
3565 *fragment_length);
3566 mpool_free(&api_page_pool, memory_region_v1_1);
J-Alves33c47bf2022-09-29 11:36:20 +01003567
3568 return (struct ffa_value){.func = FFA_SUCCESS_32};
3569}
3570
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003571struct ffa_value api_ffa_mem_send(uint32_t share_func, uint32_t length,
3572 uint32_t fragment_length, ipaddr_t address,
Andrew Walbran1a86aa92020-05-15 17:22:28 +01003573 uint32_t page_count, struct vcpu *current)
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003574{
3575 struct vm *from = current->vm;
3576 struct vm *to;
3577 const void *from_msg;
J-Alves33c47bf2022-09-29 11:36:20 +01003578 void *allocated_entry;
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003579 struct ffa_memory_region *memory_region = NULL;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003580 struct ffa_value ret;
J-Alves363f5722022-04-25 17:37:37 +01003581 bool targets_other_world = false;
Karl Meakin0e617d92024-04-05 12:55:22 +01003582 enum ffa_version ffa_version;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003583
3584 if (ipa_addr(address) != 0 || page_count != 0) {
3585 /*
3586 * Hafnium only supports passing the descriptor in the TX
3587 * mailbox.
3588 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003589 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003590 }
3591
Andrew Walbranca808b12020-05-15 17:22:28 +01003592 if (fragment_length > length) {
3593 dlog_verbose(
3594 "Fragment length %d greater than total length %d.\n",
3595 fragment_length, length);
3596 return ffa_error(FFA_INVALID_PARAMETERS);
3597 }
J-Alves33c47bf2022-09-29 11:36:20 +01003598
3599 if (fragment_length > HF_MAILBOX_SIZE ||
3600 fragment_length > MM_PPOOL_ENTRY_SIZE) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003601 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003602 }
3603
3604 /*
3605 * Check that the sender has configured its send buffer. If the TX
3606 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
3607 * be safely accessed after releasing the lock since the TX mailbox
3608 * address can only be configured once.
3609 */
3610 sl_lock(&from->lock);
3611 from_msg = from->mailbox.send;
J-Alves33c47bf2022-09-29 11:36:20 +01003612 ffa_version = from->ffa_version;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003613 sl_unlock(&from->lock);
3614
3615 if (from_msg == NULL) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003616 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003617 }
3618
3619 /*
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003620 * Copy the memory region descriptor to a fresh page from the memory
3621 * pool. This prevents the sender from changing it underneath us, and
3622 * also lets us keep it around in the share state table if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003623 */
J-Alves33c47bf2022-09-29 11:36:20 +01003624 allocated_entry = mpool_alloc(&api_page_pool);
3625 if (allocated_entry == NULL) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003626 dlog_verbose("Failed to allocate memory region copy.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003627 return ffa_error(FFA_NO_MEMORY);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003628 }
J-Alves33c47bf2022-09-29 11:36:20 +01003629
J-Alves8f2150d2024-03-28 16:15:56 +00003630 if (!memcpy_trapped(allocated_entry, MM_PPOOL_ENTRY_SIZE, from_msg,
3631 fragment_length)) {
3632 dlog_error(
3633 "%s: Failed to copy FF-A memory region descriptor.\n",
3634 __func__);
leisened7ed3d2024-08-06 17:25:18 +08003635 ret = ffa_error(FFA_ABORTED);
3636 goto out;
J-Alves8f2150d2024-03-28 16:15:56 +00003637 }
J-Alves33c47bf2022-09-29 11:36:20 +01003638
J-Alves8bc47f32025-03-21 10:23:51 +00003639 /*
3640 * Out-of-bounds accesses should be eliminated by the sanity checks
3641 * below.
3642 */
Daniel Boulbyc7dc9322023-10-27 15:12:07 +01003643 if (!ffa_memory_region_sanity_check(allocated_entry, ffa_version,
3644 fragment_length, true)) {
3645 ret = ffa_error(FFA_INVALID_PARAMETERS);
3646 goto out;
3647 }
3648
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003649 ret = api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3650 allocated_entry, &fragment_length, &length, ffa_version, true);
J-Alves33c47bf2022-09-29 11:36:20 +01003651 if (ret.func != FFA_SUCCESS_32) {
3652 goto out;
3653 }
3654
J-Alves8bc47f32025-03-21 10:23:51 +00003655 memory_region = allocated_entry;
3656
J-Alves33c47bf2022-09-29 11:36:20 +01003657 if (fragment_length < sizeof(struct ffa_memory_region) +
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003658 memory_region->memory_access_desc_size) {
J-Alves33c47bf2022-09-29 11:36:20 +01003659 dlog_verbose(
3660 "Initial fragment length %d smaller than header size "
Karl Meakine8937d92024-03-19 16:04:25 +00003661 "%lu.\n",
J-Alves33c47bf2022-09-29 11:36:20 +01003662 fragment_length,
3663 sizeof(struct ffa_memory_region) +
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003664 memory_region->memory_access_desc_size);
3665 ret = ffa_error(FFA_INVALID_PARAMETERS);
3666 goto out;
J-Alves33c47bf2022-09-29 11:36:20 +01003667 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003668
J-Alves84658fc2021-06-17 14:37:32 +01003669 if (!api_memory_region_check_flags(memory_region, share_func)) {
3670 dlog_verbose(
3671 "Memory region reserved arguments must be zero.\n");
3672 ret = ffa_error(FFA_INVALID_PARAMETERS);
3673 goto out;
3674 }
3675
J-Alves363f5722022-04-25 17:37:37 +01003676 if (memory_region->receiver_count == 0U) {
3677 dlog_verbose("Receiver count can't be 0.\n");
3678 ret = ffa_error(FFA_INVALID_PARAMETERS);
3679 goto out;
3680 }
3681
J-Alves95fbb312024-03-20 15:19:16 +00003682 if ((share_func == FFA_MEM_DONATE_32 ||
3683 share_func == FFA_MEM_DONATE_64) &&
J-Alves363f5722022-04-25 17:37:37 +01003684 memory_region->receiver_count != 1U) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003685 dlog_verbose(
J-Alves0a824e92024-04-26 16:20:12 +01003686 "FFA_MEM_DONATE only supports one recipient. Specified "
3687 "%u\n",
J-Alves363f5722022-04-25 17:37:37 +01003688 memory_region->receiver_count);
3689 ret = ffa_error(FFA_INVALID_PARAMETERS);
3690 goto out;
3691 }
3692
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003693 /*
3694 * Ensure that the receiver VM exists and isn't the same as the sender.
J-Alves363f5722022-04-25 17:37:37 +01003695 * If there is a receiver from the other world, track it for later
3696 * forwarding if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003697 */
J-Alves363f5722022-04-25 17:37:37 +01003698 for (uint32_t i = 0U; i < memory_region->receiver_count; i++) {
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003699 struct ffa_memory_access *receiver =
3700 ffa_memory_region_get_receiver(memory_region, i);
J-Alvesc9227c82024-04-24 21:00:58 +01003701 ffa_id_t receiver_id;
3702
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003703 assert(receiver != NULL);
J-Alvesc9227c82024-04-24 21:00:58 +01003704
3705 receiver_id = receiver->receiver_permissions.receiver;
Daniel Boulbyd5ae44b2023-12-12 12:18:11 +00003706
J-Alves363f5722022-04-25 17:37:37 +01003707 to = vm_find(receiver_id);
3708
J-Alves7de61af2024-03-27 10:29:46 +00003709 if ((vm_id_is_current_world(receiver_id) && to == NULL) ||
3710 to == from) {
J-Alves363f5722022-04-25 17:37:37 +01003711 dlog_verbose("%s: invalid receiver.\n", __func__);
3712 ret = ffa_error(FFA_INVALID_PARAMETERS);
3713 goto out;
3714 }
3715
Karl Meakin117c8082024-12-04 16:03:28 +00003716 if (!ffa_memory_is_send_valid(
J-Alvesc9227c82024-04-24 21:00:58 +01003717 receiver_id, from->id, share_func,
3718 memory_region->receiver_count > 1)) {
J-Alves363f5722022-04-25 17:37:37 +01003719 ret = ffa_error(FFA_DENIED);
3720 goto out;
3721 }
3722
3723 /* Capture if any of the receivers is from the other world. */
3724 if (!targets_other_world) {
3725 targets_other_world =
3726 !vm_id_is_current_world(receiver_id);
3727 }
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003728 }
3729
J-Alves363f5722022-04-25 17:37:37 +01003730 if (targets_other_world) {
Karl Meakin117c8082024-12-04 16:03:28 +00003731 ret = ffa_memory_other_world_mem_send(
J-Alves66652252022-07-06 09:49:51 +01003732 from, share_func, &memory_region, length,
3733 fragment_length, &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003734 } else {
3735 struct vm_locked from_locked = vm_lock(from);
3736
Andrew Walbran1a86aa92020-05-15 17:22:28 +01003737 ret = ffa_memory_send(from_locked, memory_region, length,
3738 fragment_length, share_func,
3739 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003740 /*
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003741 * ffa_memory_send takes ownership of the memory_region, so
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003742 * make sure we don't free it.
3743 */
3744 memory_region = NULL;
3745
3746 vm_unlock(&from_locked);
3747 }
3748
3749out:
3750 if (memory_region != NULL) {
3751 mpool_free(&api_page_pool, memory_region);
3752 }
3753
3754 return ret;
3755}
3756
J-Alvesc7270b72024-09-12 10:16:34 +01003757/**
3758 * An FFA_MEM_RETRIEVE_REQ from the hypervisor must specify the handle of the
3759 * memory transaction it is querying and all other fields must be 0.
3760 */
3761static bool api_ffa_memory_hypervisor_retrieve_request_validate(
3762 struct ffa_memory_region *request, enum ffa_version version)
3763{
3764 switch (version) {
3765 case FFA_VERSION_1_0: {
3766 struct ffa_memory_region_v1_0 *request_v1_0 =
3767 (struct ffa_memory_region_v1_0 *)request;
3768
3769 return request_v1_0->sender == 0U &&
3770 request_v1_0->attributes.shareability == 0U &&
3771 request_v1_0->attributes.cacheability == 0U &&
3772 request_v1_0->attributes.type == 0U &&
3773 request_v1_0->attributes.security == 0U &&
3774 request_v1_0->flags == 0U && request_v1_0->tag == 0U &&
3775 request_v1_0->receiver_count == 0U &&
Karl Meakin117c8082024-12-04 16:03:28 +00003776 ffa_memory_is_handle_allocated_by_current_world(
J-Alvesc7270b72024-09-12 10:16:34 +01003777 request_v1_0->handle);
3778 }
3779 default:
3780 return request->sender == 0U &&
3781 request->attributes.shareability == 0U &&
3782 request->attributes.cacheability == 0U &&
3783 request->attributes.type == 0U &&
3784 request->attributes.security == 0U &&
3785 request->flags == 0U && request->tag == 0U &&
3786 request->memory_access_desc_size == 0U &&
3787 request->receiver_count == 0U &&
3788 request->receivers_offset == 0U &&
Karl Meakin117c8082024-12-04 16:03:28 +00003789 ffa_memory_is_handle_allocated_by_current_world(
J-Alvesc7270b72024-09-12 10:16:34 +01003790 request->handle);
3791 }
3792}
3793
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003794struct ffa_value api_ffa_mem_retrieve_req(uint32_t length,
3795 uint32_t fragment_length,
3796 ipaddr_t address, uint32_t page_count,
3797 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003798{
3799 struct vm *to = current->vm;
3800 struct vm_locked to_locked;
3801 const void *to_msg;
J-Alves00847062022-10-03 17:08:44 +01003802 void *retrieve_msg;
3803 struct ffa_memory_region *retrieve_request = NULL;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003804 uint32_t message_buffer_size;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003805 struct ffa_value ret;
Karl Meakin0e617d92024-04-05 12:55:22 +01003806 enum ffa_version ffa_version;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003807
3808 if (ipa_addr(address) != 0 || page_count != 0) {
3809 /*
3810 * Hafnium only supports passing the descriptor in the TX
3811 * mailbox.
3812 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003813 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003814 }
3815
Andrew Walbrana65a1322020-04-06 19:32:32 +01003816 if (fragment_length != length) {
J-Alves33c47bf2022-09-29 11:36:20 +01003817 dlog_verbose("Fragmentation not supported.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003818 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003819 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003820
J-Alves00847062022-10-03 17:08:44 +01003821 retrieve_msg = cpu_get_buffer(current->cpu);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003822 message_buffer_size = cpu_get_buffer_size(current->cpu);
3823 if (length > HF_MAILBOX_SIZE || length > message_buffer_size) {
3824 dlog_verbose("Retrieve request too long.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003825 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003826 }
3827
3828 to_locked = vm_lock(to);
3829 to_msg = to->mailbox.send;
J-Alves00847062022-10-03 17:08:44 +01003830 ffa_version = to->ffa_version;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003831
3832 if (to_msg == NULL) {
3833 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003834 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003835 goto out;
3836 }
3837
3838 /*
3839 * Copy the retrieve request descriptor to an internal buffer, so that
3840 * the caller can't change it underneath us.
3841 */
J-Alves8f2150d2024-03-28 16:15:56 +00003842 if (!memcpy_trapped(retrieve_msg, message_buffer_size, to_msg,
3843 length)) {
3844 dlog_error(
3845 "%s: Failed to copy FF-A retrieve request "
3846 "descriptor.\n",
3847 __func__);
3848 ret = ffa_error(FFA_ABORTED);
3849 goto out;
3850 }
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003851
J-Alvese8c8c2b2022-12-16 15:34:48 +00003852 if ((vm_is_mailbox_other_world_owned(to_locked) &&
Karl Meakin117c8082024-12-04 16:03:28 +00003853 !ffa_setup_acquire_receiver_rx(to_locked, &ret)) ||
J-Alvese8c8c2b2022-12-16 15:34:48 +00003854 vm_is_mailbox_busy(to_locked)) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003855 /*
J-Alvese8c8c2b2022-12-16 15:34:48 +00003856 * Can't retrieve memory information if the mailbox is
3857 * not available.
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003858 */
J-Alves59ed0042022-07-28 18:26:41 +01003859 dlog_verbose("%s: RX buffer not ready.\n", __func__);
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003860 ret = ffa_error(FFA_BUSY);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003861 goto out;
3862 }
3863
Daniel Boulby296ee702023-11-28 13:36:55 +00003864 if (!is_ffa_hypervisor_retrieve_request(retrieve_msg)) {
J-Alves8bc47f32025-03-21 10:23:51 +00003865 /*
3866 * The checks from function below should guarantee there are no
3867 * invalid values, and the accesses that follow can't be out of
3868 * bounds.
3869 */
Daniel Boulby44e9b3b2024-01-17 12:21:44 +00003870 if (!ffa_memory_region_sanity_check(retrieve_msg, ffa_version,
3871 fragment_length, false)) {
3872 ret = ffa_error(FFA_INVALID_PARAMETERS);
3873 goto out;
3874 }
3875 /*
3876 * If required, transform the retrieve request to FF-A v1.1.
3877 */
3878 ret = api_ffa_memory_transaction_descriptor_v1_1_from_v1_0(
3879 retrieve_msg, &fragment_length, &length, ffa_version,
3880 false);
Daniel Boulbyc7dc9322023-10-27 15:12:07 +01003881
Daniel Boulby44e9b3b2024-01-17 12:21:44 +00003882 if (ret.func != FFA_SUCCESS_32) {
3883 goto out;
3884 }
J-Alvesc7270b72024-09-12 10:16:34 +01003885 } else {
3886 if (!api_ffa_memory_hypervisor_retrieve_request_validate(
3887 retrieve_msg, ffa_version)) {
3888 dlog_verbose(
3889 "All fields except the handle in the "
3890 "memory access descriptor must be zero for a "
3891 "hypervisor retrieve request.\n");
3892 ret = ffa_error(FFA_INVALID_PARAMETERS);
3893 goto out;
3894 }
J-Alves00847062022-10-03 17:08:44 +01003895 }
3896
Daniel Boulby36e0bdb2023-10-09 12:00:41 +01003897 retrieve_request = retrieve_msg;
Kathleen Capella578784f2023-09-01 18:03:27 -04003898
Karl Meakin117c8082024-12-04 16:03:28 +00003899 if (ffa_memory_is_handle_allocated_by_current_world(
J-Alvesb5084cf2022-07-06 14:20:12 +01003900 retrieve_request->handle)) {
3901 ret = ffa_memory_retrieve(to_locked, retrieve_request, length,
3902 &api_page_pool);
3903 } else {
Daniel Boulbyfdd59f72023-10-19 16:43:19 +01003904 dlog_error("Invalid FF-A memory handle.\n");
3905 ret = ffa_error(FFA_INVALID_PARAMETERS);
J-Alvesb5084cf2022-07-06 14:20:12 +01003906 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003907out:
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003908 vm_unlock(&to_locked);
3909 return ret;
3910}
3911
J-Alvesa39a8442024-04-26 15:41:47 +01003912/**
3913 * Copies the memory relinquish descriptor from the partition's TX buffer, to
3914 * the buffer of the local CPU. Do it safely, and return error if:
3915 * - FFA_ABORTED: if the `memcpy_trapped` fails.
3916 * - FFA_INVALID_PARAMETERS: if the size of the full memory relinquish
3917 * descriptor doesn't fit the local CPU buffer.
3918 *
3919 * Returns FFA_SUCCESS if copying goes well, and sets 'out_relinquish'
3920 * to the address of the cpu buffer with the relinquish descriptor.
3921 */
3922static struct ffa_value api_get_ffa_mem_relinquish_descriptor(
3923 struct vcpu *current, const void *from_msg,
3924 struct ffa_mem_relinquish **out_relinquish)
3925{
3926 struct ffa_mem_relinquish *relinquish_request;
3927 uint32_t from_msg_size;
3928 uint32_t total_from_msg_size;
3929 uint32_t dst_size;
3930 vaddr_t dst;
3931 vaddr_t src;
3932
3933 assert(from_msg != NULL);
3934 assert(out_relinquish != NULL);
3935
3936 /*
3937 * Copy the relinquish descriptor to an internal buffer, so that the
3938 * caller can't change it underneath us.
3939 */
3940 relinquish_request =
3941 (struct ffa_mem_relinquish *)cpu_get_buffer(current->cpu);
3942
3943 /* Set the destination for the copy. */
3944 dst = va_from_ptr(relinquish_request);
3945 src = va_from_ptr(from_msg);
3946
3947 dst_size = cpu_get_buffer_size(current->cpu);
3948
3949 /* Only copy the size to start with. */
3950 from_msg_size = sizeof(struct ffa_mem_relinquish);
3951 total_from_msg_size = from_msg_size;
3952
3953 if (!memcpy_trapped(ptr_from_va(dst), dst_size, ptr_from_va(src),
3954 from_msg_size)) {
3955 dlog_error(
3956 "%s: Failed to copy FF-A memory relinquish "
3957 "descriptor.\n",
3958 __func__);
3959 return ffa_error(FFA_ABORTED);
3960 }
3961
3962 if (relinquish_request->endpoint_count != 1) {
3963 dlog_error("%s: relinquish descriptor must have 1 endpoint\n",
3964 __func__);
3965 return ffa_error(FFA_INVALID_PARAMETERS);
3966 }
3967
3968 /*
3969 * Increment the `dst` to the position right after the copied header.
3970 * Increment the `src` to point at the list of endpoints.
3971 *
3972 * Calculate the new `dst_size` which is the size of the allocated cpu
3973 * buffer, minus the size of the copied memory relinquish header.
3974 *
3975 * Only after the above: determine the new `from_msg_size` in accordance
3976 * to the endpoint count.
3977 */
3978 dst = va_add(dst, from_msg_size);
3979 src = va_add(src, from_msg_size);
3980
3981 /*
3982 * Check if it is safe to copy the rest of the message.
3983 * This also serves as a santiy check to 'endpoint_count'.
3984 * The size of what is left in the descriptor, based on endpoint_count,
3985 * shall not be bigger than the size of the mailbox minus the size of
3986 * the header which was previously copied in this function.
3987 */
3988 dst_size -= from_msg_size;
3989 from_msg_size = relinquish_request->endpoint_count * sizeof(ffa_id_t);
3990 total_from_msg_size += from_msg_size;
3991
3992 if (total_from_msg_size > HF_MAILBOX_SIZE ||
3993 total_from_msg_size > dst_size) {
3994 dlog_verbose(
3995 "Relinquish message too long. Endpoint count: %u\n",
3996 relinquish_request->endpoint_count);
3997 return ffa_error(FFA_INVALID_PARAMETERS);
3998 }
3999
4000 /* Copy the remaining fragment. */
4001 if (!memcpy_trapped(ptr_from_va(dst), dst_size, ptr_from_va(src),
4002 from_msg_size)) {
4003 dlog_error("%s: Failed to copy FF-A relinquish request.\n",
4004 __func__);
4005 return ffa_error(FFA_ABORTED);
4006 }
4007
4008 /*
4009 * Set the output address for the relinquish descriptor to the current
4010 * cpu's buffer.
4011 */
4012 *out_relinquish = relinquish_request;
4013
4014 return (struct ffa_value){.func = FFA_SUCCESS_32};
4015}
4016
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004017struct ffa_value api_ffa_mem_relinquish(struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004018{
4019 struct vm *from = current->vm;
4020 struct vm_locked from_locked;
4021 const void *from_msg;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004022 struct ffa_value ret;
J-Alvesa39a8442024-04-26 15:41:47 +01004023 struct ffa_mem_relinquish *relinquish_request;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004024
4025 from_locked = vm_lock(from);
4026 from_msg = from->mailbox.send;
4027
4028 if (from_msg == NULL) {
4029 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004030 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004031 goto out;
4032 }
4033
J-Alvesa39a8442024-04-26 15:41:47 +01004034 ret = api_get_ffa_mem_relinquish_descriptor(current, from_msg,
4035 &relinquish_request);
4036
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004037 /*
J-Alvesa39a8442024-04-26 15:41:47 +01004038 * If the descriptor was safely copied, continue with the handling of
4039 * the retrieve request.
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004040 */
J-Alvesa39a8442024-04-26 15:41:47 +01004041 if (ret.func == FFA_SUCCESS_32) {
4042 ret = ffa_memory_relinquish(from_locked, relinquish_request,
4043 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004044 }
J-Alves8f2150d2024-03-28 16:15:56 +00004045
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004046out:
4047 vm_unlock(&from_locked);
4048 return ret;
4049}
4050
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004051struct ffa_value api_ffa_mem_reclaim(ffa_memory_handle_t handle,
4052 ffa_memory_region_flags_t flags,
4053 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004054{
4055 struct vm *to = current->vm;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004056 struct ffa_value ret;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004057
Karl Meakin117c8082024-12-04 16:03:28 +00004058 if (ffa_memory_is_handle_allocated_by_current_world(handle)) {
Andrew Walbran290b0c92020-02-03 16:37:14 +00004059 struct vm_locked to_locked = vm_lock(to);
4060
Andrew Walbranca808b12020-05-15 17:22:28 +01004061 ret = ffa_memory_reclaim(to_locked, handle, flags,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01004062 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00004063
Andrew Walbran290b0c92020-02-03 16:37:14 +00004064 vm_unlock(&to_locked);
4065 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004066 ret = ffa_memory_other_world_mem_reclaim(to, handle, flags,
4067 &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01004068 }
4069
4070 return ret;
4071}
4072
4073struct ffa_value api_ffa_mem_frag_rx(ffa_memory_handle_t handle,
4074 uint32_t fragment_offset,
J-Alves19e20cf2023-08-02 12:48:55 +01004075 ffa_id_t sender_vm_id,
Andrew Walbranca808b12020-05-15 17:22:28 +01004076 struct vcpu *current)
4077{
4078 struct vm *to = current->vm;
4079 struct vm_locked to_locked;
4080 struct ffa_value ret;
4081
4082 /* Sender ID MBZ at virtual instance. */
J-Alves59ed0042022-07-28 18:26:41 +01004083 if (vm_id_is_current_world(to->id)) {
4084 if (sender_vm_id != 0) {
4085 dlog_verbose("%s: Invalid sender.\n", __func__);
4086 return ffa_error(FFA_INVALID_PARAMETERS);
4087 }
Andrew Walbranca808b12020-05-15 17:22:28 +01004088 }
4089
4090 to_locked = vm_lock(to);
4091
J-Alves122f1a12022-12-12 15:55:42 +00004092 if (vm_is_mailbox_busy(to_locked)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01004093 /*
4094 * Can't retrieve memory information if the mailbox is not
4095 * available.
4096 */
J-Alves59ed0042022-07-28 18:26:41 +01004097 dlog_verbose("%s: RX buffer not ready partition %x.\n",
4098 __func__, to_locked.vm->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01004099 ret = ffa_error(FFA_BUSY);
4100 goto out;
4101 }
4102
J-Alvesc3fd9752024-04-04 11:45:33 +01004103 /*
4104 * Whilst copying the fragments, initialize the remaining constituents
4105 * in the CPU's internal structure, and later copy from the CPU buffer
4106 * into the partition's RX buffer. In the case SPMC is doing a retrieve
4107 * request for a VM/Hypervisor in an RME enabled system, there is no
4108 * guarantee the RX buffer is in the NS PAS. Accessing the buffer with
4109 * the wrong security state attribute would then result in an GPF.
4110 * The fragment is initialized in an internal buffer, and is later
4111 * copied to the RX buffer using the 'memcpy_trapped' which allows to
4112 * smoothly terminate the operation if the access has been preempted by
4113 * a GPF exception.
4114 */
4115 ret = ffa_memory_retrieve_continue(
4116 to_locked, handle, fragment_offset, sender_vm_id,
4117 cpu_get_buffer(current->cpu), &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01004118out:
4119 vm_unlock(&to_locked);
4120 return ret;
4121}
4122
4123struct ffa_value api_ffa_mem_frag_tx(ffa_memory_handle_t handle,
4124 uint32_t fragment_length,
J-Alves19e20cf2023-08-02 12:48:55 +01004125 ffa_id_t sender_vm_id,
Andrew Walbranca808b12020-05-15 17:22:28 +01004126 struct vcpu *current)
4127{
4128 struct vm *from = current->vm;
4129 const void *from_msg;
4130 void *fragment_copy;
4131 struct ffa_value ret;
4132
4133 /* Sender ID MBZ at virtual instance. */
J-Alvesfdd29272022-07-19 13:16:31 +01004134 if (vm_id_is_current_world(from->id) && sender_vm_id != 0) {
4135 dlog_verbose("Invalid sender.");
Andrew Walbranca808b12020-05-15 17:22:28 +01004136 return ffa_error(FFA_INVALID_PARAMETERS);
4137 }
4138
4139 /*
4140 * Check that the sender has configured its send buffer. If the TX
4141 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
4142 * be safely accessed after releasing the lock since the TX mailbox
4143 * address can only be configured once.
4144 */
4145 sl_lock(&from->lock);
4146 from_msg = from->mailbox.send;
4147 sl_unlock(&from->lock);
4148
4149 if (from_msg == NULL) {
J-Alves59ed0042022-07-28 18:26:41 +01004150 dlog_verbose("Mailbox from %x is not set.\n", from->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01004151 return ffa_error(FFA_INVALID_PARAMETERS);
4152 }
4153
4154 /*
4155 * Copy the fragment to a fresh page from the memory pool. This prevents
4156 * the sender from changing it underneath us, and also lets us keep it
4157 * around in the share state table if needed.
4158 */
4159 if (fragment_length > HF_MAILBOX_SIZE ||
4160 fragment_length > MM_PPOOL_ENTRY_SIZE) {
4161 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004162 "Fragment length %d larger than mailbox size %zu.\n",
Andrew Walbranca808b12020-05-15 17:22:28 +01004163 fragment_length, HF_MAILBOX_SIZE);
4164 return ffa_error(FFA_INVALID_PARAMETERS);
4165 }
4166 if (fragment_length < sizeof(struct ffa_memory_region_constituent) ||
4167 fragment_length % sizeof(struct ffa_memory_region_constituent) !=
4168 0) {
4169 dlog_verbose("Invalid fragment length %d.\n", fragment_length);
4170 return ffa_error(FFA_INVALID_PARAMETERS);
4171 }
4172 fragment_copy = mpool_alloc(&api_page_pool);
4173 if (fragment_copy == NULL) {
4174 dlog_verbose("Failed to allocate fragment copy.\n");
4175 return ffa_error(FFA_NO_MEMORY);
4176 }
J-Alves8f2150d2024-03-28 16:15:56 +00004177
4178 if (!memcpy_trapped(fragment_copy, MM_PPOOL_ENTRY_SIZE, from_msg,
4179 fragment_length)) {
4180 dlog_error("%s: Failed to copy fragment.\n", __func__);
4181 return ffa_error(FFA_ABORTED);
4182 }
Andrew Walbranca808b12020-05-15 17:22:28 +01004183
4184 /*
4185 * Hafnium doesn't support fragmentation of memory retrieve requests
4186 * (because it doesn't support caller-specified mappings, so a request
4187 * will never be larger than a single page), so this must be part of a
4188 * memory send (i.e. donate, lend or share) request.
4189 *
4190 * We can tell from the handle whether the memory transaction is for the
J-Alvesfdd29272022-07-19 13:16:31 +01004191 * other world or not.
Andrew Walbranca808b12020-05-15 17:22:28 +01004192 */
Karl Meakin117c8082024-12-04 16:03:28 +00004193 if (ffa_memory_is_handle_allocated_by_current_world(handle)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01004194 struct vm_locked from_locked = vm_lock(from);
4195
4196 ret = ffa_memory_send_continue(from_locked, fragment_copy,
4197 fragment_length, handle,
4198 &api_page_pool);
4199 /*
4200 * `ffa_memory_send_continue` takes ownership of the
4201 * fragment_copy, so we don't need to free it here.
4202 */
4203 vm_unlock(&from_locked);
4204 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004205 ret = ffa_memory_other_world_mem_send_continue(
J-Alvesfdd29272022-07-19 13:16:31 +01004206 from, fragment_copy, fragment_length, handle,
4207 &api_page_pool);
Andrew Walbran290b0c92020-02-03 16:37:14 +00004208 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00004209
4210 return ret;
4211}
Max Shvetsov40108e72020-08-27 12:39:50 +01004212
Olivier Deprezd614d322021-06-18 15:21:00 +02004213/**
4214 * Register an entry point for a vCPU in warm boot cases.
4215 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1 FFA_SECONDARY_EP_REGISTER.
4216 */
Max Shvetsov40108e72020-08-27 12:39:50 +01004217struct ffa_value api_ffa_secondary_ep_register(ipaddr_t entry_point,
4218 struct vcpu *current)
4219{
4220 struct vm_locked vm_locked;
Olivier Deprezb2808332023-02-02 15:25:40 +01004221 struct vcpu_locked current_locked;
Max Shvetsov40108e72020-08-27 12:39:50 +01004222
Olivier Deprezd614d322021-06-18 15:21:00 +02004223 /*
4224 * Reject if interface is not supported at this FF-A instance
4225 * (DEN0077A FF-A v1.1 Beta0 Table 18.29) or the VM is UP.
4226 */
Karl Meakin117c8082024-12-04 16:03:28 +00004227 if (!ffa_setup_is_secondary_ep_register_supported() ||
Karl Meakin82041822024-05-20 11:14:34 +01004228 vm_is_up(current->vm)) {
Olivier Deprezd614d322021-06-18 15:21:00 +02004229 return ffa_error(FFA_NOT_SUPPORTED);
4230 }
4231
4232 /*
4233 * No further check is made on the address validity
4234 * (FF-A v1.1 Beta0 Table 18.29) as the VM boundaries are not known
4235 * from the VM or vCPU structure.
4236 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1.1:
4237 * For each SP [...] the Framework assumes that the same entry point
4238 * address is used for initializing any execution context during a
4239 * secondary cold boot.
4240 * If this function is invoked multiple times, then the entry point
4241 * address specified in the last valid invocation must be used by the
4242 * callee.
4243 */
Olivier Deprezb2808332023-02-02 15:25:40 +01004244 current_locked = vcpu_lock(current);
4245 if (current->rt_model != RTM_SP_INIT) {
4246 dlog_error(
4247 "FFA_SECONDARY_EP_REGISTER can only be called while "
4248 "vCPU in run-time state for initialization.\n");
4249 vcpu_unlock(&current_locked);
4250 return ffa_error(FFA_DENIED);
Olivier Deprezd614d322021-06-18 15:21:00 +02004251 }
Olivier Deprezb2808332023-02-02 15:25:40 +01004252 vcpu_unlock(&current_locked);
Olivier Deprezd614d322021-06-18 15:21:00 +02004253
Olivier Deprezb2808332023-02-02 15:25:40 +01004254 vm_locked = vm_lock(current->vm);
Max Shvetsov40108e72020-08-27 12:39:50 +01004255 vm_locked.vm->secondary_ep = entry_point;
4256 vm_unlock(&vm_locked);
4257
Olivier Deprezb2808332023-02-02 15:25:40 +01004258 return (struct ffa_value){.func = FFA_SUCCESS_32};
Max Shvetsov40108e72020-08-27 12:39:50 +01004259}
J-Alvesa0f317d2021-06-09 13:31:59 +01004260
J-Alves19e20cf2023-08-02 12:48:55 +01004261struct ffa_value api_ffa_notification_bitmap_create(ffa_id_t vm_id,
J-Alvesa0f317d2021-06-09 13:31:59 +01004262 ffa_vcpu_count_t vcpu_count,
4263 struct vcpu *current)
4264{
J-Alves7ccaccf2024-02-01 14:25:23 +00004265 const struct ffa_value ret =
Karl Meakin117c8082024-12-04 16:03:28 +00004266 ffa_notifications_is_bitmap_access_valid(current, vm_id);
J-Alves7ccaccf2024-02-01 14:25:23 +00004267
4268 if (ffa_func_id(ret) != FFA_SUCCESS_32) {
4269 dlog_verbose(
4270 "FFA_NOTIFICATION_BITMAP_CREATE to be used by "
4271 "hypervisor for valid NWd VM IDs only (%x).\n",
4272 vm_id);
4273 return ret;
J-Alvesa0f317d2021-06-09 13:31:59 +01004274 }
4275
Karl Meakin117c8082024-12-04 16:03:28 +00004276 return ffa_notifications_bitmap_create(vm_id, vcpu_count);
J-Alvesa0f317d2021-06-09 13:31:59 +01004277}
4278
J-Alves19e20cf2023-08-02 12:48:55 +01004279struct ffa_value api_ffa_notification_bitmap_destroy(ffa_id_t vm_id,
J-Alvesa0f317d2021-06-09 13:31:59 +01004280 struct vcpu *current)
4281{
J-Alves7ccaccf2024-02-01 14:25:23 +00004282 const struct ffa_value ret =
Karl Meakin117c8082024-12-04 16:03:28 +00004283 ffa_notifications_is_bitmap_access_valid(current, vm_id);
J-Alves7ccaccf2024-02-01 14:25:23 +00004284
4285 if (ffa_func_id(ret) != FFA_SUCCESS_32) {
4286 dlog_verbose(
4287 "FFA_NOTIFICATION_BITMAP_DESTROY to be used by "
4288 "hypervisor for valid NWd VM IDs only (%x).\n",
4289 vm_id);
4290 return ret;
J-Alvesa0f317d2021-06-09 13:31:59 +01004291 }
4292
Karl Meakin117c8082024-12-04 16:03:28 +00004293 return ffa_notifications_bitmap_destroy(vm_id);
J-Alvesa0f317d2021-06-09 13:31:59 +01004294}
J-Alvesc003a7a2021-03-18 13:06:53 +00004295
4296struct ffa_value api_ffa_notification_update_bindings(
J-Alves19e20cf2023-08-02 12:48:55 +01004297 ffa_id_t sender_vm_id, ffa_id_t receiver_vm_id, uint32_t flags,
J-Alvesc003a7a2021-03-18 13:06:53 +00004298 ffa_notifications_bitmap_t notifications, bool is_bind,
4299 struct vcpu *current)
4300{
4301 struct ffa_value ret = {.func = FFA_SUCCESS_32};
4302 struct vm_locked receiver_locked;
4303 const bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
J-Alves19e20cf2023-08-02 12:48:55 +01004304 const ffa_id_t id_to_update = is_bind ? sender_vm_id : HF_INVALID_VM_ID;
4305 const ffa_id_t id_to_validate =
J-Alvesc003a7a2021-03-18 13:06:53 +00004306 is_bind ? HF_INVALID_VM_ID : sender_vm_id;
J-Alves1daeaea2022-09-06 17:41:24 +01004307 const uint32_t flags_mbz =
4308 is_bind ? ~FFA_NOTIFICATIONS_FLAG_PER_VCPU : ~0U;
4309
4310 if ((flags_mbz & flags) != 0U) {
4311 return ffa_error(FFA_INVALID_PARAMETERS);
4312 }
J-Alvesc003a7a2021-03-18 13:06:53 +00004313
Karl Meakin117c8082024-12-04 16:03:28 +00004314 if (!ffa_notifications_is_bind_valid(current, sender_vm_id,
4315 receiver_vm_id)) {
J-Alvesc003a7a2021-03-18 13:06:53 +00004316 dlog_verbose("Invalid use of notifications bind interface.\n");
4317 return ffa_error(FFA_INVALID_PARAMETERS);
4318 }
4319
Karl Meakin117c8082024-12-04 16:03:28 +00004320 if (ffa_notifications_update_bindings_forward(
J-Alvesb15e9402021-09-08 11:44:42 +01004321 receiver_vm_id, sender_vm_id, flags, notifications, is_bind,
4322 &ret)) {
J-Alvesb15e9402021-09-08 11:44:42 +01004323 return ret;
4324 }
4325
J-Alvesc003a7a2021-03-18 13:06:53 +00004326 if (notifications == 0U) {
Karl Meakine8937d92024-03-19 16:04:25 +00004327 dlog_verbose("No notifications have been specified %lx.\n",
J-Alves1512acc2024-02-01 16:57:10 +00004328 notifications);
J-Alvesc003a7a2021-03-18 13:06:53 +00004329 return ffa_error(FFA_INVALID_PARAMETERS);
4330 }
4331
4332 /**
4333 * This check assumes receiver is the current VM, and has been enforced
Karl Meakin117c8082024-12-04 16:03:28 +00004334 * by 'ffa_notifications_is_bind_valid'.
J-Alvesc003a7a2021-03-18 13:06:53 +00004335 */
Karl Meakin117c8082024-12-04 16:03:28 +00004336 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesc003a7a2021-03-18 13:06:53 +00004337
4338 if (receiver_locked.vm == NULL) {
4339 dlog_verbose("Receiver doesn't exist!\n");
J-Alves7333dcf2024-02-01 17:25:10 +00004340 return ffa_error(FFA_INVALID_PARAMETERS);
J-Alvesc003a7a2021-03-18 13:06:53 +00004341 }
4342
J-Alves3e55c4d2024-10-09 14:24:07 +01004343 if (receiver_locked.vm->ffa_version < FFA_VERSION_1_1) {
4344 dlog_verbose(
4345 "%s: caller (%x) version should be GE to FF-A v1.1.\n",
4346 __func__, receiver_locked.vm->id);
4347 ret = ffa_error(FFA_NOT_SUPPORTED);
4348 goto out;
4349 }
4350
J-Alves09ff9d82021-11-02 11:55:20 +00004351 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesc003a7a2021-03-18 13:06:53 +00004352 dlog_verbose("Notifications are not enabled.\n");
4353 ret = ffa_error(FFA_NOT_SUPPORTED);
4354 goto out;
4355 }
4356
4357 if (is_bind && vm_id_is_current_world(sender_vm_id) &&
4358 vm_find(sender_vm_id) == NULL) {
4359 dlog_verbose("Sender VM does not exist!\n");
4360 ret = ffa_error(FFA_INVALID_PARAMETERS);
4361 goto out;
4362 }
4363
4364 /*
4365 * Can't bind/unbind notifications if at least one is bound to a
4366 * different sender.
4367 */
4368 if (!vm_notifications_validate_bound_sender(
J-Alves661e1b72023-08-02 13:39:40 +01004369 receiver_locked, ffa_is_vm_id(sender_vm_id), id_to_validate,
4370 notifications)) {
J-Alvesf0208142024-02-01 17:28:58 +00004371 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004372 "Sender %x not permitted to set notifications %lx to "
J-Alvesf0208142024-02-01 17:28:58 +00004373 "%x.\n",
4374 sender_vm_id, notifications, receiver_vm_id);
J-Alvesc003a7a2021-03-18 13:06:53 +00004375 ret = ffa_error(FFA_DENIED);
4376 goto out;
4377 }
4378
4379 /**
4380 * Check if there is a pending notification within those specified in
4381 * the bitmap.
4382 */
4383 if (vm_are_notifications_pending(receiver_locked,
J-Alves661e1b72023-08-02 13:39:40 +01004384 ffa_is_vm_id(sender_vm_id),
J-Alvesc003a7a2021-03-18 13:06:53 +00004385 notifications)) {
Karl Meakine8937d92024-03-19 16:04:25 +00004386 dlog_verbose("Notifications within '%lx' pending.\n",
J-Alvesc003a7a2021-03-18 13:06:53 +00004387 notifications);
4388 ret = ffa_error(FFA_DENIED);
4389 goto out;
4390 }
4391
4392 vm_notifications_update_bindings(
J-Alves661e1b72023-08-02 13:39:40 +01004393 receiver_locked, ffa_is_vm_id(sender_vm_id), id_to_update,
J-Alvesc003a7a2021-03-18 13:06:53 +00004394 notifications, is_per_vcpu && is_bind);
4395
4396out:
4397 vm_unlock(&receiver_locked);
4398 return ret;
4399}
J-Alvesaa79c012021-07-09 14:29:45 +01004400
4401struct ffa_value api_ffa_notification_set(
J-Alves19e20cf2023-08-02 12:48:55 +01004402 ffa_id_t sender_vm_id, ffa_id_t receiver_vm_id, uint32_t flags,
J-Alvesaa79c012021-07-09 14:29:45 +01004403 ffa_notifications_bitmap_t notifications, struct vcpu *current)
4404{
4405 struct ffa_value ret;
4406 struct vm_locked receiver_locked;
J-Alvesaa79c012021-07-09 14:29:45 +01004407 /*
4408 * Check if is per-vCPU or global, and extracting vCPU ID according
4409 * to table 17.19 of the FF-A v1.1 Beta 0 spec.
4410 */
4411 bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
4412 ffa_vcpu_index_t vcpu_id = (uint16_t)(flags >> 16);
J-Alves6b754a12024-02-14 14:26:30 +00004413 const uint32_t flags_mbz =
4414 ~(FFA_NOTIFICATIONS_FLAG_PER_VCPU |
4415 FFA_NOTIFICATIONS_FLAG_DELAY_SRI | (0xFFFFU << 16));
J-Alves41c5da32024-06-19 10:05:05 +01004416 const bool delay_sri = (FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) != 0U;
J-Alves6b754a12024-02-14 14:26:30 +00004417
4418 if ((flags_mbz & flags) != 0U) {
4419 dlog_verbose("%s: caller shouldn't set bits that MBZ.\n",
4420 __func__);
4421 return ffa_error(FFA_INVALID_PARAMETERS);
4422 }
J-Alvesaa79c012021-07-09 14:29:45 +01004423
J-Alves30ac91d2024-02-14 15:33:12 +00004424 /* Global notifications must target any vCPU. */
4425 if (!is_per_vcpu && vcpu_id != 0U) {
4426 dlog_verbose(
4427 "For global notifications vCPU ID MBZ in call to set "
4428 "notifications.\n");
4429 return ffa_error(FFA_INVALID_PARAMETERS);
4430 }
4431
Karl Meakin117c8082024-12-04 16:03:28 +00004432 if (!ffa_notifications_is_set_valid(current, sender_vm_id,
4433 receiver_vm_id)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004434 dlog_verbose("Invalid use of notifications set interface.\n");
4435 return ffa_error(FFA_INVALID_PARAMETERS);
4436 }
4437
4438 if (notifications == 0U) {
4439 dlog_verbose("No notifications have been specified.\n");
4440 return ffa_error(FFA_INVALID_PARAMETERS);
4441 }
4442
J-Alves41c5da32024-06-19 10:05:05 +01004443 /*
4444 * The 'Delay Schedule Receiver interrupt flag' only applies to the
4445 * secure virtual FF-A instance.
4446 */
4447 if (!vm_id_is_current_world(sender_vm_id) && delay_sri) {
4448 dlog_verbose(
4449 "The delay SRI flag can only be set at the secure "
4450 "virtual FF-A instance.\n");
4451 return ffa_error(FFA_INVALID_PARAMETERS);
4452 }
4453
Karl Meakin117c8082024-12-04 16:03:28 +00004454 if (ffa_notifications_set_forward(sender_vm_id, receiver_vm_id, flags,
4455 notifications, &ret)) {
J-Alvesde7bd2f2021-09-09 19:54:35 +01004456 return ret;
4457 }
4458
J-Alvesaa79c012021-07-09 14:29:45 +01004459 /*
4460 * This check assumes receiver is the current VM, and has been enforced
Karl Meakin117c8082024-12-04 16:03:28 +00004461 * by 'ffa_notifications_is_set_valid'.
J-Alvesaa79c012021-07-09 14:29:45 +01004462 */
Karl Meakin117c8082024-12-04 16:03:28 +00004463 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesaa79c012021-07-09 14:29:45 +01004464
4465 if (receiver_locked.vm == NULL) {
4466 dlog_verbose("Receiver ID is not valid.\n");
4467 return ffa_error(FFA_INVALID_PARAMETERS);
4468 }
4469
J-Alves09ff9d82021-11-02 11:55:20 +00004470 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004471 dlog_verbose("Receiver's notifications not enabled.\n");
4472 ret = ffa_error(FFA_DENIED);
4473 goto out;
4474 }
4475
4476 /*
J-Alves89c22132024-02-14 15:44:41 +00004477 * Check the if the notifications are bound as global if per-vCPU flag
4478 * is set, or if they are bound as per-vCPU and caller setting as
4479 * global. In either case, return FFA_INVALID_PARAMETERS.
4480 */
4481 if (vm_notifications_validate_binding(
4482 receiver_locked, ffa_is_vm_id(sender_vm_id), sender_vm_id,
4483 notifications, !is_per_vcpu)) {
Karl Meakine8937d92024-03-19 16:04:25 +00004484 dlog_verbose("Notifications in %lx are %s\n", notifications,
J-Alves89c22132024-02-14 15:44:41 +00004485 !is_per_vcpu ? "global" : "per-vCPU");
4486 ret = ffa_error(FFA_INVALID_PARAMETERS);
4487 goto out;
4488 }
4489
4490 /*
J-Alvesaa79c012021-07-09 14:29:45 +01004491 * If notifications are not bound to the sender, they wouldn't be
4492 * enabled either for the receiver.
4493 */
4494 if (!vm_notifications_validate_binding(
J-Alves661e1b72023-08-02 13:39:40 +01004495 receiver_locked, ffa_is_vm_id(sender_vm_id), sender_vm_id,
4496 notifications, is_per_vcpu)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004497 dlog_verbose("Notifications bindings not valid.\n");
4498 ret = ffa_error(FFA_DENIED);
4499 goto out;
4500 }
4501
4502 if (is_per_vcpu && vcpu_id >= receiver_locked.vm->vcpu_count) {
4503 dlog_verbose("Invalid VCPU ID!\n");
4504 ret = ffa_error(FFA_INVALID_PARAMETERS);
4505 goto out;
4506 }
4507
J-Alves7461ef22021-10-18 17:21:33 +01004508 /* Set notifications pending. */
J-Alves5a16c962022-03-25 12:32:51 +00004509 vm_notifications_partition_set_pending(
J-Alves661e1b72023-08-02 13:39:40 +01004510 receiver_locked, ffa_is_vm_id(sender_vm_id), notifications,
J-Alves5a16c962022-03-25 12:32:51 +00004511 vcpu_id, is_per_vcpu);
4512
Karl Meakine8937d92024-03-19 16:04:25 +00004513 dlog_verbose("Set the notifications: %lx.\n", notifications);
J-Alvesaa79c012021-07-09 14:29:45 +01004514
J-Alves41c5da32024-06-19 10:05:05 +01004515 if (!delay_sri) {
J-Alves13394022021-06-30 13:48:49 +01004516 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
4517 vcpu_index(current));
Karl Meakin117c8082024-12-04 16:03:28 +00004518 ffa_notifications_sri_trigger_not_delayed(current->cpu);
J-Alves13394022021-06-30 13:48:49 +01004519 } else {
Karl Meakin117c8082024-12-04 16:03:28 +00004520 ffa_notifications_sri_set_delayed(current->cpu);
J-Alves13394022021-06-30 13:48:49 +01004521 }
J-Alvesaa79c012021-07-09 14:29:45 +01004522
J-Alves13394022021-06-30 13:48:49 +01004523 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
J-Alvesaa79c012021-07-09 14:29:45 +01004524out:
4525 vm_unlock(&receiver_locked);
4526
4527 return ret;
4528}
4529
4530static struct ffa_value api_ffa_notification_get_success_return(
4531 ffa_notifications_bitmap_t from_sp, ffa_notifications_bitmap_t from_vm,
4532 ffa_notifications_bitmap_t from_framework)
4533{
4534 return (struct ffa_value){
4535 .func = FFA_SUCCESS_32,
4536 .arg1 = 0U,
4537 .arg2 = (uint32_t)from_sp,
4538 .arg3 = (uint32_t)(from_sp >> 32),
4539 .arg4 = (uint32_t)from_vm,
4540 .arg5 = (uint32_t)(from_vm >> 32),
4541 .arg6 = (uint32_t)from_framework,
4542 .arg7 = (uint32_t)(from_framework >> 32),
4543 };
4544}
4545
J-Alves19e20cf2023-08-02 12:48:55 +01004546struct ffa_value api_ffa_notification_get(ffa_id_t receiver_vm_id,
J-Alvesaa79c012021-07-09 14:29:45 +01004547 ffa_vcpu_index_t vcpu_id,
4548 uint32_t flags, struct vcpu *current)
4549{
J-Alves663682a2022-03-25 13:56:51 +00004550 ffa_notifications_bitmap_t framework_notifications = 0;
J-Alvesaa79c012021-07-09 14:29:45 +01004551 ffa_notifications_bitmap_t sp_notifications = 0;
4552 ffa_notifications_bitmap_t vm_notifications = 0;
4553 struct vm_locked receiver_locked;
4554 struct ffa_value ret;
J-Alvesfc95a302022-04-22 14:18:23 +01004555 const uint32_t flags_mbz = ~(FFA_NOTIFICATION_FLAG_BITMAP_HYP |
4556 FFA_NOTIFICATION_FLAG_BITMAP_SPM |
4557 FFA_NOTIFICATION_FLAG_BITMAP_SP |
4558 FFA_NOTIFICATION_FLAG_BITMAP_VM);
4559
4560 /* The FF-A v1.1 EAC0 specification states bits [31:4] Must Be Zero. */
4561 if ((flags & flags_mbz) != 0U) {
4562 dlog_verbose(
4563 "Invalid flags bit(s) set in notifications get. [31:4] "
4564 "MBZ(%x)\n",
4565 flags);
4566 return ffa_error(FFA_INVALID_PARAMETERS);
4567 }
J-Alvesaa79c012021-07-09 14:29:45 +01004568
4569 /*
J-Alvesfc95a302022-04-22 14:18:23 +01004570 * Following check should capture wrong uses of the interface,
4571 * depending on whether Hafnium is SPMC or hypervisor. On the
4572 * rest of the function it is assumed this condition is met.
J-Alvesaa79c012021-07-09 14:29:45 +01004573 */
Karl Meakin117c8082024-12-04 16:03:28 +00004574 if (!ffa_notifications_is_get_valid(current, receiver_vm_id, flags)) {
J-Alvesaa79c012021-07-09 14:29:45 +01004575 dlog_verbose("Invalid use of notifications get interface.\n");
4576 return ffa_error(FFA_INVALID_PARAMETERS);
4577 }
4578
4579 /*
4580 * This check assumes receiver is the current VM, and has been enforced
Karl Meakinfa1dcb82025-02-10 16:47:50 +00004581 * by `ffa_notifications_is_get_valid`.
J-Alvesaa79c012021-07-09 14:29:45 +01004582 */
Karl Meakin117c8082024-12-04 16:03:28 +00004583 receiver_locked = ffa_vm_find_locked(receiver_vm_id);
J-Alvesaa79c012021-07-09 14:29:45 +01004584
4585 /*
Karl Meakinfa1dcb82025-02-10 16:47:50 +00004586 * `ffa_notifications_is_get_valid` ensures following is never
J-Alvesaa79c012021-07-09 14:29:45 +01004587 * true.
4588 */
4589 CHECK(receiver_locked.vm != NULL);
4590
J-Alves60458812024-03-22 11:57:10 +00004591 if (receiver_locked.vm->vcpu_count <= vcpu_id) {
J-Alves1abb3342022-01-05 11:59:10 +00004592 dlog_verbose(
Karl Meakine8937d92024-03-19 16:04:25 +00004593 "Invalid VCPU ID %u. vcpu count %u current core: "
4594 "%zu!\n",
J-Alves1abb3342022-01-05 11:59:10 +00004595 vcpu_id, receiver_locked.vm->vcpu_count,
4596 cpu_index(current->cpu));
J-Alvesaa79c012021-07-09 14:29:45 +01004597 ret = ffa_error(FFA_INVALID_PARAMETERS);
4598 goto out;
4599 }
4600
4601 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_SP) != 0U) {
Karl Meakin117c8082024-12-04 16:03:28 +00004602 ret = ffa_notifications_get_from_sp(receiver_locked, vcpu_id,
4603 &sp_notifications);
Karl Meakinf9c73ce2024-07-30 17:37:13 +01004604 if (ret.func == FFA_ERROR_32) {
J-Alves98ff9562021-09-09 14:39:41 +01004605 dlog_verbose("Failed to get notifications from sps.");
4606 goto out;
4607 }
J-Alvesaa79c012021-07-09 14:29:45 +01004608 }
4609
4610 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_VM) != 0U) {
J-Alves5136dda2022-03-25 12:26:38 +00004611 vm_notifications = vm_notifications_partition_get_pending(
J-Alvesaa79c012021-07-09 14:29:45 +01004612 receiver_locked, true, vcpu_id);
4613 }
4614
J-Alvesd605a092022-03-28 14:20:48 +01004615 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_HYP) != 0U ||
4616 (flags & FFA_NOTIFICATION_FLAG_BITMAP_SPM) != 0U) {
Karl Meakin117c8082024-12-04 16:03:28 +00004617 ret = ffa_notifications_get_framework_notifications(
Karl Meakinf9c73ce2024-07-30 17:37:13 +01004618 receiver_locked, &framework_notifications, flags,
4619 vcpu_id);
4620 if (ret.func == FFA_ERROR_32) {
J-Alvesd605a092022-03-28 14:20:48 +01004621 dlog_verbose(
4622 "Failed to get notifications from "
4623 "framework.\n");
4624 goto out;
4625 }
4626 }
4627
J-Alves663682a2022-03-25 13:56:51 +00004628 ret = api_ffa_notification_get_success_return(
4629 sp_notifications, vm_notifications, framework_notifications);
J-Alvesaa79c012021-07-09 14:29:45 +01004630
4631out:
4632 vm_unlock(&receiver_locked);
4633
4634 return ret;
4635}
J-Alvesc8e8a222021-06-08 17:33:52 +01004636
4637/**
4638 * Prepares successful return for FFA_NOTIFICATION_INFO_GET, as described by
4639 * the section 17.7.1 of the FF-A v1.1 Beta0 specification.
4640 */
4641static struct ffa_value api_ffa_notification_info_get_success_return(
4642 const uint16_t *ids, uint32_t ids_count, const uint32_t *lists_sizes,
J-Alvesfe23ebe2021-10-13 16:07:07 +01004643 uint32_t lists_count)
J-Alvesc8e8a222021-06-08 17:33:52 +01004644{
4645 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_64};
4646
4647 /*
4648 * Copying content of ids into ret structure. Use 5 registers (x3-x7) to
4649 * hold the list of ids.
4650 */
4651 memcpy_s(&ret.arg3,
4652 sizeof(ret.arg3) * FFA_NOTIFICATIONS_INFO_GET_REGS_RET, ids,
4653 sizeof(ids[0]) * ids_count);
4654
4655 /*
4656 * According to the spec x2 should have:
4657 * - Bit flagging if there are more notifications pending;
4658 * - The total number of elements (i.e. total list size);
4659 * - The number of VCPU IDs within each VM specific list.
4660 */
J-Alvesfe23ebe2021-10-13 16:07:07 +01004661 ret.arg2 = vm_notifications_pending_not_retrieved_by_scheduler()
4662 ? FFA_NOTIFICATIONS_INFO_GET_FLAG_MORE_PENDING
4663 : 0;
J-Alvesc8e8a222021-06-08 17:33:52 +01004664
4665 ret.arg2 |= (lists_count & FFA_NOTIFICATIONS_LISTS_COUNT_MASK)
4666 << FFA_NOTIFICATIONS_LISTS_COUNT_SHIFT;
4667
4668 for (unsigned int i = 0; i < lists_count; i++) {
4669 ret.arg2 |= (lists_sizes[i] & FFA_NOTIFICATIONS_LIST_SIZE_MASK)
4670 << FFA_NOTIFICATIONS_LIST_SHIFT(i + 1);
4671 }
4672
4673 return ret;
4674}
4675
4676struct ffa_value api_ffa_notification_info_get(struct vcpu *current)
4677{
4678 /*
4679 * Following set of variables should be populated with the return info.
4680 * At a successfull handling of this interface, they should be used
4681 * to populate the 'ret' structure in accordance to the table 17.29
4682 * of the FF-A v1.1 Beta0 specification.
4683 */
4684 uint16_t ids[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS];
4685 uint32_t lists_sizes[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS] = {0};
4686 uint32_t lists_count = 0;
4687 uint32_t ids_count = 0;
4688 bool list_is_full = false;
J-Alves13394022021-06-30 13:48:49 +01004689 struct ffa_value result;
J-Alvesc8e8a222021-06-08 17:33:52 +01004690
4691 /*
4692 * This interface can only be called at NS virtual/physical FF-A
4693 * instance by the endpoint implementing the primary scheduler and the
4694 * Hypervisor/OS kernel.
4695 * In the SPM, following check passes if call has been forwarded from
4696 * the hypervisor.
4697 */
Karl Meakin5e996992024-05-20 11:27:07 +01004698
4699 if (!vm_is_primary(current->vm)) {
J-Alvesc8e8a222021-06-08 17:33:52 +01004700 dlog_verbose(
4701 "Only the receiver's scheduler can use this "
4702 "interface\n");
4703 return ffa_error(FFA_NOT_SUPPORTED);
4704 }
4705
J-Alvesca058c22021-09-10 14:02:07 +01004706 /*
4707 * Forward call to the other world, and fill the arrays used to assemble
4708 * return.
4709 */
Karl Meakin117c8082024-12-04 16:03:28 +00004710 ffa_notifications_info_get_forward(ids, &ids_count, lists_sizes,
4711 &lists_count,
4712 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
J-Alvesca058c22021-09-10 14:02:07 +01004713
4714 list_is_full = ids_count == FFA_NOTIFICATIONS_INFO_GET_MAX_IDS;
4715
J-Alvesc8e8a222021-06-08 17:33:52 +01004716 /* Get notifications' info from this world */
4717 for (ffa_vm_count_t index = 0; index < vm_get_count() && !list_is_full;
4718 ++index) {
4719 struct vm_locked vm_locked = vm_lock(vm_find_index(index));
4720
4721 list_is_full = vm_notifications_info_get(
4722 vm_locked, ids, &ids_count, lists_sizes, &lists_count,
4723 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
4724
4725 vm_unlock(&vm_locked);
4726 }
4727
4728 if (!list_is_full) {
4729 /* Grab notifications info from other world */
Karl Meakin117c8082024-12-04 16:03:28 +00004730 ffa_vm_notifications_info_get(
J-Alvesc8e8a222021-06-08 17:33:52 +01004731 ids, &ids_count, lists_sizes, &lists_count,
4732 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
4733 }
4734
4735 if (ids_count == 0) {
J-Alvesca058c22021-09-10 14:02:07 +01004736 dlog_verbose(
4737 "Notification info get has no data to retrieve.\n");
J-Alves13394022021-06-30 13:48:49 +01004738 result = ffa_error(FFA_NO_DATA);
4739 } else {
4740 result = api_ffa_notification_info_get_success_return(
J-Alvesfe23ebe2021-10-13 16:07:07 +01004741 ids, ids_count, lists_sizes, lists_count);
J-Alvesc8e8a222021-06-08 17:33:52 +01004742 }
4743
J-Alves13394022021-06-30 13:48:49 +01004744 return result;
J-Alvesc8e8a222021-06-08 17:33:52 +01004745}
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004746
Karl Meakin04f86c92025-03-11 15:47:29 +00004747/*
4748 * Calculate the end of the memory range (`base_addr + page_count * PAGE_SIZE`)
4749 * and write the result to `*res`.
4750 * Returns whether any of the intermediate operations overflowed.
4751 */
4752static bool api_memory_range_end(vaddr_t base_addr, uint32_t page_count,
4753 vaddr_t *res)
4754{
4755 uint64_t range_size;
4756 uintvaddr_t end_addr;
4757
4758 if (mul_overflow(page_count, PAGE_SIZE, &range_size)) {
4759 return true;
4760 }
4761
4762 if (add_overflow(va_addr(base_addr), range_size, &end_addr)) {
4763 return true;
4764 }
4765
4766 *res = va_init(end_addr);
4767 return false;
4768}
4769
Karl Meakined91e992025-02-01 16:16:27 +00004770struct ffa_value api_ffa_mem_perm_get(vaddr_t base_addr, uint32_t page_count,
4771 struct vcpu *current)
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004772{
4773 struct vm_locked vm_locked;
Karl Meakincdecdba2025-02-01 15:36:58 +00004774 struct ffa_value ret;
4775 bool mode_ret;
4776 uint32_t mode;
Karl Meakined91e992025-02-01 16:16:27 +00004777 vaddr_t end_addr;
4778
4779 /**
4780 * The size of the memory region is calculated as (page_count + 1) *
4781 * granule size to ensure backwards compatability: v1.2 or earlier
4782 * callers, who leave `arg2` as 0, will get the correct behaviour
4783 * (querying a single page).
Karl Meakin04f86c92025-03-11 15:47:29 +00004784 *
4785 * Any overflow will be caught by the check against zero.
Karl Meakined91e992025-02-01 16:16:27 +00004786 */
4787 page_count += 1;
Karl Meakin04f86c92025-03-11 15:47:29 +00004788
4789 /* Empty ranges should be disallowed, as should ranges that overflow */
4790 if (page_count == 0) {
4791 dlog_error("FFA_MEM_PERM_GET: page_count was zero\n");
4792 return ffa_error(FFA_INVALID_PARAMETERS);
4793 }
4794
4795 if (api_memory_range_end(base_addr, page_count, &end_addr)) {
4796 dlog_error("FFA_MEM_PERM_GET: overflow calculating end_addr\n");
4797 return ffa_error(FFA_INVALID_PARAMETERS);
4798 }
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004799
Karl Meakin117c8082024-12-04 16:03:28 +00004800 if (!ffa_memory_is_mem_perm_get_valid(current)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004801 dlog_error("FFA_MEM_PERM_GET: not allowed\n");
J-Alves5a099172024-02-22 14:34:51 +00004802 return ffa_error(FFA_DENIED);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004803 }
4804
Karl Meakincdecdba2025-02-01 15:36:58 +00004805 if (!is_aligned(va_addr(base_addr), PAGE_SIZE)) {
4806 dlog_error(
4807 "FFA_MEM_PERM_GET: base addr %#016lx is not page "
4808 "aligned\n",
4809 va_addr(base_addr));
4810 return ffa_error(FFA_INVALID_PARAMETERS);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004811 }
4812
4813 vm_locked = vm_lock(current->vm);
4814
4815 /*
Karl Meakin9f568582025-02-20 17:12:32 +00004816 * mm_get_mode_partial is used to check if the given base_addr page is
4817 * already mapped. If the page is unmapped, return error. If the page is
4818 * mapped appropriate attributes are returned to the caller. Note that
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004819 * mm_get_mode returns true if the address is in the valid VA range as
4820 * supported by the architecture and MMU configurations, as opposed to
4821 * whether a page is mapped or not. For a page to be known as mapped,
4822 * the API must return true AND the returned mode must not have
4823 * MM_MODE_INVALID set.
4824 */
Karl Meakin9f568582025-02-20 17:12:32 +00004825 mode_ret = mm_get_mode_partial(&vm_locked.vm->ptable, base_addr,
4826 end_addr, &mode, &end_addr);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004827 if (!mode_ret || (mode & MM_MODE_INVALID)) {
Karl Meakined91e992025-02-01 16:16:27 +00004828 dlog_error(
4829 "FFA_MEM_PERM_GET: cannot find permission for range "
4830 "%#016lx - %#016lx\n",
4831 va_addr(base_addr), va_addr(end_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004832 ret = ffa_error(FFA_INVALID_PARAMETERS);
4833 goto out;
4834 }
Karl Meakin9f568582025-02-20 17:12:32 +00004835 page_count = (va_addr(end_addr) - va_addr(base_addr)) / PAGE_SIZE;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004836
4837 /* No memory should be marked RWX */
4838 CHECK((mode & (MM_MODE_R | MM_MODE_W | MM_MODE_X)) !=
4839 (MM_MODE_R | MM_MODE_W | MM_MODE_X));
4840
4841 /*
4842 * S-EL0 partitions are expected to have all their pages marked as
4843 * non-global.
4844 */
4845 CHECK((mode & (MM_MODE_NG | MM_MODE_USER)) ==
4846 (MM_MODE_NG | MM_MODE_USER));
4847
Karl Meakin80220052025-02-20 14:43:34 +00004848 ret = (struct ffa_value){
4849 .func = FFA_SUCCESS_32,
Karl Meakined91e992025-02-01 16:16:27 +00004850 /* Same logic as for the input page count. */
4851 .arg3 = page_count - 1,
Karl Meakin80220052025-02-20 14:43:34 +00004852 };
Karl Meakincdecdba2025-02-01 15:36:58 +00004853
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004854 if (mode & MM_MODE_W) {
4855 /* No memory should be writeable but not readable. */
4856 CHECK(mode & MM_MODE_R);
Karl Meakin80220052025-02-20 14:43:34 +00004857 ret.arg2 = FFA_MEM_PERM_RW;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004858 } else if (mode & MM_MODE_R) {
Karl Meakin80220052025-02-20 14:43:34 +00004859 ret.arg2 = FFA_MEM_PERM_RX;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004860 if (!(mode & MM_MODE_X)) {
Karl Meakin80220052025-02-20 14:43:34 +00004861 ret.arg2 = FFA_MEM_PERM_RO;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004862 }
4863 }
4864out:
4865 vm_unlock(&vm_locked);
4866 return ret;
4867}
4868
4869struct ffa_value api_ffa_mem_perm_set(vaddr_t base_addr, uint32_t page_count,
Karl Meakin80220052025-02-20 14:43:34 +00004870 enum ffa_mem_perm mem_perm,
4871 struct vcpu *current)
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004872{
4873 struct vm_locked vm_locked;
4874 struct ffa_value ret;
Karl Meakincdecdba2025-02-01 15:36:58 +00004875 bool mode_ret;
Karl Meakin07a69ab2025-02-07 14:53:19 +00004876 mm_mode_t original_mode;
4877 mm_mode_t new_mode;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004878 struct mpool local_page_pool;
Karl Meakin04f86c92025-03-11 15:47:29 +00004879 vaddr_t end_addr;
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004880
Karl Meakin117c8082024-12-04 16:03:28 +00004881 if (!ffa_memory_is_mem_perm_set_valid(current)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004882 dlog_error("FFA_MEM_PERM_SET: not allowed\n");
J-Alves5a099172024-02-22 14:34:51 +00004883 return ffa_error(FFA_DENIED);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004884 }
4885
Karl Meakincdecdba2025-02-01 15:36:58 +00004886 if (!current->vm->el0_partition) {
4887 dlog_error("FFA_MEM_PERM_SET: VM %#x is not an EL0 partition\n",
4888 current->vm->id);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004889 return ffa_error(FFA_DENIED);
4890 }
4891
4892 if (!is_aligned(va_addr(base_addr), PAGE_SIZE)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004893 dlog_error(
4894 "FFA_MEM_PERM_SET: base addr %#016lx is not page "
4895 "aligned\n",
4896 va_addr(base_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004897 return ffa_error(FFA_INVALID_PARAMETERS);
4898 }
4899
Karl Meakin04f86c92025-03-11 15:47:29 +00004900 /* Empty ranges should be disallowed, as should ranges that overflow */
4901 if (page_count == 0) {
4902 dlog_error("FFA_MEM_PERM_SET: page_count was zero\n");
4903 return ffa_error(FFA_INVALID_PARAMETERS);
4904 }
4905
4906 if (api_memory_range_end(base_addr, page_count, &end_addr)) {
4907 dlog_error("FFA_MEM_PERM_SET: overflow calculating end_addr\n");
4908 return ffa_error(FFA_INVALID_PARAMETERS);
4909 }
4910
Karl Meakin80220052025-02-20 14:43:34 +00004911 switch (mem_perm) {
4912 case FFA_MEM_PERM_RO:
4913 new_mode = MM_MODE_R | MM_MODE_USER | MM_MODE_NG;
4914 break;
4915 case FFA_MEM_PERM_RW:
4916 new_mode = MM_MODE_R | MM_MODE_W | MM_MODE_USER | MM_MODE_NG;
4917 break;
4918 case FFA_MEM_PERM_RX:
4919 new_mode = MM_MODE_R | MM_MODE_X | MM_MODE_USER | MM_MODE_NG;
4920 break;
4921 default:
Karl Meakincdecdba2025-02-01 15:36:58 +00004922 dlog_error("FFA_MEM_PERM_SET: invalid permissions %#x\n",
4923 mem_perm);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004924 return ffa_error(FFA_INVALID_PARAMETERS);
4925 }
4926
4927 /*
4928 * Create a local pool so any freed memory can't be used by another
4929 * thread. This is to ensure the original mapping can be restored if any
4930 * stage of the process fails.
4931 */
4932 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
4933
4934 vm_locked = vm_lock(current->vm);
4935
4936 /*
4937 * All regions accessible by the partition are mapped during boot. If we
4938 * cannot get a successful translation for the page range, the request
4939 * to change permissions is rejected.
4940 * mm_get_mode is used to check if the given address range is already
4941 * mapped. If the range is unmapped, return error. If the range is
4942 * mapped appropriate attributes are returned to the caller. Note that
4943 * mm_get_mode returns true if the address is in the valid VA range as
4944 * supported by the architecture and MMU configurations, as opposed to
4945 * whether a page is mapped or not. For a page to be known as mapped,
4946 * the API must return true AND the returned mode must not have
4947 * MM_MODE_INVALID set.
4948 */
4949
4950 mode_ret = mm_get_mode(&vm_locked.vm->ptable, base_addr,
4951 va_add(base_addr, page_count * PAGE_SIZE),
4952 &original_mode);
4953 if (!mode_ret || (original_mode & MM_MODE_INVALID)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004954 dlog_error(
4955 "FFA_MEM_PERM_SET: range %#016lx - %#016lx is not "
4956 "mapped\n",
4957 va_addr(base_addr), va_addr(end_addr));
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004958 ret = ffa_error(FFA_INVALID_PARAMETERS);
4959 goto out;
4960 }
4961
4962 /* Device memory cannot be marked as executable */
4963 if ((original_mode & MM_MODE_D) && (mem_perm == FFA_MEM_PERM_RX)) {
Karl Meakincdecdba2025-02-01 15:36:58 +00004964 dlog_error(
4965 "FFA_MEM_PERM_SET: cannot set device memory as "
4966 "executable\n");
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004967 ret = ffa_error(FFA_INVALID_PARAMETERS);
4968 goto out;
4969 }
4970
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004971 /*
4972 * Safe to re-map memory, since we know the requested permissions are
4973 * valid, and the memory requested to be re-mapped is also valid.
4974 */
Karl Meakincdecdba2025-02-01 15:36:58 +00004975 if (!mm_identity_prepare(&vm_locked.vm->ptable, pa_from_va(base_addr),
4976 pa_from_va(end_addr), new_mode,
4977 &local_page_pool)) {
4978 dlog_error(
4979 "FFA_MEM_PERM_SET: remapping memory range %#016lx - "
4980 "%#016lx failed\n",
4981 va_addr(base_addr), va_addr(end_addr));
4982
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07004983 /*
4984 * Defrag the table into the local page pool.
4985 * mm_identity_prepare could have allocated or freed pages to
4986 * split blocks or tables etc.
4987 */
4988 mm_stage1_defrag(&vm_locked.vm->ptable, &local_page_pool);
4989
4990 /*
4991 * Guaranteed to succeed mapping with old mode since the mapping
4992 * with old mode already existed and we have a local page pool
4993 * that should have sufficient memory to go back to the original
4994 * state.
4995 */
4996 CHECK(mm_identity_prepare(
4997 &vm_locked.vm->ptable, pa_from_va(base_addr),
Karl Meakincdecdba2025-02-01 15:36:58 +00004998 pa_from_va(end_addr), original_mode, &local_page_pool));
4999 mm_identity_commit(&vm_locked.vm->ptable, pa_from_va(base_addr),
5000 pa_from_va(end_addr), original_mode,
5001 &local_page_pool);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07005002
5003 mm_stage1_defrag(&vm_locked.vm->ptable, &api_page_pool);
5004 ret = ffa_error(FFA_NO_MEMORY);
5005 goto out;
5006 }
5007
Karl Meakincdecdba2025-02-01 15:36:58 +00005008 mm_identity_commit(&vm_locked.vm->ptable, pa_from_va(base_addr),
5009 pa_from_va(end_addr), new_mode, &local_page_pool);
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07005010
5011 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
5012
5013out:
5014 mpool_fini(&local_page_pool);
5015 vm_unlock(&vm_locked);
5016
5017 return ret;
5018}
Maksims Svecovs71b76702022-05-20 15:32:58 +01005019
5020/**
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005021 * Send the contents of the given vCPU's log buffer to the log, preceded
Karl Meakin705b56e2024-05-22 10:04:32 +01005022 * by the VM ID and followed by a newline.
5023 */
Karl Meakin6f1f1212024-07-16 10:18:16 +01005024void api_flush_log_buffer(struct vcpu_locked *vcpu_locked)
Karl Meakin705b56e2024-05-22 10:04:32 +01005025{
Karl Meakin6f1f1212024-07-16 10:18:16 +01005026 /*
5027 * NOTE: This line is parsed by `hftest.py`.
5028 * If you change the format, make sure to update
5029 * `HFTEST_CTRL_JSON_REGEX` as well.
5030 */
5031 struct vcpu *vcpu = vcpu_locked->vcpu;
5032 struct log_buffer *buffer = &vcpu->log_buffer;
5033 ffa_id_t vm_id = vcpu->vm->id;
5034 ffa_id_t vcpu_id = vcpu_index(vcpu);
5035
Karl Meakin7de26952024-06-14 14:50:19 +01005036 buffer->chars[buffer->len] = '\0';
Olivier Deprezbd432092024-07-26 14:01:12 +02005037 dlog("[%x %u] %s\n", vm_id, vcpu_id, buffer->chars);
Karl Meakin7de26952024-06-14 14:50:19 +01005038 buffer->len = 0;
Karl Meakin705b56e2024-05-22 10:04:32 +01005039}
5040
5041/**
Karl Meakin740f74f2024-02-14 18:04:48 +00005042 * Implements FF-A v1.2 FFA_CONSOLE_LOG ABI for buffered logging.
Maksims Svecovs71b76702022-05-20 15:32:58 +01005043 */
5044struct ffa_value api_ffa_console_log(const struct ffa_value args,
5045 struct vcpu *current)
5046{
Karl Meakin740f74f2024-02-14 18:04:48 +00005047 /* Maximum number of characters is 128: 16 registers of 8 bytes each. */
5048 char chars[128] = {0};
Karl Meakin0e617d92024-04-05 12:55:22 +01005049 const bool v1_2 = current->vm->ffa_version >= FFA_VERSION_1_2;
Karl Meakin740f74f2024-02-14 18:04:48 +00005050 const bool log32 = args.func == FFA_CONSOLE_LOG_32;
Maksims Svecovs71b76702022-05-20 15:32:58 +01005051
Karl Meakin740f74f2024-02-14 18:04:48 +00005052 /*
5053 * 32bit: always 6 registers
5054 * 64bit and less than v1.2: 6 registers
5055 * 64bit and v1.2 or greater: 16 registers
5056 */
Karl Meakin66a38bd2024-05-28 16:00:56 +01005057 /* NOLINTNEXTLINE(readability-avoid-nested-conditional-operator) */
Karl Meakin740f74f2024-02-14 18:04:48 +00005058 const size_t registers_max = log32 ? 6 : (v1_2 ? 16 : 6);
5059 const size_t chars_max =
5060 registers_max * (log32 ? sizeof(uint32_t) : sizeof(uint64_t));
5061 const size_t chars_count = args.arg1;
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005062 struct vcpu_locked vcpu_locked;
5063 struct log_buffer *log_buffer;
Karl Meakin740f74f2024-02-14 18:04:48 +00005064
5065 assert(args.func == FFA_CONSOLE_LOG_32 ||
5066 args.func == FFA_CONSOLE_LOG_64);
5067
5068 if (chars_count == 0 || chars_count > chars_max) {
Maksims Svecovs71b76702022-05-20 15:32:58 +01005069 return ffa_error(FFA_INVALID_PARAMETERS);
5070 }
5071
Karl Meakin740f74f2024-02-14 18:04:48 +00005072 if (log32) {
5073 uint32_t *registers = (uint32_t *)chars;
Maksims Svecovs71b76702022-05-20 15:32:58 +01005074
Karl Meakin740f74f2024-02-14 18:04:48 +00005075 registers[0] = args.arg2 & 0xffffffff;
5076 registers[1] = args.arg3 & 0xffffffff;
5077 registers[2] = args.arg4 & 0xffffffff;
5078 registers[3] = args.arg5 & 0xffffffff;
5079 registers[4] = args.arg6 & 0xffffffff;
5080 registers[5] = args.arg7 & 0xffffffff;
5081 } else {
5082 uint64_t *registers = (uint64_t *)chars;
5083
5084 registers[0] = args.arg2;
5085 registers[1] = args.arg3;
5086 registers[2] = args.arg4;
5087 registers[3] = args.arg5;
5088 registers[4] = args.arg6;
5089 registers[5] = args.arg7;
5090 if (v1_2) {
5091 registers[6] = args.extended_val.arg8;
5092 registers[7] = args.extended_val.arg9;
5093 registers[8] = args.extended_val.arg10;
5094 registers[9] = args.extended_val.arg11;
5095 registers[10] = args.extended_val.arg12;
5096 registers[11] = args.extended_val.arg13;
5097 registers[12] = args.extended_val.arg14;
5098 registers[13] = args.extended_val.arg15;
5099 registers[14] = args.extended_val.arg16;
5100 registers[15] = args.extended_val.arg17;
5101 }
5102 }
5103
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005104 vcpu_locked = vcpu_lock(current);
5105 log_buffer = &current->log_buffer;
Karl Meakin7de26952024-06-14 14:50:19 +01005106
Karl Meakin740f74f2024-02-14 18:04:48 +00005107 for (size_t i = 0; i < chars_count; i++) {
5108 bool flush = false;
5109 const char c = chars[i];
5110
5111 if (c == '\n' || c == '\0') {
5112 flush = true;
5113 } else {
J-Alves33b52f82025-03-21 10:55:31 +00005114 log_buffer->chars[log_buffer->len] = c;
5115 log_buffer->len++;
5116 assert(log_buffer->len <= LOG_BUFFER_SIZE);
Karl Meakin7de26952024-06-14 14:50:19 +01005117 flush = log_buffer->len == LOG_BUFFER_SIZE;
Karl Meakin740f74f2024-02-14 18:04:48 +00005118 }
5119
5120 if (flush) {
Karl Meakin6f1f1212024-07-16 10:18:16 +01005121 api_flush_log_buffer(&vcpu_locked);
Karl Meakin740f74f2024-02-14 18:04:48 +00005122 }
5123 }
Maksims Svecovs71b76702022-05-20 15:32:58 +01005124
Karl Meakinc5cebbc2024-06-17 11:30:27 +01005125 vcpu_unlock(&vcpu_locked);
Maksims Svecovs71b76702022-05-20 15:32:58 +01005126 return (struct ffa_value){.func = FFA_SUCCESS_32};
5127}
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005128
5129/**
5130 * Send an IPI interrupt to a target vcpu belonging to the
5131 * sender that isn't itself.
5132 */
Daniel Boulby84d49b62024-11-04 18:25:59 +00005133int64_t api_hf_interrupt_send_ipi(uint32_t target_vcpu_id, struct vcpu *current)
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005134{
5135 struct vm *vm = current->vm;
5136 ffa_vcpu_index_t target_vcpu_index = vcpu_id_to_index(target_vcpu_id);
5137
J-Alves5dbf9322025-02-21 13:02:02 +00005138 if (target_vcpu_index >= vm->vcpu_count) {
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005139 dlog_verbose("Invalid vCPU %d for IPI.\n", target_vcpu_id);
5140 return -1;
5141 }
5142
5143 dlog_verbose("Injecting IPI to target vCPU%d for %#x\n", target_vcpu_id,
5144 vm->id);
5145
J-Alves5dbf9322025-02-21 13:02:02 +00005146 /*
5147 * If the SP is targeting the current vCPU, inject the IPI VI,
5148 * to avoid trapping into Hafnium.
5149 */
5150 if (target_vcpu_index == cpu_index(current->cpu)) {
5151 struct vcpu_locked current_locked = vcpu_lock(current);
5152
5153 vcpu_virt_interrupt_inject(current_locked, HF_IPI_INTID);
5154
5155 vcpu_unlock(&current_locked);
5156 } else {
5157 hf_ipi_send_interrupt(vm, target_vcpu_index);
5158 }
Daniel Boulbyf3cf28c2024-08-22 10:46:23 +01005159
5160 return 0;
5161}