blob: 9ceb743f541e279a1539300c56fb8e78c6c16711 [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"
Olivier Deprez96a2a262020-06-11 17:21:38 +020013#include "hf/arch/mm.h"
Olivier Deprez112d2b52020-09-30 07:39:23 +020014#include "hf/arch/other_world.h"
Olivier Deprez55a189e2021-06-09 15:45:27 +020015#include "hf/arch/plat/ffa.h"
Andrew Walbran508e63c2018-12-20 17:02:37 +000016#include "hf/arch/timer.h"
Olivier Deprez764fd2e2020-07-29 15:14:09 +020017#include "hf/arch/vm.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000018
Andrew Scull877ae4b2019-07-02 12:52:33 +010019#include "hf/check.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000020#include "hf/dlog.h"
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010021#include "hf/ffa_internal.h"
22#include "hf/ffa_memory.h"
Andrew Scull6386f252018-12-06 13:29:10 +000023#include "hf/mm.h"
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +010024#include "hf/plat/console.h"
Manish Pandeya5f39fb2020-09-11 09:47:11 +010025#include "hf/plat/interrupts.h"
Andrew Scull6386f252018-12-06 13:29:10 +000026#include "hf/spinlock.h"
Andrew Scull877ae4b2019-07-02 12:52:33 +010027#include "hf/static_assert.h"
Andrew Scull8d9e1212019-04-05 13:52:55 +010028#include "hf/std.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010029#include "hf/vm.h"
30
Andrew Scullf35a5c92018-08-07 18:09:46 +010031#include "vmapi/hf/call.h"
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010032#include "vmapi/hf/ffa.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010033
Daniel Boulby1ddb3d72021-12-16 18:16:50 +000034static_assert(sizeof(struct ffa_partition_info_v1_0) == 8,
Fuad Tabbae4efcc32020-07-16 15:37:27 +010035 "Partition information descriptor size doesn't match the one in "
36 "the FF-A 1.0 EAC specification, Table 82.");
Daniel Boulby1ddb3d72021-12-16 18:16:50 +000037static_assert(sizeof(struct ffa_partition_info) == 24,
38 "Partition information descriptor size doesn't match the one in "
39 "the FF-A 1.1 BETA0 EAC specification, Table 13.34.");
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -080040static_assert((sizeof(struct ffa_partition_info) & 7) == 0,
41 "Partition information descriptor must be a multiple of 8 bytes"
42 " for ffa_partition_info_get_regs to work correctly. Information"
43 " from this structure are returned in 8 byte registers and the"
44 " count of 8 byte registers is returned by the ABI.");
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000045/*
46 * To eliminate the risk of deadlocks, we define a partial order for the
47 * acquisition of locks held concurrently by the same physical CPU. Our current
48 * ordering requirements are as follows:
49 *
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +010050 * vm::lock -> vcpu::lock -> mm_stage1_lock -> dlog sl
Andrew Scull6386f252018-12-06 13:29:10 +000051 *
Andrew Scull4caadaf2019-07-03 13:13:47 +010052 * Locks of the same kind require the lock of lowest address to be locked first,
53 * see `sl_lock_both()`.
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000054 */
55
Andrew Scullaa039b32018-10-04 15:02:26 +010056static_assert(HF_MAILBOX_SIZE == PAGE_SIZE,
Andrew Scull13652af2018-09-17 14:49:08 +010057 "Currently, a page is mapped for the send and receive buffers so "
58 "the maximum request is the size of a page.");
59
Andrew Walbran5de9c3d2020-02-10 13:35:29 +000060static_assert(MM_PPOOL_ENTRY_SIZE >= HF_MAILBOX_SIZE,
61 "The page pool entry size must be at least as big as the mailbox "
62 "size, so that memory region descriptors can be copied from the "
63 "mailbox for memory sharing.");
64
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -080065/*
66 * Maximum ffa_partition_info entries that can be returned by an invocation
67 * of FFA_PARTITION_INFO_GET_REGS_64 is size in bytes, of available
68 * registers/args in struct ffa_value divided by size of struct
69 * ffa_partition_info. For this ABI, arg3-arg17 in ffa_value can be used, i.e.
70 * 15 uint64_t fields. For FF-A v1.1, this value should be 5.
71 */
72#define MAX_INFO_REGS_ENTRIES_PER_CALL \
73 ((15 * sizeof(uint64_t)) / sizeof(struct ffa_partition_info))
74static_assert(MAX_INFO_REGS_ENTRIES_PER_CALL == 5,
75 "FF-A v1.1 supports no more than 5 entries"
76 " per FFA_PARTITION_INFO_GET_REGS64 calls");
77
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000078static struct mpool api_page_pool;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000079
80/**
Wedson Almeida Filho81568c42019-01-04 13:33:02 +000081 * Initialises the API page pool by taking ownership of the contents of the
82 * given page pool.
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000083 */
84void api_init(struct mpool *ppool)
85{
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000086 mpool_init_from(&api_page_pool, ppool);
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000087}
88
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010089/**
J-Alvesad6a0432021-04-09 16:06:21 +010090 * Get target VM vCPU:
91 * If VM is UP then return first vCPU.
92 * If VM is MP then return vCPU whose index matches current CPU index.
93 */
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -050094struct vcpu *api_ffa_get_vm_vcpu(struct vm *vm, struct vcpu *current)
J-Alvesad6a0432021-04-09 16:06:21 +010095{
96 ffa_vcpu_index_t current_cpu_index = cpu_index(current->cpu);
97 struct vcpu *vcpu = NULL;
98
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -050099 CHECK((vm != NULL) && (current != NULL));
100
J-Alvesad6a0432021-04-09 16:06:21 +0100101 if (vm->vcpu_count == 1) {
102 vcpu = vm_get_vcpu(vm, 0);
103 } else if (current_cpu_index < vm->vcpu_count) {
104 vcpu = vm_get_vcpu(vm, current_cpu_index);
105 }
106
107 return vcpu;
108}
109
110/**
J-Alvesfe7f7372020-11-09 11:32:12 +0000111 * Switches the physical CPU back to the corresponding vCPU of the VM whose ID
112 * is given as argument of the function.
113 *
114 * Called to change the context between SPs for direct messaging (when Hafnium
115 * is SPMC), and on the context of the remaining 'api_switch_to_*' functions.
116 *
117 * This function works for partitions that are:
J-Alvesad6a0432021-04-09 16:06:21 +0100118 * - UP migratable.
J-Alvesfe7f7372020-11-09 11:32:12 +0000119 * - MP with pinned Execution Contexts.
120 */
121static struct vcpu *api_switch_to_vm(struct vcpu *current,
122 struct ffa_value to_ret,
123 enum vcpu_state vcpu_state,
124 ffa_vm_id_t to_id)
125{
126 struct vm *to_vm = vm_find(to_id);
J-Alvesad6a0432021-04-09 16:06:21 +0100127 struct vcpu *next = api_ffa_get_vm_vcpu(to_vm, current);
J-Alvesfe7f7372020-11-09 11:32:12 +0000128
129 CHECK(next != NULL);
130
131 /* Set the return value for the target VM. */
132 arch_regs_set_retval(&next->regs, to_ret);
133
134 /* Set the current vCPU state. */
135 sl_lock(&current->lock);
136 current->state = vcpu_state;
137 sl_unlock(&current->lock);
138
139 return next;
140}
141
142/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000143 * Switches the physical CPU back to the corresponding vCPU of the primary VM.
Andrew Scullaa039b32018-10-04 15:02:26 +0100144 *
145 * This triggers the scheduling logic to run. Run in the context of secondary VM
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100146 * to cause FFA_RUN to return and the primary VM to regain control of the CPU.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100147 */
J-Alves27b71962022-12-12 15:29:58 +0000148struct vcpu *api_switch_to_primary(struct vcpu *current,
149 struct ffa_value primary_ret,
150 enum vcpu_state secondary_state)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100151{
Andrew Walbran508e63c2018-12-20 17:02:37 +0000152 /*
153 * If the secondary is blocked but has a timer running, sleep until the
154 * timer fires rather than indefinitely.
155 */
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100156 switch (primary_ret.func) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100157 case HF_FFA_RUN_WAIT_FOR_INTERRUPT:
158 case FFA_MSG_WAIT_32: {
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100159 if (arch_timer_enabled_current()) {
160 uint64_t remaining_ns =
161 arch_timer_remaining_ns_current();
162
163 if (remaining_ns == 0) {
164 /*
165 * Timer is pending, so the current vCPU should
166 * be run again right away.
167 */
Andrew Walbran7e824602020-10-22 16:51:40 +0100168 primary_ret = (struct ffa_value){
169 .func = FFA_INTERRUPT_32};
170
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100171 } else {
172 primary_ret.arg2 = remaining_ns;
173 }
174 } else {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100175 primary_ret.arg2 = FFA_SLEEP_INDEFINITE;
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100176 }
Andrew Scullb06d1752019-02-04 10:15:48 +0000177 break;
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100178 }
Andrew Scullb06d1752019-02-04 10:15:48 +0000179
180 default:
181 /* Do nothing. */
182 break;
Andrew Walbran508e63c2018-12-20 17:02:37 +0000183 }
184
J-Alvesfe7f7372020-11-09 11:32:12 +0000185 return api_switch_to_vm(current, primary_ret, secondary_state,
186 HF_PRIMARY_VM_ID);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100187}
188
189/**
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200190 * Choose next vCPU to run to be the counterpart vCPU in the other
191 * world (run the normal world if currently running in the secure
192 * world). Set current vCPU state to the given vcpu_state parameter.
193 * Set FF-A return values to the target vCPU in the other world.
194 *
195 * Called in context of a direct message response from a secure
196 * partition to a VM.
197 */
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100198struct vcpu *api_switch_to_other_world(struct vcpu *current,
199 struct ffa_value other_world_ret,
200 enum vcpu_state vcpu_state)
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200201{
J-Alvesfe7f7372020-11-09 11:32:12 +0000202 return api_switch_to_vm(current, other_world_ret, vcpu_state,
203 HF_OTHER_WORLD_ID);
Olivier Deprez2ebae3a2020-06-11 16:34:30 +0200204}
205
206/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000207 * Returns true if the given vCPU is executing in context of an
208 * FFA_MSG_SEND_DIRECT_REQ invocation.
209 */
J-Alves27b71962022-12-12 15:29:58 +0000210bool is_ffa_direct_msg_request_ongoing(struct vcpu_locked locked)
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000211{
212 return locked.vcpu->direct_request_origin_vm_id != HF_INVALID_VM_ID;
213}
214
215/**
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100216 * Returns true if the VM owning the given vCPU is supporting managed exit and
217 * the vCPU is currently processing a managed exit.
218 */
219static bool api_ffa_is_managed_exit_ongoing(struct vcpu_locked vcpu_locked)
220{
Maksims Svecovs9ddf86a2021-05-06 17:17:21 +0100221 return (plat_ffa_vm_managed_exit_supported(vcpu_locked.vcpu->vm) &&
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100222 vcpu_locked.vcpu->processing_managed_exit);
223}
224
225/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000226 * Returns to the primary VM and signals that the vCPU still has work to do so.
Andrew Scull33fecd32019-01-08 14:48:27 +0000227 */
228struct vcpu *api_preempt(struct vcpu *current)
229{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100230 struct ffa_value ret = {
231 .func = FFA_INTERRUPT_32,
Olivier Deprez0d725f52022-07-06 14:20:27 +0200232 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull33fecd32019-01-08 14:48:27 +0000233 };
234
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500235 return api_switch_to_primary(current, ret, VCPU_STATE_PREEMPTED);
Andrew Scull33fecd32019-01-08 14:48:27 +0000236}
237
238/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000239 * Puts the current vCPU in wait for interrupt mode, and returns to the primary
Fuad Tabbaed294af2019-12-20 10:43:01 +0000240 * VM.
Andrew Scullaa039b32018-10-04 15:02:26 +0100241 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100242struct vcpu *api_wait_for_interrupt(struct vcpu *current)
Andrew Scullaa039b32018-10-04 15:02:26 +0100243{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100244 struct ffa_value ret = {
245 .func = HF_FFA_RUN_WAIT_FOR_INTERRUPT,
246 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull6d2db332018-10-10 15:28:17 +0100247 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000248
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000249 return api_switch_to_primary(current, ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100250 VCPU_STATE_BLOCKED_INTERRUPT);
Andrew Scullaa039b32018-10-04 15:02:26 +0100251}
252
253/**
Andrew Walbran33645652019-04-15 12:29:31 +0100254 * Puts the current vCPU in off mode, and returns to the primary VM.
255 */
256struct vcpu *api_vcpu_off(struct vcpu *current)
257{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100258 struct ffa_value ret = {
259 .func = HF_FFA_RUN_WAIT_FOR_INTERRUPT,
260 .arg1 = ffa_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Walbran33645652019-04-15 12:29:31 +0100261 };
262
263 /*
264 * Disable the timer, so the scheduler doesn't get told to call back
265 * based on it.
266 */
267 arch_timer_disable_current();
268
269 return api_switch_to_primary(current, ret, VCPU_STATE_OFF);
270}
271
272/**
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500273 * The current vCPU is blocked on some resource and needs to relinquish
274 * control back to the execution context of the endpoint that originally
275 * allocated cycles to it.
Andrew Scull66d62bf2019-02-01 13:54:10 +0000276 */
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000277struct ffa_value api_yield(struct vcpu *current, struct vcpu **next)
Andrew Scull66d62bf2019-02-01 13:54:10 +0000278{
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000279 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_32};
280 struct vcpu_locked current_locked;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500281 bool transition_allowed;
282 enum vcpu_state next_state = VCPU_STATE_BLOCKED;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000283
284 if (current->vm->id == HF_PRIMARY_VM_ID) {
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000285 /* NOOP on the primary as it makes the scheduling decisions. */
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000286 return ret;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000287 }
288
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000289 current_locked = vcpu_lock(current);
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500290 transition_allowed = plat_ffa_check_runtime_state_transition(
291 current, current->vm->id, HF_INVALID_VM_ID, NULL, FFA_YIELD_32,
292 &next_state);
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000293 vcpu_unlock(&current_locked);
294
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500295 if (!transition_allowed) {
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000296 return ffa_error(FFA_DENIED);
297 }
298
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500299 assert(next_state == VCPU_STATE_BLOCKED);
300
Madhukar Pappireddy1f2f2132023-02-14 17:48:44 -0600301 plat_ffa_yield_prepare(current);
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000302 *next = api_switch_to_primary(
303 current,
304 (struct ffa_value){.func = FFA_YIELD_32,
305 .arg1 = ffa_vm_vcpu(current->vm->id,
306 vcpu_index(current))},
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500307 next_state);
Olivier Deprezee9d6a92019-11-26 09:14:11 +0000308
309 return ret;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000310}
311
312/**
Andrew Walbran33645652019-04-15 12:29:31 +0100313 * Switches to the primary so that it can switch to the target, or kick it if it
314 * is already running on a different physical CPU.
315 */
316struct vcpu *api_wake_up(struct vcpu *current, struct vcpu *target_vcpu)
317{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100318 struct ffa_value ret = {
Andrew Walbran7e824602020-10-22 16:51:40 +0100319 .func = FFA_INTERRUPT_32,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100320 .arg1 = ffa_vm_vcpu(target_vcpu->vm->id,
321 vcpu_index(target_vcpu)),
Andrew Walbran33645652019-04-15 12:29:31 +0100322 };
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500323 return api_switch_to_primary(current, ret, VCPU_STATE_BLOCKED);
Andrew Walbran33645652019-04-15 12:29:31 +0100324}
325
326/**
Andrew Scull38772ab2019-01-24 15:16:50 +0000327 * Aborts the vCPU and triggers its VM to abort fully.
Andrew Scull9726c252019-01-23 13:44:19 +0000328 */
329struct vcpu *api_abort(struct vcpu *current)
330{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100331 struct ffa_value ret = ffa_error(FFA_ABORTED);
Andrew Scull9726c252019-01-23 13:44:19 +0000332
Olivier Deprezf92e5d42020-11-13 16:00:54 +0100333 dlog_notice("Aborting VM %#x vCPU %u\n", current->vm->id,
Andrew Walbran17eebf92020-02-05 16:35:49 +0000334 vcpu_index(current));
Andrew Scull9726c252019-01-23 13:44:19 +0000335
336 if (current->vm->id == HF_PRIMARY_VM_ID) {
337 /* TODO: what to do when the primary aborts? */
338 for (;;) {
339 /* Do nothing. */
340 }
341 }
342
343 atomic_store_explicit(&current->vm->aborting, true,
344 memory_order_relaxed);
345
346 /* TODO: free resources once all vCPUs abort. */
347
Andrew Sculld6ee1102019-04-05 22:12:42 +0100348 return api_switch_to_primary(current, ret, VCPU_STATE_ABORTED);
Andrew Scull9726c252019-01-23 13:44:19 +0000349}
350
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000351/*
352 * Format the partition info descriptors according to the version supported
353 * by the endpoint and return the size of the array created.
354 */
355static struct ffa_value send_versioned_partition_info_descriptors(
Daniel Boulby191b5f02022-02-17 17:26:14 +0000356 struct vm_locked vm_locked, struct ffa_partition_info *partitions,
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000357 uint32_t vm_count)
358{
Daniel Boulby191b5f02022-02-17 17:26:14 +0000359 struct vm *vm = vm_locked.vm;
360 uint32_t version = vm->ffa_version;
Daniel Boulby835e1592022-05-30 17:38:51 +0100361 uint32_t partition_info_size;
362 uint32_t buffer_size;
Federico Recanati644f0462022-03-17 12:04:00 +0100363 struct ffa_value ret;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000364
J-Alves122f1a12022-12-12 15:55:42 +0000365 if (vm_is_mailbox_busy(vm_locked)) {
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000366 /*
367 * Can't retrieve memory information if the mailbox is not
368 * available.
369 */
370 dlog_verbose("RX buffer not ready.\n");
Daniel Boulby191b5f02022-02-17 17:26:14 +0000371 return ffa_error(FFA_BUSY);
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000372 }
373
Federico Recanati644f0462022-03-17 12:04:00 +0100374 /* Acquire receiver's RX buffer. */
375 if (!plat_ffa_acquire_receiver_rx(vm_locked, &ret)) {
376 dlog_verbose("Failed to acquire RX buffer for VM %x\n", vm->id);
377 return ret;
378 }
379
Daniel Boulby191b5f02022-02-17 17:26:14 +0000380 if (version == MAKE_FFA_VERSION(1, 0)) {
381 struct ffa_partition_info_v1_0 *recv_mailbox = vm->mailbox.recv;
382
Daniel Boulby835e1592022-05-30 17:38:51 +0100383 partition_info_size = sizeof(struct ffa_partition_info_v1_0);
384 buffer_size = partition_info_size * vm_count;
385 if (buffer_size > HF_MAILBOX_SIZE) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000386 dlog_error(
387 "Partition information does not fit in the "
388 "VM's RX "
389 "buffer.\n");
390 return ffa_error(FFA_NO_MEMORY);
391 }
392
393 for (uint32_t i = 0; i < vm_count; i++) {
394 /*
395 * Populate the VM's RX buffer with the partition
Kathleen Capella402fa852022-11-09 16:16:51 -0500396 * information. Clear properties bits that must be zero
397 * according to DEN0077A FF-A v1.0 REL Table 8.25.
Daniel Boulby191b5f02022-02-17 17:26:14 +0000398 */
399 recv_mailbox[i].vm_id = partitions[i].vm_id;
400 recv_mailbox[i].vcpu_count = partitions[i].vcpu_count;
Kathleen Capella402fa852022-11-09 16:16:51 -0500401 recv_mailbox[i].properties =
402 partitions[i].properties &
403 ~FFA_PARTITION_v1_0_RES_MASK;
Daniel Boulby191b5f02022-02-17 17:26:14 +0000404 }
405
406 } else {
Daniel Boulby835e1592022-05-30 17:38:51 +0100407 partition_info_size = sizeof(struct ffa_partition_info);
408 buffer_size = partition_info_size * vm_count;
409 if (buffer_size > HF_MAILBOX_SIZE) {
Daniel Boulby191b5f02022-02-17 17:26:14 +0000410 dlog_error(
411 "Partition information does not fit in the "
412 "VM's RX "
413 "buffer.\n");
414 return ffa_error(FFA_NO_MEMORY);
415 }
416
417 /* Populate the VM's RX buffer with the partition information.
418 */
Daniel Boulby835e1592022-05-30 17:38:51 +0100419 memcpy_s(vm->mailbox.recv, HF_MAILBOX_SIZE, partitions,
420 buffer_size);
Daniel Boulby191b5f02022-02-17 17:26:14 +0000421 }
422
Daniel Boulby835e1592022-05-30 17:38:51 +0100423 vm->mailbox.recv_size = buffer_size;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000424
425 /* Sender is Hypervisor in the normal world (TEE in secure world). */
Daniel Boulby191b5f02022-02-17 17:26:14 +0000426 vm->mailbox.recv_sender = HF_VM_ID_BASE;
427 vm->mailbox.recv_func = FFA_PARTITION_INFO_GET_32;
428 vm->mailbox.state = MAILBOX_STATE_READ;
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000429
Daniel Boulby835e1592022-05-30 17:38:51 +0100430 /*
431 * Return the count of partition information descriptors in w2
432 * and the size of the descriptors in w3.
433 */
434 return (struct ffa_value){.func = FFA_SUCCESS_32,
435 .arg2 = vm_count,
436 .arg3 = partition_info_size};
Daniel Boulby1ddb3d72021-12-16 18:16:50 +0000437}
438
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800439static void api_ffa_fill_partitions_info_array(
440 struct ffa_partition_info *partitions, size_t partitions_len,
441 const struct ffa_uuid *uuid, bool count_flag, ffa_vm_id_t vm_id,
442 ffa_vm_count_t *vm_count_out)
443{
444 ffa_vm_count_t vm_count = 0;
445 bool uuid_is_null = ffa_uuid_is_null(uuid);
446
447 assert(vm_get_count() <= partitions_len);
448
449 /*
450 * Iterate through the VMs to find the ones with a matching
451 * UUID. A Null UUID retrieves information for all VMs.
452 */
453 for (ffa_vm_count_t index = 0; index < vm_get_count(); ++index) {
454 struct vm *vm = vm_find_index(index);
455
456 if (uuid_is_null || ffa_uuid_equal(uuid, &vm->uuid)) {
457 uint16_t array_index = vm_count;
458
459 ++vm_count;
460 if (count_flag) {
461 continue;
462 }
463
464 partitions[array_index].vm_id = vm->id;
465 partitions[array_index].vcpu_count = vm->vcpu_count;
466 partitions[array_index].properties =
467 plat_ffa_partition_properties(vm_id, vm);
468 partitions[array_index].properties |=
469 vm_are_notifications_enabled(vm)
470 ? FFA_PARTITION_NOTIFICATION
471 : 0;
472 partitions[array_index].properties |=
473 FFA_PARTITION_AARCH64_EXEC;
474 if (uuid_is_null) {
475 partitions[array_index].uuid = vm->uuid;
476 }
477 }
478 }
479
480 *vm_count_out = vm_count;
481}
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800482
483static inline void api_ffa_pack_vmid_count_props(
484 uint64_t *xn, ffa_vm_id_t vm_id, ffa_vcpu_count_t vcpu_count,
485 ffa_partition_properties_t properties)
486{
487 *xn = (uint64_t)vm_id;
488 *xn |= (uint64_t)vcpu_count << 16;
489 *xn |= (uint64_t)properties << 32;
490}
491
492static inline void api_ffa_pack_uuid(uint64_t *xn_1, uint64_t *xn_2,
493 struct ffa_uuid *uuid)
494{
495 *xn_1 = (uint64_t)uuid->uuid[0];
496 *xn_1 |= (uint64_t)uuid->uuid[1] << 32;
497 *xn_2 = (uint64_t)uuid->uuid[2];
498 *xn_2 |= (uint64_t)uuid->uuid[3] << 32;
499}
500
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800501struct ffa_value api_ffa_partition_info_get_regs(struct vcpu *current,
502 const struct ffa_uuid *uuid,
503 const uint16_t start_index,
504 const uint16_t tag)
505{
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800506 struct vm *current_vm = current->vm;
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800507 static struct ffa_partition_info partitions[2 * MAX_VMS];
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800508 bool uuid_is_null = ffa_uuid_is_null(uuid);
509 ffa_vm_count_t vm_count = 0;
510 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
511 uint16_t max_idx = 0;
512 uint16_t curr_idx = 0;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800513 uint8_t num_entries_to_ret = 0;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800514 uint8_t arg_idx = 3;
515
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800516 /* list of pointers to args in return value */
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800517 uint64_t *arg_ptrs[] = {
518 &(ret).func,
519 &(ret).arg1,
520 &(ret).arg2,
521 &(ret).arg3,
522 &(ret).arg4,
523 &(ret).arg5,
524 &(ret).arg6,
525 &(ret).arg7,
526 &(ret).extended_val.arg8,
527 &(ret).extended_val.arg9,
528 &(ret).extended_val.arg10,
529 &(ret).extended_val.arg11,
530 &(ret).extended_val.arg12,
531 &(ret).extended_val.arg13,
532 &(ret).extended_val.arg14,
533 &(ret).extended_val.arg15,
534 &(ret).extended_val.arg16,
535 &(ret).extended_val.arg17,
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800536 };
537
538 /* TODO: Add support for using tags */
539 if (tag != 0) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800540 dlog_error("Tag not 0. Unsupported tag. %d\n", tag);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800541 return ffa_error(FFA_RETRY);
542 }
543
544 memset_s(&partitions, sizeof(partitions), 0, sizeof(partitions));
545
546 api_ffa_fill_partitions_info_array(partitions, ARRAY_SIZE(partitions),
547 uuid, false, current_vm->id,
548 &vm_count);
549
550 /* If UUID is Null vm_count must not be zero at this stage. */
551 CHECK(!uuid_is_null || vm_count != 0);
552
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800553 /*
554 * When running the Hypervisor:
555 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
556 * it to fill with secure partitions information.
557 * TODO: Note that for this ABI, forwarding on every invocation when
558 * uuid is Null is inefficient,and if performance becomes a problem,
559 * this would be a good place to optimize using strategies such as
560 * caching info etc. For now, assuming this inefficiency is not a major
561 * issue.
562 * - If UUID is non-Null vm_count may be zero because the UUID matches
563 * a secure partition and the query is forwarded to the SPMC.
564 * When running the SPMC:
565 * - If UUID is non-Null and vm_count is zero it means there is no such
566 * partition identified in the system.
567 */
568 if (!plat_ffa_partition_info_get_regs_forward(
569 uuid, start_index, tag, partitions, ARRAY_SIZE(partitions),
570 &vm_count)) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800571 dlog_error("Failed to forward ffa_partition_info_get_regs.\n");
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800572 return ffa_error(FFA_DENIED);
573 }
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800574
575 /*
576 * Unrecognized UUID: does not match any of the VMs (or SPs)
577 * and is not Null.
578 */
Raghu Krishnamurthyef432cb2022-12-29 06:56:32 -0800579 if (vm_count == 0 || vm_count > ARRAY_SIZE(partitions)) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800580 dlog_error(
581 "Invalid parameters. vm_count = %d (must not be zero "
582 "or > %d)\n",
583 vm_count, ARRAY_SIZE(partitions));
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800584 return ffa_error(FFA_INVALID_PARAMETERS);
585 }
586
587 if (start_index >= vm_count) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800588 dlog_error(
589 "start index = %d vm_count = %d (start_index must be "
590 "less than vm_count)\n",
591 start_index, vm_count);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800592 return ffa_error(FFA_INVALID_PARAMETERS);
593 }
594
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800595 max_idx = vm_count - 1;
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800596 num_entries_to_ret = (max_idx - start_index) + 1;
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800597 num_entries_to_ret =
598 MIN(num_entries_to_ret, MAX_INFO_REGS_ENTRIES_PER_CALL);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800599 curr_idx = start_index + num_entries_to_ret - 1;
600 assert(curr_idx <= max_idx);
601
602 ret.func = FFA_SUCCESS_64;
603 ret.arg2 = (sizeof(struct ffa_partition_info) & 0xFFFF) << 48;
604 ret.arg2 |= curr_idx << 16;
605 ret.arg2 |= max_idx;
606
607 if (num_entries_to_ret > 1) {
608 ret.extended_val.valid = 1;
609 }
610
611 for (uint16_t idx = start_index; idx <= curr_idx; ++idx) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800612 uint64_t *xn_0 = arg_ptrs[arg_idx++];
613 uint64_t *xn_1 = arg_ptrs[arg_idx++];
614 uint64_t *xn_2 = arg_ptrs[arg_idx++];
615
616 api_ffa_pack_vmid_count_props(xn_0, partitions[idx].vm_id,
617 partitions[idx].vcpu_count,
618 partitions[idx].properties);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800619 if (uuid_is_null) {
Raghu Krishnamurthybefdcc82023-02-24 06:41:56 -0800620 api_ffa_pack_uuid(xn_1, xn_2, &partitions[idx].uuid);
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800621 }
622 assert(arg_idx < ARRAY_SIZE(arg_ptrs));
623 }
624
625 return ret;
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -0800626}
627
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100628struct ffa_value api_ffa_partition_info_get(struct vcpu *current,
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000629 const struct ffa_uuid *uuid,
630 const uint32_t flags)
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100631{
632 struct vm *current_vm = current->vm;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100633 ffa_vm_count_t vm_count = 0;
Olivier Deprez013f4d62022-11-21 15:46:20 +0100634 bool count_flag = (flags & FFA_PARTITION_COUNT_FLAG_MASK) ==
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000635 FFA_PARTITION_COUNT_FLAG;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100636 bool uuid_is_null = ffa_uuid_is_null(uuid);
Daniel Boulbyce541842022-05-31 15:54:31 +0100637 struct ffa_partition_info partitions[2 * MAX_VMS] = {0};
Daniel Boulby191b5f02022-02-17 17:26:14 +0000638 struct vm_locked vm_locked;
639 struct ffa_value ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100640
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000641 /* Bits 31:1 Must Be Zero */
Olivier Deprez013f4d62022-11-21 15:46:20 +0100642 if ((flags & ~FFA_PARTITION_COUNT_FLAG_MASK) != 0) {
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000643 return ffa_error(FFA_INVALID_PARAMETERS);
644 }
645
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100646 /*
Kathleen Capella402fa852022-11-09 16:16:51 -0500647 * No need to count if we are returning the number of partitions as we
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000648 * already know this.
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100649 */
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000650 if (uuid_is_null && count_flag) {
651 vm_count = vm_get_count();
652 } else {
Raghu Krishnamurthyf67776f2022-12-26 10:10:05 -0800653 api_ffa_fill_partitions_info_array(
654 partitions, ARRAY_SIZE(partitions), uuid, count_flag,
655 current_vm->id, &vm_count);
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100656 }
657
Olivier Depreze562e542020-06-11 17:31:54 +0200658 /* If UUID is Null vm_count must not be zero at this stage. */
659 CHECK(!uuid_is_null || vm_count != 0);
660
661 /*
662 * When running the Hypervisor:
663 * - If UUID is Null the Hypervisor forwards the query to the SPMC for
664 * it to fill with secure partitions information.
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000665 * - If UUID is non-Null vm_count may be zero because the UUID matches
Olivier Depreze562e542020-06-11 17:31:54 +0200666 * a secure partition and the query is forwarded to the SPMC.
667 * When running the SPMC:
668 * - If UUID is non-Null and vm_count is zero it means there is no such
669 * partition identified in the system.
670 */
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000671 plat_ffa_partition_info_get_forward(uuid, flags, partitions, &vm_count);
Olivier Depreze562e542020-06-11 17:31:54 +0200672
673 /*
674 * Unrecognized UUID: does not match any of the VMs (or SPs)
675 * and is not Null.
676 */
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100677 if (vm_count == 0) {
678 return ffa_error(FFA_INVALID_PARAMETERS);
679 }
680
Daniel Boulbyb46cad12021-12-13 17:47:21 +0000681 /*
682 * If the count flag is set we don't need to return the partition info
683 * descriptors.
684 */
685 if (count_flag) {
686 return (struct ffa_value){.func = FFA_SUCCESS_32,
687 .arg2 = vm_count};
688 }
689
Daniel Boulby191b5f02022-02-17 17:26:14 +0000690 vm_locked = vm_lock(current_vm);
691 ret = send_versioned_partition_info_descriptors(vm_locked, partitions,
692 vm_count);
693 vm_unlock(&vm_locked);
694 return ret;
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100695}
696
Andrew Scull9726c252019-01-23 13:44:19 +0000697/**
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000698 * Returns the ID of the VM.
699 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100700struct ffa_value api_ffa_id_get(const struct vcpu *current)
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000701{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100702 return (struct ffa_value){.func = FFA_SUCCESS_32,
703 .arg2 = current->vm->id};
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000704}
705
706/**
Olivier Deprez421677d2021-06-18 12:18:53 +0200707 * Returns the SPMC FF-A ID at NS virtual/physical and secure virtual
708 * FF-A instances.
709 * DEN0077A FF-A v1.1 Beta0 section 13.9 FFA_SPM_ID_GET.
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +0000710 */
711struct ffa_value api_ffa_spm_id_get(void)
712{
J-Alves3829fc02021-03-18 12:49:18 +0000713#if (MAKE_FFA_VERSION(1, 1) <= FFA_VERSION_COMPILED)
714 /*
715 * Return the SPMC ID that was fetched during FF-A
716 * initialization.
717 */
718 return (struct ffa_value){.func = FFA_SUCCESS_32,
719 .arg2 = arch_ffa_spmc_id_get()};
720#else
721 return ffa_error(FFA_NOT_SUPPORTED);
722#endif
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +0000723}
724
725/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000726 * This function is called by the architecture-specific context switching
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000727 * function to indicate that register state for the given vCPU has been saved
728 * and can therefore be used by other pCPUs.
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000729 */
730void api_regs_state_saved(struct vcpu *vcpu)
731{
732 sl_lock(&vcpu->lock);
733 vcpu->regs_available = true;
734 sl_unlock(&vcpu->lock);
735}
736
737/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000738 * Retrieves the next waiter and removes it from the wait list if the VM's
739 * mailbox is in a writable state.
740 */
741static struct wait_entry *api_fetch_waiter(struct vm_locked locked_vm)
742{
743 struct wait_entry *entry;
744 struct vm *vm = locked_vm.vm;
745
Andrew Sculld6ee1102019-04-05 22:12:42 +0100746 if (vm->mailbox.state != MAILBOX_STATE_EMPTY ||
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000747 vm->mailbox.recv == NULL || list_empty(&vm->mailbox.waiter_list)) {
748 /* The mailbox is not writable or there are no waiters. */
749 return NULL;
750 }
751
752 /* Remove waiter from the wait list. */
753 entry = CONTAINER_OF(vm->mailbox.waiter_list.next, struct wait_entry,
754 wait_links);
755 list_remove(&entry->wait_links);
756 return entry;
757}
758
759/**
Andrew Walbran508e63c2018-12-20 17:02:37 +0000760 * Assuming that the arguments have already been checked by the caller, injects
761 * a virtual interrupt of the given ID into the given target vCPU. This doesn't
762 * cause the vCPU to actually be run immediately; it will be taken when the vCPU
763 * is next run, which is up to the scheduler.
764 *
765 * Returns:
766 * - 0 on success if no further action is needed.
767 * - 1 if it was called by the primary VM and the primary VM now needs to wake
768 * up or kick the target vCPU.
769 */
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100770int64_t api_interrupt_inject_locked(struct vcpu_locked target_locked,
771 uint32_t intid, struct vcpu *current,
772 struct vcpu **next)
Andrew Walbran508e63c2018-12-20 17:02:37 +0000773{
Manish Pandey35e452f2021-02-18 21:36:34 +0000774 struct vcpu *target_vcpu = target_locked.vcpu;
Daniel Boulby4ca50f02022-07-29 18:29:34 +0100775 struct interrupts *interrupts = &target_vcpu->interrupts;
Andrew Walbran508e63c2018-12-20 17:02:37 +0000776 int64_t ret = 0;
777
Andrew Walbran508e63c2018-12-20 17:02:37 +0000778 /*
Manish Pandey35e452f2021-02-18 21:36:34 +0000779 * We only need to change state and (maybe) trigger a virtual interrupt
780 * if it is enabled and was not previously pending. Otherwise we can
781 * skip everything except setting the pending bit.
Andrew Walbran508e63c2018-12-20 17:02:37 +0000782 */
Daniel Boulby4ca50f02022-07-29 18:29:34 +0100783 if (!(vcpu_is_virt_interrupt_enabled(interrupts, intid) &&
784 !vcpu_is_virt_interrupt_pending(interrupts, intid))) {
Andrew Walbran508e63c2018-12-20 17:02:37 +0000785 goto out;
786 }
787
788 /* Increment the count. */
Daniel Boulby4ca50f02022-07-29 18:29:34 +0100789 vcpu_interrupt_count_increment(target_locked, interrupts, intid);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000790
791 /*
792 * Only need to update state if there was not already an
793 * interrupt enabled and pending.
794 */
Manish Pandey35e452f2021-02-18 21:36:34 +0000795 if (vcpu_interrupt_count_get(target_locked) != 1) {
Andrew Walbran508e63c2018-12-20 17:02:37 +0000796 goto out;
797 }
798
Andrew Walbran508e63c2018-12-20 17:02:37 +0000799 if (current->vm->id == HF_PRIMARY_VM_ID) {
800 /*
801 * If the call came from the primary VM, let it know that it
802 * should run or kick the target vCPU.
803 */
804 ret = 1;
Manish Pandey35e452f2021-02-18 21:36:34 +0000805 } else if (current != target_vcpu && next != NULL) {
806 *next = api_wake_up(current, target_vcpu);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000807 }
808
809out:
810 /* Either way, make it pending. */
Daniel Boulby4ca50f02022-07-29 18:29:34 +0100811 vcpu_virt_interrupt_set_pending(interrupts, intid);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000812
Olivier Deprezc19a6ea2020-08-06 11:16:07 +0200813 return ret;
814}
815
816/* Wrapper to internal_interrupt_inject with locking of target vCPU */
817static int64_t internal_interrupt_inject(struct vcpu *target_vcpu,
818 uint32_t intid, struct vcpu *current,
819 struct vcpu **next)
820{
821 int64_t ret;
822 struct vcpu_locked target_locked;
823
824 target_locked = vcpu_lock(target_vcpu);
Manish Pandeya5f39fb2020-09-11 09:47:11 +0100825 ret = api_interrupt_inject_locked(target_locked, intid, current, next);
Olivier Deprezc19a6ea2020-08-06 11:16:07 +0200826 vcpu_unlock(&target_locked);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000827
828 return ret;
829}
830
831/**
Federico Recanati25053ee2022-03-14 15:01:53 +0100832 * Constructs the return value from a successful FFA_MSG_POLL or
833 * FFA_MSG_WAIT call.
834 *
835 * Note: FFA_MSG_POLL is deprecated in FF-A v1.1 and should not be used with
836 * FFA_MSG_SEND2; no check is done on mixing FF-A v1.0 and FF-A v1.1 indirect
837 * message protocols.
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100838 */
J-Alves27b71962022-12-12 15:29:58 +0000839struct ffa_value ffa_msg_recv_return(const struct vm *receiver)
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100840{
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000841 switch (receiver->mailbox.recv_func) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100842 case FFA_MSG_SEND_32:
843 return (struct ffa_value){
844 .func = FFA_MSG_SEND_32,
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000845 .arg1 = (receiver->mailbox.recv_sender << 16) |
846 receiver->id,
847 .arg3 = receiver->mailbox.recv_size};
Federico Recanati25053ee2022-03-14 15:01:53 +0100848 case FFA_MSG_SEND2_32:
849 return (struct ffa_value){
850 .func = FFA_RUN_32,
851 /*
852 * TODO: FFA_RUN should return vCPU and VM ID in arg1.
853 * Retrieving vCPU requires a rework of the function,
854 * while receiver ID must be set because it's checked by
855 * other APIs (eg: FFA_NOTIFICATION_GET).
856 */
857 .arg1 = receiver->id};
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000858 default:
859 /* This should never be reached, but return an error in case. */
Andrew Walbran17eebf92020-02-05 16:35:49 +0000860 dlog_error("Tried to return an invalid message function %#x\n",
861 receiver->mailbox.recv_func);
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100862 return ffa_error(FFA_DENIED);
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000863 }
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100864}
865
Madhukar Pappireddy5522c672021-12-17 16:35:51 -0600866struct ffa_value api_ffa_msg_wait(struct vcpu *current, struct vcpu **next,
867 struct ffa_value *args)
868{
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500869 enum vcpu_state next_state = VCPU_STATE_WAITING;
Madhukar Pappireddy5522c672021-12-17 16:35:51 -0600870
871 if (args->arg1 != 0U || args->arg2 != 0U || args->arg3 != 0U ||
872 args->arg4 != 0U || args->arg5 != 0U || args->arg6 != 0U ||
873 args->arg7 != 0U) {
874 return ffa_error(FFA_INVALID_PARAMETERS);
875 }
876
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -0500877 if (!plat_ffa_check_runtime_state_transition(
878 current, current->vm->id, HF_INVALID_VM_ID, NULL,
879 FFA_MSG_WAIT_32, &next_state)) {
880 return ffa_error(FFA_DENIED);
881 }
882
883 assert(next_state == VCPU_STATE_WAITING);
884
Madhukar Pappireddydd883202022-10-24 16:49:28 -0500885 return plat_ffa_msg_wait_prepare(current, next);
Madhukar Pappireddy5522c672021-12-17 16:35:51 -0600886}
887
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100888/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000889 * Prepares the vCPU to run by updating its state and fetching whether a return
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000890 * value needs to be forced onto the vCPU.
891 */
J-Alves6e2abc62021-12-02 14:58:56 +0000892static bool api_vcpu_prepare_run(struct vcpu *current, struct vcpu *vcpu,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100893 struct ffa_value *run_ret)
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000894{
Max Shvetsov40108e72020-08-27 12:39:50 +0100895 struct vcpu_locked vcpu_locked;
896 struct vm_locked vm_locked;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000897 bool ret;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500898 uint64_t timer_remaining_ns = FFA_SLEEP_INDEFINITE;
Olivier Deprez04168ed2022-09-26 09:20:00 +0200899 bool vcpu_was_init_state = false;
J-Alves6e2abc62021-12-02 14:58:56 +0000900 bool need_vm_lock;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000901
Andrew Scullb06d1752019-02-04 10:15:48 +0000902 /*
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000903 * Check that the registers are available so that the vCPU can be run.
Andrew Scullb06d1752019-02-04 10:15:48 +0000904 *
Andrew Scull4caadaf2019-07-03 13:13:47 +0100905 * The VM lock is not needed in the common case so it must only be taken
906 * when it is going to be needed. This ensures there are no inter-vCPU
907 * dependencies in the common run case meaning the sensitive context
908 * switch performance is consistent.
Andrew Scullb06d1752019-02-04 10:15:48 +0000909 */
Max Shvetsov40108e72020-08-27 12:39:50 +0100910 vcpu_locked = vcpu_lock(vcpu);
911
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000912 /* The VM needs to be locked to deliver mailbox messages. */
J-Alves6e2abc62021-12-02 14:58:56 +0000913 need_vm_lock = vcpu->state == VCPU_STATE_WAITING ||
914 (!vcpu->vm->el0_partition &&
915 (vcpu->state == VCPU_STATE_BLOCKED_INTERRUPT ||
916 vcpu->state == VCPU_STATE_BLOCKED ||
917 vcpu->state == VCPU_STATE_PREEMPTED));
918
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000919 if (need_vm_lock) {
Max Shvetsov40108e72020-08-27 12:39:50 +0100920 vcpu_unlock(&vcpu_locked);
921 vm_locked = vm_lock(vcpu->vm);
922 vcpu_locked = vcpu_lock(vcpu);
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000923 }
924
925 /*
926 * If the vCPU is already running somewhere then we can't run it here
927 * simultaneously. While it is actually running then the state should be
928 * `VCPU_STATE_RUNNING` and `regs_available` should be false. Once it
929 * stops running but while Hafnium is in the process of switching back
930 * to the primary there will be a brief period while the state has been
931 * updated but `regs_available` is still false (until
932 * `api_regs_state_saved` is called). We can't start running it again
933 * until this has finished, so count this state as still running for the
934 * purposes of this check.
935 */
936 if (vcpu->state == VCPU_STATE_RUNNING || !vcpu->regs_available) {
937 /*
938 * vCPU is running on another pCPU.
939 *
940 * It's okay not to return the sleep duration here because the
941 * other physical CPU that is currently running this vCPU will
942 * return the sleep duration if needed.
943 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100944 *run_ret = ffa_error(FFA_BUSY);
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000945 ret = false;
946 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000947 }
Andrew Scull9726c252019-01-23 13:44:19 +0000948
949 if (atomic_load_explicit(&vcpu->vm->aborting, memory_order_relaxed)) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100950 if (vcpu->state != VCPU_STATE_ABORTED) {
Olivier Deprezf92e5d42020-11-13 16:00:54 +0100951 dlog_notice("Aborting VM %#x vCPU %u\n", vcpu->vm->id,
Andrew Walbran17eebf92020-02-05 16:35:49 +0000952 vcpu_index(vcpu));
Andrew Sculld6ee1102019-04-05 22:12:42 +0100953 vcpu->state = VCPU_STATE_ABORTED;
Andrew Scull9726c252019-01-23 13:44:19 +0000954 }
955 ret = false;
956 goto out;
957 }
958
Andrew Walbran508e63c2018-12-20 17:02:37 +0000959 switch (vcpu->state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100960 case VCPU_STATE_RUNNING:
961 case VCPU_STATE_OFF:
962 case VCPU_STATE_ABORTED:
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000963 ret = false;
964 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000965
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500966 case VCPU_STATE_WAITING:
967 /*
Olivier Deprezb2808332023-02-02 15:25:40 +0100968 * An initial FFA_RUN is necessary for SP's secondary vCPUs to
969 * reach the message wait loop.
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500970 */
Olivier Deprezb2808332023-02-02 15:25:40 +0100971 if (vcpu->rt_model == RTM_SP_INIT) {
972 /*
973 * TODO: this should be removed, but omitting it makes
974 * normal world arch gicv3 tests failing.
975 */
976 vcpu->rt_model = RTM_NONE;
Olivier Deprez04168ed2022-09-26 09:20:00 +0200977
978 vcpu_was_init_state = true;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -0500979 break;
980 }
981
J-Alves6e2abc62021-12-02 14:58:56 +0000982 assert(need_vm_lock == true);
983 if (!vm_locked.vm->el0_partition &&
984 plat_ffa_inject_notification_pending_interrupt(
985 vcpu_locked, current, vm_locked)) {
Federico Recanati9dccc4b2022-04-27 12:52:36 +0200986 /* TODO: setting a return value to override
987 * the placeholder (FFA_ERROR(INTERRUPTED))
988 * set by FFA_MSG_WAIT. FF-A v1.1 allows
989 * FFA_MSG_WAIT to successfully return even if
990 * it didn't receive a message. TFTF tests are
991 * still expecting an FFA_ERROR instead,
992 * should be fixed?
993 */
994 arch_regs_set_retval(
995 &vcpu->regs,
996 (struct ffa_value){.func = FFA_RUN_32,
997 // TODO: does it make sense
998 // to set vCPU/receiver?
999 .arg1 = 0});
J-Alves6e2abc62021-12-02 14:58:56 +00001000 break;
1001 }
1002
Andrew Scullb06d1752019-02-04 10:15:48 +00001003 /*
1004 * A pending message allows the vCPU to run so the message can
1005 * be delivered directly.
1006 */
Andrew Sculld6ee1102019-04-05 22:12:42 +01001007 if (vcpu->vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001008 arch_regs_set_retval(&vcpu->regs,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001009 ffa_msg_recv_return(vcpu->vm));
Federico Recanati25053ee2022-03-14 15:01:53 +01001010 if (vcpu->vm->mailbox.recv_func == FFA_MSG_SEND_32) {
1011 vcpu->vm->mailbox.state = MAILBOX_STATE_READ;
1012 }
Andrew Scullb06d1752019-02-04 10:15:48 +00001013 break;
1014 }
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001015
1016 if (vcpu_interrupt_count_get(vcpu_locked) > 0) {
1017 break;
1018 }
1019
1020 if (arch_timer_enabled(&vcpu->regs)) {
1021 timer_remaining_ns =
1022 arch_timer_remaining_ns(&vcpu->regs);
1023 if (timer_remaining_ns == 0) {
1024 break;
1025 }
1026 } else {
1027 dlog_verbose("Timer disabled\n");
1028 }
1029 run_ret->func = FFA_MSG_WAIT_32;
1030 run_ret->arg1 = ffa_vm_vcpu(vcpu->vm->id, vcpu_index(vcpu));
1031 run_ret->arg2 = timer_remaining_ns;
1032 ret = false;
1033 goto out;
Andrew Sculld6ee1102019-04-05 22:12:42 +01001034 case VCPU_STATE_BLOCKED_INTERRUPT:
J-Alves6e2abc62021-12-02 14:58:56 +00001035 if (need_vm_lock &&
1036 plat_ffa_inject_notification_pending_interrupt(
1037 vcpu_locked, current, vm_locked)) {
1038 assert(vcpu_interrupt_count_get(vcpu_locked) > 0);
1039 break;
1040 }
1041
Andrew Scullb06d1752019-02-04 10:15:48 +00001042 /* Allow virtual interrupts to be delivered. */
Manish Pandey35e452f2021-02-18 21:36:34 +00001043 if (vcpu_interrupt_count_get(vcpu_locked) > 0) {
Andrew Scullb06d1752019-02-04 10:15:48 +00001044 break;
1045 }
1046
Andrew Walbran508e63c2018-12-20 17:02:37 +00001047 if (arch_timer_enabled(&vcpu->regs)) {
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001048 timer_remaining_ns =
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001049 arch_timer_remaining_ns(&vcpu->regs);
1050
1051 /*
1052 * The timer expired so allow the interrupt to be
1053 * delivered.
1054 */
1055 if (timer_remaining_ns == 0) {
1056 break;
1057 }
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001058 }
Andrew Walbran2fc856a2019-11-04 15:17:24 +00001059
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001060 /*
1061 * The vCPU is not ready to run, return the appropriate code to
1062 * the primary which called vcpu_run.
1063 */
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001064 run_ret->func = HF_FFA_RUN_WAIT_FOR_INTERRUPT;
Andrew Walbran4692a3a2020-08-07 12:42:01 +01001065 run_ret->arg1 = ffa_vm_vcpu(vcpu->vm->id, vcpu_index(vcpu));
1066 run_ret->arg2 = timer_remaining_ns;
Andrew Walbran508e63c2018-12-20 17:02:37 +00001067
1068 ret = false;
1069 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +00001070
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001071 case VCPU_STATE_BLOCKED:
1072 /* A blocked vCPU is run unconditionally. Fall through. */
1073 case VCPU_STATE_PREEMPTED:
J-Alves6e2abc62021-12-02 14:58:56 +00001074 /* Check NPI is to be injected here. */
1075 if (need_vm_lock) {
1076 plat_ffa_inject_notification_pending_interrupt(
1077 vcpu_locked, current, vm_locked);
1078 }
Andrew Walbran508e63c2018-12-20 17:02:37 +00001079 break;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001080 default:
1081 /*
1082 * Execution not expected to reach here. Deny the request
1083 * gracefully.
1084 */
1085 *run_ret = ffa_error(FFA_DENIED);
1086 ret = false;
1087 goto out;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001088 }
1089
Madhukar Pappireddy1480fce2022-06-21 18:09:25 -05001090 plat_ffa_init_schedule_mode_ffa_run(current, vcpu_locked);
1091
Andrew Scullb06d1752019-02-04 10:15:48 +00001092 /* It has been decided that the vCPU should be run. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001093 vcpu->cpu = current->cpu;
Andrew Sculld6ee1102019-04-05 22:12:42 +01001094 vcpu->state = VCPU_STATE_RUNNING;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001095
Olivier Deprez04168ed2022-09-26 09:20:00 +02001096 if (vcpu_was_init_state) {
1097 vcpu_set_phys_core_idx(vcpu);
1098 vcpu_set_boot_info_gp_reg(vcpu);
J-Alves7ac49052022-02-08 17:20:53 +00001099 }
J-Alves7ac49052022-02-08 17:20:53 +00001100
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001101 /*
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001102 * Mark the registers as unavailable now that we're about to reflect
1103 * them onto the real registers. This will also prevent another physical
1104 * CPU from trying to read these registers.
1105 */
1106 vcpu->regs_available = false;
1107
1108 ret = true;
1109
1110out:
Max Shvetsov40108e72020-08-27 12:39:50 +01001111 vcpu_unlock(&vcpu_locked);
Andrew Scullb06d1752019-02-04 10:15:48 +00001112 if (need_vm_lock) {
Max Shvetsov40108e72020-08-27 12:39:50 +01001113 vm_unlock(&vm_locked);
Andrew Scullb06d1752019-02-04 10:15:48 +00001114 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001115 return ret;
1116}
1117
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001118struct ffa_value api_ffa_run(ffa_vm_id_t vm_id, ffa_vcpu_index_t vcpu_idx,
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001119 struct vcpu *current, struct vcpu **next)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001120{
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001121 struct vm *vm;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001122 struct vcpu *vcpu;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001123 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001124 enum vcpu_state next_state = VCPU_STATE_BLOCKED;
1125 struct vcpu_locked current_locked;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001126
Raghu Krishnamurthy048d63f2021-12-11 12:45:41 -08001127 if (!plat_ffa_run_checks(current, vm_id, vcpu_idx, &ret, next)) {
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001128 return ret;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001129 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001130
Raghu Krishnamurthy62f97a72021-07-27 02:14:59 -07001131 if (plat_ffa_run_forward(vm_id, vcpu_idx, &ret)) {
1132 return ret;
1133 }
1134
Andrew Scull19503262018-09-20 14:48:39 +01001135 /* The requested VM must exist. */
Andrew Walbran42347a92019-05-09 13:59:03 +01001136 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +01001137 if (vm == NULL) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001138 goto out;
Andrew Scull19503262018-09-20 14:48:39 +01001139 }
1140
Fuad Tabbaed294af2019-12-20 10:43:01 +00001141 /* The requested vCPU must exist. */
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001142 if (vcpu_idx >= vm->vcpu_count) {
Andrew Scull6d2db332018-10-10 15:28:17 +01001143 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +01001144 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001145
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001146 /*
1147 * Refer Figure 8.13 Scenario 1 of the FF-A v1.1 EAC spec. SPMC
1148 * bypasses the intermediate execution contexts and resumes the
1149 * SP execution context that was originally preempted.
1150 */
1151 if (*next != NULL) {
1152 vcpu = *next;
1153 } else {
1154 vcpu = vm_get_vcpu(vm, vcpu_idx);
1155 }
1156
1157 if (!plat_ffa_check_runtime_state_transition(current, current->vm->id,
1158 HF_INVALID_VM_ID, vcpu,
1159 FFA_RUN_32, &next_state)) {
1160 return ffa_error(FFA_DENIED);
1161 }
1162
Andrew Scullb06d1752019-02-04 10:15:48 +00001163 if (!api_vcpu_prepare_run(current, vcpu, &ret)) {
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001164 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001165 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001166
Andrew Walbran508e63c2018-12-20 17:02:37 +00001167 /*
1168 * Inject timer interrupt if timer has expired. It's safe to access
1169 * vcpu->regs here because api_vcpu_prepare_run already made sure that
1170 * regs_available was true (and then set it to false) before returning
1171 * true.
1172 */
1173 if (arch_timer_pending(&vcpu->regs)) {
1174 /* Make virtual timer interrupt pending. */
Andrew Walbranfc9d4382019-05-10 18:07:21 +01001175 internal_interrupt_inject(vcpu, HF_VIRTUAL_TIMER_INTID, vcpu,
1176 NULL);
Andrew Walbran508e63c2018-12-20 17:02:37 +00001177
1178 /*
1179 * Set the mask bit so the hardware interrupt doesn't fire
1180 * again. Ideally we wouldn't do this because it affects what
1181 * the secondary vCPU sees, but if we don't then we end up with
1182 * a loop of the interrupt firing each time we try to return to
1183 * the secondary vCPU.
1184 */
1185 arch_timer_mask(&vcpu->regs);
1186 }
1187
Fuad Tabbaed294af2019-12-20 10:43:01 +00001188 /* Switch to the vCPU. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001189 *next = vcpu;
Wedson Almeida Filho03306112018-11-26 00:08:03 +00001190
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05001191 assert(next_state == VCPU_STATE_BLOCKED);
1192 current_locked = vcpu_lock(current);
1193 current->state = VCPU_STATE_BLOCKED;
1194 vcpu_unlock(&current_locked);
1195
Andrew Scull33fecd32019-01-08 14:48:27 +00001196 /*
1197 * Set a placeholder return code to the scheduler. This will be
1198 * overwritten when the switch back to the primary occurs.
1199 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001200 ret.func = FFA_INTERRUPT_32;
Andrew Walbran7e824602020-10-22 16:51:40 +01001201 ret.arg1 = 0;
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +01001202 ret.arg2 = 0;
Andrew Scull33fecd32019-01-08 14:48:27 +00001203
Andrew Scull6d2db332018-10-10 15:28:17 +01001204out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001205 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001206}
1207
1208/**
Andrew Scull81e85092018-12-12 12:56:20 +00001209 * Check that the mode indicates memory that is valid, owned and exclusive.
1210 */
Andrew Walbran1281ed42019-10-22 17:23:40 +01001211static bool api_mode_valid_owned_and_exclusive(uint32_t mode)
Andrew Scull81e85092018-12-12 12:56:20 +00001212{
Andrew Scullb5f49e02019-10-02 13:20:47 +01001213 return (mode & (MM_MODE_D | MM_MODE_INVALID | MM_MODE_UNOWNED |
1214 MM_MODE_SHARED)) == 0;
Andrew Scull81e85092018-12-12 12:56:20 +00001215}
1216
1217/**
Andrew Walbranc8a01972020-09-22 11:23:30 +01001218 * Determines the value to be returned by api_ffa_rxtx_map and
1219 * api_ffa_rx_release after they've succeeded. If a secondary VM is running and
1220 * there are waiters, it also switches back to the primary VM for it to wake
1221 * waiters up.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001222 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001223static struct ffa_value api_waiter_result(struct vm_locked locked_vm,
1224 struct vcpu *current,
1225 struct vcpu **next)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001226{
1227 struct vm *vm = locked_vm.vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001228
Federico Recanati86f6cde2022-04-28 19:44:49 +02001229 CHECK(list_empty(&vm->mailbox.waiter_list));
1230
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001231 if (list_empty(&vm->mailbox.waiter_list)) {
1232 /* No waiters, nothing else to do. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001233 return (struct ffa_value){.func = FFA_SUCCESS_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001234 }
1235
1236 if (vm->id == HF_PRIMARY_VM_ID) {
1237 /* The caller is the primary VM. Tell it to wake up waiters. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001238 return (struct ffa_value){.func = FFA_RX_RELEASE_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001239 }
1240
1241 /*
1242 * Switch back to the primary VM, informing it that there are waiters
1243 * that need to be notified.
1244 */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001245 *next = api_switch_to_primary(
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001246 current, (struct ffa_value){.func = FFA_RX_RELEASE_32},
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001247 VCPU_STATE_WAITING);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001248
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001249 return (struct ffa_value){.func = FFA_SUCCESS_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001250}
1251
1252/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001253 * Configures the hypervisor's stage-1 view of the send and receive pages.
Andrew Sculle1322792019-07-01 17:46:10 +01001254 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001255static bool api_vm_configure_stage1(struct mm_stage1_locked mm_stage1_locked,
1256 struct vm_locked vm_locked,
Andrew Sculle1322792019-07-01 17:46:10 +01001257 paddr_t pa_send_begin, paddr_t pa_send_end,
1258 paddr_t pa_recv_begin, paddr_t pa_recv_end,
Olivier Deprez96a2a262020-06-11 17:21:38 +02001259 uint32_t extra_attributes,
Andrew Sculle1322792019-07-01 17:46:10 +01001260 struct mpool *local_page_pool)
1261{
1262 bool ret;
Andrew Sculle1322792019-07-01 17:46:10 +01001263
1264 /* Map the send page as read-only in the hypervisor address space. */
1265 vm_locked.vm->mailbox.send =
1266 mm_identity_map(mm_stage1_locked, pa_send_begin, pa_send_end,
Olivier Deprez96a2a262020-06-11 17:21:38 +02001267 MM_MODE_R | extra_attributes, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001268 if (!vm_locked.vm->mailbox.send) {
Andrew Sculle1322792019-07-01 17:46:10 +01001269 goto fail;
1270 }
1271
1272 /*
1273 * Map the receive page as writable in the hypervisor address space. On
1274 * failure, unmap the send page before returning.
1275 */
1276 vm_locked.vm->mailbox.recv =
1277 mm_identity_map(mm_stage1_locked, pa_recv_begin, pa_recv_end,
Olivier Deprez96a2a262020-06-11 17:21:38 +02001278 MM_MODE_W | extra_attributes, local_page_pool);
Andrew Sculle1322792019-07-01 17:46:10 +01001279 if (!vm_locked.vm->mailbox.recv) {
Andrew Sculle1322792019-07-01 17:46:10 +01001280 goto fail_undo_send;
1281 }
1282
1283 ret = true;
1284 goto out;
1285
1286 /*
1287 * The following mappings will not require more memory than is available
1288 * in the local pool.
1289 */
1290fail_undo_send:
1291 vm_locked.vm->mailbox.send = NULL;
Andrew Scull7e8de322019-07-02 13:00:56 +01001292 CHECK(mm_unmap(mm_stage1_locked, pa_send_begin, pa_send_end,
1293 local_page_pool));
Andrew Sculle1322792019-07-01 17:46:10 +01001294
1295fail:
1296 ret = false;
1297
1298out:
Andrew Sculle1322792019-07-01 17:46:10 +01001299 return ret;
1300}
1301
1302/**
Manish Pandeyd34f8892020-06-19 17:41:07 +01001303 * Sanity checks and configures the send and receive pages in the VM stage-2
1304 * and hypervisor stage-1 page tables.
1305 *
1306 * Returns:
1307 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001308 * aligned, are the same or have invalid attributes.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001309 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
1310 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001311 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Manish Pandeyd34f8892020-06-19 17:41:07 +01001312 * - FFA_SUCCESS on success if no further action is needed.
Andrew Sculle1322792019-07-01 17:46:10 +01001313 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001314
1315struct ffa_value api_vm_configure_pages(
1316 struct mm_stage1_locked mm_stage1_locked, struct vm_locked vm_locked,
1317 ipaddr_t send, ipaddr_t recv, uint32_t page_count,
1318 struct mpool *local_page_pool)
Andrew Sculle1322792019-07-01 17:46:10 +01001319{
Manish Pandeyd34f8892020-06-19 17:41:07 +01001320 struct ffa_value ret;
1321 paddr_t pa_send_begin;
1322 paddr_t pa_send_end;
1323 paddr_t pa_recv_begin;
1324 paddr_t pa_recv_end;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001325 uint32_t orig_send_mode = 0;
1326 uint32_t orig_recv_mode = 0;
Olivier Deprez96a2a262020-06-11 17:21:38 +02001327 uint32_t extra_attributes;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001328
1329 /* We only allow these to be setup once. */
1330 if (vm_locked.vm->mailbox.send || vm_locked.vm->mailbox.recv) {
1331 ret = ffa_error(FFA_DENIED);
1332 goto out;
1333 }
1334
1335 /* Hafnium only supports a fixed size of RX/TX buffers. */
1336 if (page_count != HF_MAILBOX_SIZE / FFA_PAGE_SIZE) {
1337 ret = ffa_error(FFA_INVALID_PARAMETERS);
1338 goto out;
1339 }
1340
1341 /* Fail if addresses are not page-aligned. */
1342 if (!is_aligned(ipa_addr(send), PAGE_SIZE) ||
1343 !is_aligned(ipa_addr(recv), PAGE_SIZE)) {
1344 ret = ffa_error(FFA_INVALID_PARAMETERS);
1345 goto out;
1346 }
1347
1348 /* Convert to physical addresses. */
1349 pa_send_begin = pa_from_ipa(send);
1350 pa_send_end = pa_add(pa_send_begin, HF_MAILBOX_SIZE);
1351 pa_recv_begin = pa_from_ipa(recv);
1352 pa_recv_end = pa_add(pa_recv_begin, HF_MAILBOX_SIZE);
1353
1354 /* Fail if the same page is used for the send and receive pages. */
1355 if (pa_addr(pa_send_begin) == pa_addr(pa_recv_begin)) {
1356 ret = ffa_error(FFA_INVALID_PARAMETERS);
1357 goto out;
1358 }
Andrew Sculle1322792019-07-01 17:46:10 +01001359
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001360 /* Set stage 2 translation tables only for virtual FF-A instances. */
1361 if (vm_id_is_current_world(vm_locked.vm->id)) {
1362 /*
1363 * Ensure the pages are valid, owned and exclusive to the VM and
1364 * that the VM has the required access to the memory.
1365 */
1366 if (!vm_mem_get_mode(vm_locked, send, ipa_add(send, PAGE_SIZE),
1367 &orig_send_mode) ||
1368 !api_mode_valid_owned_and_exclusive(orig_send_mode) ||
1369 (orig_send_mode & MM_MODE_R) == 0 ||
1370 (orig_send_mode & MM_MODE_W) == 0) {
1371 dlog_error(
1372 "VM doesn't have required access rights to map "
1373 "TX buffer in stage 2.\n");
1374 ret = ffa_error(FFA_INVALID_PARAMETERS);
1375 goto out;
1376 }
Manish Pandeyd34f8892020-06-19 17:41:07 +01001377
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001378 if (!vm_mem_get_mode(vm_locked, recv, ipa_add(recv, PAGE_SIZE),
1379 &orig_recv_mode) ||
1380 !api_mode_valid_owned_and_exclusive(orig_recv_mode) ||
1381 (orig_recv_mode & MM_MODE_R) == 0) {
1382 dlog_error(
1383 "VM doesn't have required access rights to map "
1384 "RX buffer in stage 2.\n");
1385 ret = ffa_error(FFA_INVALID_PARAMETERS);
1386 goto out;
1387 }
Andrew Sculle1322792019-07-01 17:46:10 +01001388
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001389 /* Take memory ownership away from the VM and mark as shared. */
1390 uint32_t mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R |
1391 MM_MODE_W;
1392 if (vm_locked.vm->el0_partition) {
1393 mode |= MM_MODE_USER | MM_MODE_NG;
1394 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001395
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001396 if (!vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
1397 mode, local_page_pool, NULL)) {
1398 dlog_error(
1399 "Cannot allocate a new entry in stage 2 "
1400 "translation table.\n");
1401 ret = ffa_error(FFA_NO_MEMORY);
1402 goto out;
1403 }
Andrew Sculle1322792019-07-01 17:46:10 +01001404
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001405 mode = MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R;
1406 if (vm_locked.vm->el0_partition) {
1407 mode |= MM_MODE_USER | MM_MODE_NG;
1408 }
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001409
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001410 if (!vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
1411 mode, local_page_pool, NULL)) {
1412 /* TODO: partial defrag of failed range. */
1413 /* Recover any memory consumed in failed mapping. */
1414 vm_ptable_defrag(vm_locked, local_page_pool);
1415 goto fail_undo_send;
1416 }
Andrew Sculle1322792019-07-01 17:46:10 +01001417 }
1418
Olivier Deprez96a2a262020-06-11 17:21:38 +02001419 /* Get extra send/recv pages mapping attributes for the given VM ID. */
1420 extra_attributes = arch_mm_extra_attributes_from_vm(vm_locked.vm->id);
1421
Raghu Krishnamurthy95c3a272021-02-26 18:09:41 -08001422 /*
1423 * For EL0 partitions, since both the partition and the hypervisor code
1424 * use the EL2&0 translation regime, it is critical to mark the mappings
1425 * of the send and recv buffers as non-global in the TLB. For one, if we
1426 * dont mark it as non-global, it would cause TLB conflicts since there
1427 * would be an identity mapping with non-global attribute in the
1428 * partitions page tables, but another identity mapping in the
1429 * hypervisor page tables with the global attribute. The other issue is
1430 * one of security, we dont want other partitions to be able to access
1431 * other partitions buffers through cached translations.
1432 */
1433 if (vm_locked.vm->el0_partition) {
1434 extra_attributes |= MM_MODE_NG;
1435 }
1436
Manish Pandeyd34f8892020-06-19 17:41:07 +01001437 if (!api_vm_configure_stage1(mm_stage1_locked, vm_locked, pa_send_begin,
1438 pa_send_end, pa_recv_begin, pa_recv_end,
Olivier Deprez96a2a262020-06-11 17:21:38 +02001439 extra_attributes, local_page_pool)) {
Andrew Sculle1322792019-07-01 17:46:10 +01001440 goto fail_undo_send_and_recv;
1441 }
1442
Manish Pandeyd34f8892020-06-19 17:41:07 +01001443 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Sculle1322792019-07-01 17:46:10 +01001444 goto out;
1445
Andrew Sculle1322792019-07-01 17:46:10 +01001446fail_undo_send_and_recv:
Andrew Scull3c257452019-11-26 13:32:50 +00001447 CHECK(vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001448 orig_recv_mode, local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +01001449
1450fail_undo_send:
Andrew Scull3c257452019-11-26 13:32:50 +00001451 CHECK(vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
Manish Pandeyd34f8892020-06-19 17:41:07 +01001452 orig_send_mode, local_page_pool, NULL));
1453 ret = ffa_error(FFA_NO_MEMORY);
Andrew Sculle1322792019-07-01 17:46:10 +01001454
1455out:
Andrew Sculle1322792019-07-01 17:46:10 +01001456 return ret;
1457}
1458
J-Alves28ad9b42022-12-08 12:19:43 +00001459static void api_get_rxtx_description(struct vm *current_vm, ipaddr_t *send,
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001460 ipaddr_t *recv, uint32_t *page_count,
1461 ffa_vm_id_t *owner_vm_id)
1462{
1463 /*
1464 * If the message has been forwarded the effective addresses are in
1465 * hypervisor's TX buffer.
1466 */
J-Alves28ad9b42022-12-08 12:19:43 +00001467 bool forwarded = (current_vm->id == HF_OTHER_WORLD_ID) &&
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001468 (ipa_addr(*send) == 0) && (ipa_addr(*recv) == 0) &&
1469 (*page_count == 0);
1470
1471 if (forwarded) {
J-Alves28ad9b42022-12-08 12:19:43 +00001472 struct vm_locked vm_locked = vm_lock(current_vm);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001473 struct ffa_endpoint_rx_tx_descriptor *endpoint_desc =
1474 (struct ffa_endpoint_rx_tx_descriptor *)
1475 vm_locked.vm->mailbox.send;
1476 struct ffa_composite_memory_region *rx_region =
1477 ffa_enpoint_get_rx_memory_region(endpoint_desc);
1478 struct ffa_composite_memory_region *tx_region =
1479 ffa_enpoint_get_tx_memory_region(endpoint_desc);
1480
1481 *owner_vm_id = endpoint_desc->endpoint_id;
1482 *recv = ipa_init(rx_region->constituents[0].address);
1483 *send = ipa_init(tx_region->constituents[0].address);
1484 *page_count = rx_region->constituents[0].page_count;
J-Alves28ad9b42022-12-08 12:19:43 +00001485
1486 vm_unlock(&vm_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001487 } else {
J-Alves28ad9b42022-12-08 12:19:43 +00001488 *owner_vm_id = current_vm->id;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001489 }
1490}
Andrew Sculle1322792019-07-01 17:46:10 +01001491/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001492 * Configures the VM to send/receive data through the specified pages. The pages
Manish Pandeyd34f8892020-06-19 17:41:07 +01001493 * must not be shared. Locking of the page tables combined with a local memory
1494 * pool ensures there will always be enough memory to recover from any errors
1495 * that arise. The stage-1 page tables must be locked so memory cannot be taken
1496 * by another core which could result in this transaction being unable to roll
1497 * back in the case of an error.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001498 *
1499 * Returns:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001500 * - FFA_ERROR FFA_INVALID_PARAMETERS if the given addresses are not properly
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001501 * aligned, are the same or have invalid attributes.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001502 * - FFA_ERROR FFA_NO_MEMORY if the hypervisor was unable to map the buffers
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001503 * due to insuffient page table memory.
Daniel Boulby6f8941e2021-06-14 18:27:18 +01001504 * - FFA_ERROR FFA_DENIED if the pages are already mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001505 * - FFA_SUCCESS on success if no further action is needed.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001506 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001507struct ffa_value api_ffa_rxtx_map(ipaddr_t send, ipaddr_t recv,
Federico Recanati9f1b6532022-04-14 13:15:28 +02001508 uint32_t page_count, struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001509{
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001510 struct ffa_value ret;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001511 struct vm_locked owner_vm_locked;
Manish Pandeyd34f8892020-06-19 17:41:07 +01001512 struct mm_stage1_locked mm_stage1_locked;
1513 struct mpool local_page_pool;
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001514 ffa_vm_id_t owner_vm_id;
1515
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001516 /*
1517 * Get the original buffer addresses and VM ID in case of forwarded
1518 * message.
1519 */
J-Alves28ad9b42022-12-08 12:19:43 +00001520 api_get_rxtx_description(current->vm, &send, &recv, &page_count,
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001521 &owner_vm_id);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001522
1523 owner_vm_locked = plat_ffa_vm_find_locked_create(owner_vm_id);
1524 if (owner_vm_locked.vm == NULL) {
1525 dlog_error("Cannot map RX/TX for VM ID %#x, not found.\n",
1526 owner_vm_id);
1527 return ffa_error(FFA_DENIED);
1528 }
Andrew Scull220e6212018-12-21 18:09:00 +00001529
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001530 /*
Manish Pandeyd34f8892020-06-19 17:41:07 +01001531 * Create a local pool so any freed memory can't be used by another
1532 * thread. This is to ensure the original mapping can be restored if any
1533 * stage of the process fails.
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001534 */
Manish Pandeyd34f8892020-06-19 17:41:07 +01001535 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
1536
Manish Pandeyd34f8892020-06-19 17:41:07 +01001537 mm_stage1_locked = mm_lock_stage1();
Andrew Scull220e6212018-12-21 18:09:00 +00001538
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001539 ret = api_vm_configure_pages(mm_stage1_locked, owner_vm_locked, send,
1540 recv, page_count, &local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001541 if (ret.func != FFA_SUCCESS_32) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001542 goto exit;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001543 }
1544
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001545 /* Forward buffer mapping to SPMC if coming from a VM. */
1546 plat_ffa_rxtx_map_forward(owner_vm_locked);
1547
Federico Recanati9f1b6532022-04-14 13:15:28 +02001548 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Andrew Scull220e6212018-12-21 18:09:00 +00001549
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001550exit:
Manish Pandeyd34f8892020-06-19 17:41:07 +01001551 mpool_fini(&local_page_pool);
Manish Pandeyd34f8892020-06-19 17:41:07 +01001552 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8d8b1cf2022-04-14 13:16:00 +02001553 vm_unlock(&owner_vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001554
1555 return ret;
1556}
1557
1558/**
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001559 * Unmaps the RX/TX buffer pair with a partition or partition manager from the
1560 * translation regime of the caller. Unmap the region for the hypervisor and
1561 * set the memory region to owned and exclusive for the component. Since the
1562 * memory region mapped in the page table, when the buffers were originally
1563 * created we can safely remap it.
1564 *
1565 * Returns:
1566 * - FFA_ERROR FFA_INVALID_PARAMETERS if there is no buffer pair registered on
1567 * behalf of the caller.
1568 * - FFA_SUCCESS on success if no further action is needed.
1569 */
1570struct ffa_value api_ffa_rxtx_unmap(ffa_vm_id_t allocator_id,
1571 struct vcpu *current)
1572{
1573 struct vm *vm = current->vm;
1574 struct vm_locked vm_locked;
Federico Recanati8da9e332022-02-10 11:00:17 +01001575 ffa_vm_id_t owner_vm_id;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001576 struct mm_stage1_locked mm_stage1_locked;
1577 paddr_t send_pa_begin;
1578 paddr_t send_pa_end;
1579 paddr_t recv_pa_begin;
1580 paddr_t recv_pa_end;
Federico Recanati8da9e332022-02-10 11:00:17 +01001581 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_32};
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001582
J-Alves9bd324a2023-01-12 10:52:52 +00001583 if (vm->id == HF_HYPERVISOR_VM_ID && !plat_ffa_is_vm_id(allocator_id)) {
1584 dlog_error(
1585 "The Hypervisor must specify a valid VM ID in register "
1586 "W1, if FFA_RXTX_UNMAP call forwarded to SPM.\n");
1587 return ffa_error(FFA_INVALID_PARAMETERS);
1588 }
1589
Federico Recanati8da9e332022-02-10 11:00:17 +01001590 /* Ensure `allocator_id` is set only at Non-Secure Physical instance. */
1591 if (vm_id_is_current_world(vm->id) && (allocator_id != 0)) {
J-Alves9bd324a2023-01-12 10:52:52 +00001592 dlog_error(
1593 "The register W1 (containing ID) must be 0 at virtual "
1594 "instances.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001595 return ffa_error(FFA_INVALID_PARAMETERS);
1596 }
1597
1598 /* VM ID of which buffers have to be unmapped. */
1599 owner_vm_id = (allocator_id != 0) ? allocator_id : vm->id;
1600
1601 vm_locked = plat_ffa_vm_find_locked(owner_vm_id);
1602 vm = vm_locked.vm;
1603 if (vm == NULL) {
1604 dlog_error("Cannot unmap RX/TX for VM ID %#x, not found.\n",
1605 owner_vm_id);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001606 return ffa_error(FFA_INVALID_PARAMETERS);
1607 }
1608
1609 /* Get send and receive buffers. */
1610 if (vm->mailbox.send == NULL || vm->mailbox.recv == NULL) {
Olivier Deprez86d87ae2021-08-19 14:27:46 +02001611 dlog_verbose(
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001612 "No buffer pair registered on behalf of the caller.\n");
Federico Recanati8da9e332022-02-10 11:00:17 +01001613 ret = ffa_error(FFA_INVALID_PARAMETERS);
1614 goto out;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001615 }
1616
1617 /* Currently a mailbox size of 1 page is assumed. */
1618 send_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.send));
1619 send_pa_end = pa_add(send_pa_begin, HF_MAILBOX_SIZE);
1620 recv_pa_begin = pa_from_va(va_from_ptr(vm->mailbox.recv));
1621 recv_pa_end = pa_add(recv_pa_begin, HF_MAILBOX_SIZE);
1622
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001623 mm_stage1_locked = mm_lock_stage1();
1624
Federico Recanati8da9e332022-02-10 11:00:17 +01001625 /* Reset stage 2 mapping only for virtual FF-A instances. */
1626 if (vm_id_is_current_world(owner_vm_id)) {
1627 /*
1628 * Set the memory region of the buffers back to the default mode
1629 * for the VM. Since this memory region was already mapped for
1630 * the RXTX buffers we can safely remap them.
1631 */
1632 CHECK(vm_identity_map(vm_locked, send_pa_begin, send_pa_end,
1633 MM_MODE_R | MM_MODE_W | MM_MODE_X,
1634 &api_page_pool, NULL));
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001635
Federico Recanati8da9e332022-02-10 11:00:17 +01001636 CHECK(vm_identity_map(vm_locked, recv_pa_begin, recv_pa_end,
1637 MM_MODE_R | MM_MODE_W | MM_MODE_X,
1638 &api_page_pool, NULL));
1639 }
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001640
1641 /* Unmap the buffers in the partition manager. */
1642 CHECK(mm_unmap(mm_stage1_locked, send_pa_begin, send_pa_end,
1643 &api_page_pool));
1644 CHECK(mm_unmap(mm_stage1_locked, recv_pa_begin, recv_pa_end,
1645 &api_page_pool));
1646
1647 vm->mailbox.send = NULL;
1648 vm->mailbox.recv = NULL;
Federico Recanati10bd06c2022-02-23 17:32:59 +01001649 plat_ffa_vm_destroy(vm_locked);
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001650
Federico Recanati8da9e332022-02-10 11:00:17 +01001651 /* Forward buffer unmapping to SPMC if coming from a VM. */
J-Alves70079932022-12-07 17:32:20 +00001652 plat_ffa_rxtx_unmap_forward(vm_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01001653
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001654 mm_unlock_stage1(&mm_stage1_locked);
Federico Recanati8da9e332022-02-10 11:00:17 +01001655
1656out:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001657 vm_unlock(&vm_locked);
1658
Federico Recanati8da9e332022-02-10 11:00:17 +01001659 return ret;
Daniel Boulby9e420ca2021-07-07 15:03:49 +01001660}
1661
1662/**
Federico Recanati25053ee2022-03-14 15:01:53 +01001663 * Copies data from the sender's send buffer to the recipient's receive buffer
1664 * and notifies the receiver.
1665 */
1666struct ffa_value api_ffa_msg_send2(ffa_vm_id_t sender_vm_id, uint32_t flags,
1667 struct vcpu *current)
1668{
1669 struct vm *from = current->vm;
1670 struct vm *to;
1671 struct vm_locked to_locked;
1672 ffa_vm_id_t msg_sender_id;
1673 struct vm_locked sender_locked;
1674 const void *from_msg;
1675 struct ffa_value ret;
1676 struct ffa_partition_rxtx_header header;
1677 ffa_vm_id_t sender_id;
1678 ffa_vm_id_t receiver_id;
1679 uint32_t msg_size;
1680 ffa_notifications_bitmap_t rx_buffer_full;
1681
1682 /* Only Hypervisor can set `sender_vm_id` when forwarding messages. */
1683 if (from->id != HF_HYPERVISOR_VM_ID && sender_vm_id != 0) {
1684 dlog_error("Sender VM ID must be zero.\n");
1685 return ffa_error(FFA_INVALID_PARAMETERS);
1686 }
1687
Federico Recanati25053ee2022-03-14 15:01:53 +01001688 /*
1689 * Get message sender's mailbox, which can be different to the `from` vm
1690 * when the message is forwarded.
1691 */
1692 msg_sender_id = (sender_vm_id != 0) ? sender_vm_id : from->id;
1693 sender_locked = plat_ffa_vm_find_locked(msg_sender_id);
1694 if (sender_locked.vm == NULL) {
1695 dlog_error("Cannot send message from VM ID %#x, not found.\n",
1696 msg_sender_id);
1697 return ffa_error(FFA_DENIED);
1698 }
1699
1700 from_msg = sender_locked.vm->mailbox.send;
1701 if (from_msg == NULL) {
1702 dlog_error("Cannot retrieve TX buffer for VM ID %#x.\n",
1703 msg_sender_id);
1704 ret = ffa_error(FFA_DENIED);
1705 goto out_unlock_sender;
1706 }
1707
1708 /*
1709 * Copy message header as safety measure to avoid multiple accesses to
1710 * unsafe memory which could be 'corrupted' between safety checks and
1711 * final buffer copy.
1712 */
1713 memcpy_s(&header, FFA_RXTX_HEADER_SIZE, from_msg, FFA_RXTX_HEADER_SIZE);
1714 sender_id = ffa_rxtx_header_sender(&header);
1715 receiver_id = ffa_rxtx_header_receiver(&header);
1716
1717 /* Ensure Sender IDs from API and from message header match. */
1718 if (msg_sender_id != sender_id) {
1719 dlog_error(
1720 "Message sender VM ID (%#x) doesn't match header's VM "
1721 "ID (%#x).\n",
1722 msg_sender_id, sender_id);
1723 ret = ffa_error(FFA_INVALID_PARAMETERS);
1724 goto out_unlock_sender;
1725 }
1726
1727 /* Disallow reflexive requests as this suggests an error in the VM. */
1728 if (receiver_id == sender_id) {
1729 dlog_error("Sender and receive VM IDs must be different.\n");
1730 ret = ffa_error(FFA_INVALID_PARAMETERS);
1731 goto out_unlock_sender;
1732 }
1733
Federico Recanati7b39ff22022-03-14 15:01:53 +01001734 /* `flags` can be set only at secure virtual FF-A instances. */
1735 if (plat_ffa_is_vm_id(sender_id) && (flags != 0)) {
1736 dlog_error("flags must be zero.\n");
1737 return ffa_error(FFA_INVALID_PARAMETERS);
1738 }
1739
Federico Recanati25053ee2022-03-14 15:01:53 +01001740 /*
1741 * Check if the message has to be forwarded to the SPMC, in
1742 * this case return, the SPMC will handle the buffer copy.
1743 */
1744 if (plat_ffa_msg_send2_forward(receiver_id, sender_id, &ret)) {
1745 goto out_unlock_sender;
1746 }
1747
1748 /* Ensure the receiver VM exists. */
1749 to_locked = plat_ffa_vm_find_locked(receiver_id);
1750 to = to_locked.vm;
1751
1752 if (to == NULL) {
1753 dlog_error("Cannot deliver message to VM %#x, not found.\n",
1754 receiver_id);
1755 ret = ffa_error(FFA_INVALID_PARAMETERS);
1756 goto out_unlock_sender;
1757 }
1758
1759 /*
1760 * Check sender and receiver can use indirect messages.
1761 * Sender is the VM/SP who originally sent the message, not the
1762 * hypervisor possibly relaying it.
1763 */
1764 if (!plat_ffa_is_indirect_msg_supported(sender_locked, to_locked)) {
1765 dlog_verbose("VM %#x doesn't support indirect message\n",
1766 sender_id);
1767 ret = ffa_error(FFA_DENIED);
1768 goto out;
1769 }
1770
1771 if (to->mailbox.state != MAILBOX_STATE_EMPTY ||
1772 to->mailbox.recv == NULL) {
1773 dlog_error(
1774 "Cannot deliver message to VM %#x, RX buffer not "
1775 "ready.\n",
1776 receiver_id);
1777 ret = ffa_error(FFA_BUSY);
1778 goto out;
1779 }
1780
Federico Recanati644f0462022-03-17 12:04:00 +01001781 /* Acquire receiver's RX buffer. */
1782 if (!plat_ffa_acquire_receiver_rx(to_locked, &ret)) {
1783 dlog_error("Failed to acquire RX buffer for VM %#x\n", to->id);
1784 goto out;
1785 }
1786
Federico Recanati25053ee2022-03-14 15:01:53 +01001787 /* Check the size of transfer. */
1788 msg_size = FFA_RXTX_HEADER_SIZE + header.size;
1789 if ((msg_size > FFA_PARTITION_MSG_PAYLOAD_MAX) ||
1790 (header.size > FFA_PARTITION_MSG_PAYLOAD_MAX)) {
1791 dlog_error("Message is too big.\n");
1792 ret = ffa_error(FFA_INVALID_PARAMETERS);
1793 goto out;
1794 }
1795
1796 /* Copy data. */
1797 memcpy_s(to->mailbox.recv, FFA_MSG_PAYLOAD_MAX, from_msg, msg_size);
1798 to->mailbox.recv_size = msg_size;
1799 to->mailbox.recv_sender = sender_id;
1800 to->mailbox.recv_func = FFA_MSG_SEND2_32;
1801 to->mailbox.state = MAILBOX_STATE_RECEIVED;
1802
1803 rx_buffer_full = plat_ffa_is_vm_id(sender_id)
1804 ? FFA_NOTIFICATION_HYP_BUFFER_FULL_MASK
1805 : FFA_NOTIFICATION_SPM_BUFFER_FULL_MASK;
1806 vm_notifications_framework_set_pending(to_locked, rx_buffer_full);
1807
1808 if ((FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) == 0) {
1809 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
1810 vcpu_index(current));
1811 plat_ffa_sri_trigger_not_delayed(current->cpu);
1812 } else {
1813 plat_ffa_sri_state_set(DELAYED);
1814 }
1815
1816 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
1817
1818out:
1819 vm_unlock(&to_locked);
1820
1821out_unlock_sender:
1822 vm_unlock(&sender_locked);
1823
1824 return ret;
1825}
1826
1827/**
Andrew Scullec52ddf2019-08-20 10:41:01 +01001828 * Checks whether the vCPU's attempt to block for a message has already been
1829 * interrupted or whether it is allowed to block.
1830 */
Olivier Deprezd8e18882022-07-15 14:46:41 +02001831static bool api_ffa_msg_recv_block_interrupted(struct vcpu *current)
Andrew Scullec52ddf2019-08-20 10:41:01 +01001832{
Manish Pandey35e452f2021-02-18 21:36:34 +00001833 struct vcpu_locked current_locked;
Andrew Scullec52ddf2019-08-20 10:41:01 +01001834 bool interrupted;
1835
Manish Pandey35e452f2021-02-18 21:36:34 +00001836 current_locked = vcpu_lock(current);
Andrew Scullec52ddf2019-08-20 10:41:01 +01001837
1838 /*
1839 * Don't block if there are enabled and pending interrupts, to match
1840 * behaviour of wait_for_interrupt.
1841 */
Manish Pandey35e452f2021-02-18 21:36:34 +00001842 interrupted = (vcpu_interrupt_count_get(current_locked) > 0);
Andrew Scullec52ddf2019-08-20 10:41:01 +01001843
Manish Pandey35e452f2021-02-18 21:36:34 +00001844 vcpu_unlock(&current_locked);
Andrew Scullec52ddf2019-08-20 10:41:01 +01001845
1846 return interrupted;
1847}
1848
1849/**
Andrew Scullaa039b32018-10-04 15:02:26 +01001850 * Receives a message from the mailbox. If one isn't available, this function
1851 * can optionally block the caller until one becomes available.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001852 *
Andrew Scullaa039b32018-10-04 15:02:26 +01001853 * No new messages can be received until the mailbox has been cleared.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001854 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001855struct ffa_value api_ffa_msg_recv(bool block, struct vcpu *current,
1856 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001857{
Olivier Deprezee9d6a92019-11-26 09:14:11 +00001858 bool is_direct_request_ongoing;
1859 struct vcpu_locked current_locked;
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +01001860 struct vm *vm = current->vm;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001861 struct ffa_value return_code;
J-Alvesb37fd082020-10-22 12:29:21 +01001862 bool is_from_secure_world =
1863 (current->vm->id & HF_VM_ID_WORLD_MASK) != 0;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001864
Andrew Scullaa039b32018-10-04 15:02:26 +01001865 /*
1866 * The primary VM will receive messages as a status code from running
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001867 * vCPUs and must not call this function.
Andrew Scullaa039b32018-10-04 15:02:26 +01001868 */
J-Alvesb37fd082020-10-22 12:29:21 +01001869 if (!is_from_secure_world && vm->id == HF_PRIMARY_VM_ID) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001870 return ffa_error(FFA_NOT_SUPPORTED);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001871 }
1872
Olivier Deprezee9d6a92019-11-26 09:14:11 +00001873 /*
1874 * Deny if vCPU is executing in context of an FFA_MSG_SEND_DIRECT_REQ
1875 * invocation.
1876 */
1877 current_locked = vcpu_lock(current);
1878 is_direct_request_ongoing =
1879 is_ffa_direct_msg_request_ongoing(current_locked);
1880 vcpu_unlock(&current_locked);
1881
1882 if (is_direct_request_ongoing) {
1883 return ffa_error(FFA_DENIED);
1884 }
1885
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001886 sl_lock(&vm->lock);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001887
Andrew Scullaa039b32018-10-04 15:02:26 +01001888 /* Return pending messages without blocking. */
Andrew Sculld6ee1102019-04-05 22:12:42 +01001889 if (vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001890 return_code = ffa_msg_recv_return(vm);
Federico Recanati25053ee2022-03-14 15:01:53 +01001891 if (return_code.func == FFA_MSG_SEND_32) {
1892 vm->mailbox.state = MAILBOX_STATE_READ;
1893 }
Jose Marinho3e2442f2019-03-12 13:30:37 +00001894 goto out;
1895 }
1896
1897 /* No pending message so fail if not allowed to block. */
1898 if (!block) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001899 return_code = ffa_error(FFA_RETRY);
Andrew Scullaa039b32018-10-04 15:02:26 +01001900 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001901 }
Andrew Scullaa039b32018-10-04 15:02:26 +01001902
Andrew Walbran9311c9a2019-03-12 16:59:04 +00001903 /*
Jose Marinho3e2442f2019-03-12 13:30:37 +00001904 * From this point onward this call can only be interrupted or a message
1905 * received. If a message is received the return value will be set at
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001906 * that time to FFA_SUCCESS.
Andrew Walbran9311c9a2019-03-12 16:59:04 +00001907 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001908 return_code = ffa_error(FFA_INTERRUPTED);
1909 if (api_ffa_msg_recv_block_interrupted(current)) {
Andrew Scullaa039b32018-10-04 15:02:26 +01001910 goto out;
1911 }
1912
J-Alvesb37fd082020-10-22 12:29:21 +01001913 if (is_from_secure_world) {
1914 /* Return to other world if caller is a SP. */
1915 *next = api_switch_to_other_world(
1916 current, (struct ffa_value){.func = FFA_MSG_WAIT_32},
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001917 VCPU_STATE_WAITING);
J-Alvesb37fd082020-10-22 12:29:21 +01001918 } else {
1919 /* Switch back to primary VM to block. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001920 struct ffa_value run_return = {
1921 .func = FFA_MSG_WAIT_32,
1922 .arg1 = ffa_vm_vcpu(vm->id, vcpu_index(current)),
Andrew Walbranb4816552018-12-05 17:35:42 +00001923 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001924
Andrew Walbranb4816552018-12-05 17:35:42 +00001925 *next = api_switch_to_primary(current, run_return,
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05001926 VCPU_STATE_WAITING);
Andrew Walbranb4816552018-12-05 17:35:42 +00001927 }
Andrew Scullaa039b32018-10-04 15:02:26 +01001928out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001929 sl_unlock(&vm->lock);
1930
Jose Marinho3e2442f2019-03-12 13:30:37 +00001931 return return_code;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001932}
1933
1934/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001935 * Retrieves the next VM whose mailbox became writable. For a VM to be notified
1936 * by this function, the caller must have called api_mailbox_send before with
1937 * the notify argument set to true, and this call must have failed because the
1938 * mailbox was not available.
1939 *
1940 * It should be called repeatedly to retrieve a list of VMs.
1941 *
1942 * Returns -1 if no VM became writable, or the id of the VM whose mailbox
1943 * became writable.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001944 */
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001945int64_t api_mailbox_writable_get(const struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001946{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +01001947 struct vm *vm = current->vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001948 struct wait_entry *entry;
Andrew Scullc0e569a2018-10-02 18:05:21 +01001949 int64_t ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001950
1951 sl_lock(&vm->lock);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001952 if (list_empty(&vm->mailbox.ready_list)) {
1953 ret = -1;
1954 goto exit;
1955 }
1956
1957 entry = CONTAINER_OF(vm->mailbox.ready_list.next, struct wait_entry,
1958 ready_links);
1959 list_remove(&entry->ready_links);
Andrew Walbranaad8f982019-12-04 10:56:39 +00001960 ret = vm_id_for_wait_entry(vm, entry);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001961
1962exit:
1963 sl_unlock(&vm->lock);
1964 return ret;
1965}
1966
1967/**
1968 * Retrieves the next VM waiting to be notified that the mailbox of the
1969 * specified VM became writable. Only primary VMs are allowed to call this.
1970 *
Wedson Almeida Filhob790f652019-01-22 23:41:56 +00001971 * Returns -1 on failure or if there are no waiters; the VM id of the next
1972 * waiter otherwise.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001973 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01001974int64_t api_mailbox_waiter_get(ffa_vm_id_t vm_id, const struct vcpu *current)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001975{
1976 struct vm *vm;
1977 struct vm_locked locked;
1978 struct wait_entry *entry;
1979 struct vm *waiting_vm;
1980
1981 /* Only primary VMs are allowed to call this function. */
1982 if (current->vm->id != HF_PRIMARY_VM_ID) {
1983 return -1;
1984 }
1985
Andrew Walbran42347a92019-05-09 13:59:03 +01001986 vm = vm_find(vm_id);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001987 if (vm == NULL) {
1988 return -1;
1989 }
1990
Fuad Tabbaed294af2019-12-20 10:43:01 +00001991 /* Check if there are outstanding notifications from given VM. */
Andrew Walbran7e932bd2019-04-29 16:47:06 +01001992 locked = vm_lock(vm);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001993 entry = api_fetch_waiter(locked);
1994 vm_unlock(&locked);
1995
1996 if (entry == NULL) {
1997 return -1;
1998 }
1999
2000 /* Enqueue notification to waiting VM. */
2001 waiting_vm = entry->waiting_vm;
2002
2003 sl_lock(&waiting_vm->lock);
2004 if (list_empty(&entry->ready_links)) {
2005 list_append(&waiting_vm->mailbox.ready_list,
2006 &entry->ready_links);
2007 }
2008 sl_unlock(&waiting_vm->lock);
2009
2010 return waiting_vm->id;
2011}
2012
2013/**
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002014 * Releases the caller's mailbox so that a new message can be received. The
2015 * caller must have copied out all data they wish to preserve as new messages
2016 * will overwrite the old and will arrive asynchronously.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002017 *
2018 * Returns:
Federico Recanati7bef0b92022-03-17 14:56:22 +01002019 * - FFA_ERROR FFA_INVALID_PARAMETERS if message is forwarded to SPMC but
2020 * there's no buffer pair mapped.
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002021 * - FFA_ERROR FFA_DENIED on failure, if the mailbox hasn't been read.
2022 * - FFA_SUCCESS on success if no further action is needed.
2023 * - FFA_RX_RELEASE if it was called by the primary VM and the primary VM now
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00002024 * needs to wake up or kick waiters. Waiters should be retrieved by calling
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002025 * hf_mailbox_waiter_get.
2026 */
Federico Recanati7bef0b92022-03-17 14:56:22 +01002027struct ffa_value api_ffa_rx_release(ffa_vm_id_t receiver_id,
2028 struct vcpu *current, struct vcpu **next)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002029{
Federico Recanati7bef0b92022-03-17 14:56:22 +01002030 struct vm *current_vm = current->vm;
2031 struct vm *vm;
2032 struct vm_locked vm_locked;
2033 ffa_vm_id_t current_vm_id = current_vm->id;
2034 ffa_vm_id_t release_vm_id;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002035 struct ffa_value ret;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00002036
Federico Recanati7bef0b92022-03-17 14:56:22 +01002037 /* `receiver_id` can be set only at Non-Secure Physical interface. */
2038 if (vm_id_is_current_world(current_vm_id) && (receiver_id != 0)) {
2039 dlog_error("Invalid `receiver_id`, must be zero.\n");
2040 return ffa_error(FFA_INVALID_PARAMETERS);
2041 }
2042
2043 /*
2044 * VM ID to be released: `receiver_id` if message has been forwarded by
2045 * Hypervisor to release a VM's buffer, current VM ID otherwise.
2046 */
2047 if (vm_id_is_current_world(current_vm_id) || (receiver_id == 0)) {
2048 release_vm_id = current_vm_id;
2049 } else {
2050 release_vm_id = receiver_id;
2051 }
2052
2053 vm_locked = plat_ffa_vm_find_locked(release_vm_id);
2054 vm = vm_locked.vm;
2055 if (vm == NULL) {
2056 dlog_error("No buffer registered for VM ID %#x.\n",
2057 release_vm_id);
2058 return ffa_error(FFA_INVALID_PARAMETERS);
2059 }
2060
2061 if (!plat_ffa_rx_release_forward(vm_locked, &ret)) {
2062 dlog_verbose("RX_RELEASE forward failed for VM ID %#x.\n",
2063 release_vm_id);
2064 goto out;
2065 }
2066
2067 /*
2068 * When SPMC owns a VM's RX buffer, the Hypervisor's view can be out of
2069 * sync: reset it to empty and exit.
2070 */
2071 if (plat_ffa_rx_release_forwarded(vm_locked)) {
2072 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2073 goto out;
2074 }
2075
Andrew Scullaa7db8e2019-02-01 14:12:19 +00002076 switch (vm->mailbox.state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +01002077 case MAILBOX_STATE_EMPTY:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002078 ret = ffa_error(FFA_DENIED);
Andrew Scullaa7db8e2019-02-01 14:12:19 +00002079 break;
2080
Federico Recanati7bef0b92022-03-17 14:56:22 +01002081 case MAILBOX_STATE_RECEIVED:
2082 if (release_vm_id == current_vm_id) {
2083 /*
2084 * VM requesting to release its own RX buffer,
2085 * must be in READ state.
2086 */
2087 ret = ffa_error(FFA_DENIED);
2088 } else {
2089 /*
2090 * Forwarded message from Hypervisor to release a VM
2091 * RX buffer, SPMC's mailbox view can be still in
2092 * RECEIVED state.
2093 */
2094 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2095 vm->mailbox.state = MAILBOX_STATE_EMPTY;
2096 }
2097 break;
2098
Andrew Sculld6ee1102019-04-05 22:12:42 +01002099 case MAILBOX_STATE_READ:
Federico Recanati7bef0b92022-03-17 14:56:22 +01002100 ret = api_waiter_result(vm_locked, current, next);
Andrew Sculld6ee1102019-04-05 22:12:42 +01002101 vm->mailbox.state = MAILBOX_STATE_EMPTY;
Andrew Scullaa7db8e2019-02-01 14:12:19 +00002102 break;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01002103 }
Federico Recanati7bef0b92022-03-17 14:56:22 +01002104
2105out:
2106 vm_unlock(&vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01002107
2108 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01002109}
Andrew Walbran318f5732018-11-20 16:23:42 +00002110
2111/**
Federico Recanati644f0462022-03-17 12:04:00 +01002112 * Acquire ownership of an RX buffer before writing to it. Both
2113 * Hypervisor and SPMC are producers of VM's RX buffer, and they
2114 * could contend for the same buffer. SPMC owns VM's RX buffer after
2115 * it's mapped in its translation regime. This ABI should be
2116 * used by the Hypervisor to get the ownership of a VM's RX buffer
2117 * from the SPMC solving the aforementioned possible contention.
2118 *
2119 * Returns:
2120 * - FFA_DENIED: callee cannot relinquish ownership of RX buffer.
2121 * - FFA_INVALID_PARAMETERS: there is no buffer pair registered for the VM.
2122 * - FFA_NOT_SUPPORTED: function not implemented at the FF-A instance.
2123 */
2124struct ffa_value api_ffa_rx_acquire(ffa_vm_id_t receiver_id,
2125 struct vcpu *current)
2126{
2127 struct vm_locked receiver_locked;
2128 struct vm *receiver;
2129 struct ffa_value ret;
2130
2131 if ((current->vm->id != HF_HYPERVISOR_VM_ID) ||
2132 !plat_ffa_is_vm_id(receiver_id)) {
2133 dlog_error(
2134 "FFA_RX_ACQUIRE not supported at this FF-A "
2135 "instance.\n");
2136 return ffa_error(FFA_NOT_SUPPORTED);
2137 }
2138
2139 receiver_locked = plat_ffa_vm_find_locked(receiver_id);
2140 receiver = receiver_locked.vm;
2141
2142 if (receiver == NULL || receiver->mailbox.recv == NULL) {
2143 dlog_error("Cannot retrieve RX buffer for VM ID %#x.\n",
2144 receiver_id);
2145 ret = ffa_error(FFA_INVALID_PARAMETERS);
2146 goto out;
2147 }
2148
2149 if (receiver->mailbox.state != MAILBOX_STATE_EMPTY) {
2150 dlog_error("Mailbox busy for VM ID %#x.\n", receiver_id);
2151 ret = ffa_error(FFA_DENIED);
2152 goto out;
2153 }
2154
2155 receiver->mailbox.state = MAILBOX_STATE_RECEIVED;
2156
2157 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
2158
2159out:
2160 vm_unlock(&receiver_locked);
2161
2162 return ret;
2163}
2164
2165/**
Andrew Walbran318f5732018-11-20 16:23:42 +00002166 * Enables or disables a given interrupt ID for the calling vCPU.
2167 *
2168 * Returns 0 on success, or -1 if the intid is invalid.
2169 */
Manish Pandey35e452f2021-02-18 21:36:34 +00002170int64_t api_interrupt_enable(uint32_t intid, bool enable,
2171 enum interrupt_type type, struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00002172{
Manish Pandey35e452f2021-02-18 21:36:34 +00002173 struct vcpu_locked current_locked;
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002174 struct interrupts *interrupts = &current->interrupts;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002175
Andrew Walbran318f5732018-11-20 16:23:42 +00002176 if (intid >= HF_NUM_INTIDS) {
2177 return -1;
2178 }
2179
Manish Pandey35e452f2021-02-18 21:36:34 +00002180 current_locked = vcpu_lock(current);
Andrew Walbran318f5732018-11-20 16:23:42 +00002181 if (enable) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00002182 /*
2183 * If it is pending and was not enabled before, increment the
2184 * count.
2185 */
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002186 if (vcpu_is_virt_interrupt_pending(interrupts, intid) &&
2187 !vcpu_is_virt_interrupt_enabled(interrupts, intid)) {
2188 vcpu_interrupt_count_increment(current_locked,
2189 interrupts, intid);
Andrew Walbran3d84a262018-12-13 14:41:19 +00002190 }
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002191 vcpu_virt_interrupt_set_enabled(interrupts, intid);
2192 vcpu_virt_interrupt_set_type(interrupts, intid, type);
Andrew Walbran318f5732018-11-20 16:23:42 +00002193 } else {
Andrew Walbran3d84a262018-12-13 14:41:19 +00002194 /*
2195 * If it is pending and was enabled before, decrement the count.
2196 */
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002197 if (vcpu_is_virt_interrupt_pending(interrupts, intid) &&
2198 vcpu_is_virt_interrupt_enabled(interrupts, intid)) {
2199 vcpu_interrupt_count_decrement(current_locked,
2200 interrupts, intid);
Andrew Walbran3d84a262018-12-13 14:41:19 +00002201 }
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002202 vcpu_virt_interrupt_clear_enabled(interrupts, intid);
2203 vcpu_virt_interrupt_set_type(interrupts, intid,
2204 INTERRUPT_TYPE_IRQ);
Andrew Walbran318f5732018-11-20 16:23:42 +00002205 }
2206
Manish Pandey35e452f2021-02-18 21:36:34 +00002207 vcpu_unlock(&current_locked);
Andrew Walbran318f5732018-11-20 16:23:42 +00002208 return 0;
2209}
2210
Madhukar Pappireddya1019112022-06-21 18:57:44 -05002211static void api_interrupt_clear_decrement(struct vcpu_locked locked_vcpu,
2212 struct interrupts *interrupts,
2213 uint32_t intid)
2214{
2215 vcpu_virt_interrupt_clear_pending(interrupts, intid);
2216 vcpu_interrupt_count_decrement(locked_vcpu, interrupts, intid);
2217}
2218
Andrew Walbran318f5732018-11-20 16:23:42 +00002219/**
2220 * Returns the ID of the next pending interrupt for the calling vCPU, and
2221 * acknowledges it (i.e. marks it as no longer pending). Returns
2222 * HF_INVALID_INTID if there are no pending interrupts.
2223 */
Wedson Almeida Filhoc559d132019-01-09 19:33:40 +00002224uint32_t api_interrupt_get(struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00002225{
Raghu Krishnamurthy61a025b2022-07-20 08:37:04 -07002226 uint32_t i;
Andrew Walbran318f5732018-11-20 16:23:42 +00002227 uint32_t first_interrupt = HF_INVALID_INTID;
Manish Pandey35e452f2021-02-18 21:36:34 +00002228 struct vcpu_locked current_locked;
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002229 struct interrupts *interrupts = &current->interrupts;
Andrew Walbran318f5732018-11-20 16:23:42 +00002230
2231 /*
2232 * Find the first enabled and pending interrupt ID, return it, and
2233 * deactivate it.
2234 */
Manish Pandey35e452f2021-02-18 21:36:34 +00002235 current_locked = vcpu_lock(current);
Andrew Walbran318f5732018-11-20 16:23:42 +00002236 for (i = 0; i < HF_NUM_INTIDS / INTERRUPT_REGISTER_BITS; ++i) {
2237 uint32_t enabled_and_pending =
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002238 interrupts->interrupt_enabled.bitmap[i] &
2239 interrupts->interrupt_pending.bitmap[i];
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002240
Andrew Walbran318f5732018-11-20 16:23:42 +00002241 if (enabled_and_pending != 0) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00002242 uint8_t bit_index = ctz(enabled_and_pending);
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002243
2244 first_interrupt =
2245 i * INTERRUPT_REGISTER_BITS + bit_index;
Manish Pandey35e452f2021-02-18 21:36:34 +00002246
Andrew Walbran3d84a262018-12-13 14:41:19 +00002247 /*
2248 * Mark it as no longer pending and decrement the count.
2249 */
Madhukar Pappireddya1019112022-06-21 18:57:44 -05002250 api_interrupt_clear_decrement(
Daniel Boulby4ca50f02022-07-29 18:29:34 +01002251 current_locked, interrupts, first_interrupt);
Andrew Walbran318f5732018-11-20 16:23:42 +00002252 break;
2253 }
2254 }
Andrew Walbran318f5732018-11-20 16:23:42 +00002255
Manish Pandey35e452f2021-02-18 21:36:34 +00002256 vcpu_unlock(&current_locked);
Andrew Walbran318f5732018-11-20 16:23:42 +00002257 return first_interrupt;
2258}
2259
2260/**
Andrew Walbran4cf217a2018-12-14 15:24:50 +00002261 * Returns whether the current vCPU is allowed to inject an interrupt into the
Andrew Walbran318f5732018-11-20 16:23:42 +00002262 * given VM and vCPU.
2263 */
2264static inline bool is_injection_allowed(uint32_t target_vm_id,
2265 struct vcpu *current)
2266{
2267 uint32_t current_vm_id = current->vm->id;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002268
Andrew Walbran318f5732018-11-20 16:23:42 +00002269 /*
2270 * The primary VM is allowed to inject interrupts into any VM. Secondary
2271 * VMs are only allowed to inject interrupts into their own vCPUs.
2272 */
2273 return current_vm_id == HF_PRIMARY_VM_ID ||
2274 current_vm_id == target_vm_id;
2275}
2276
2277/**
2278 * Injects a virtual interrupt of the given ID into the given target vCPU.
2279 * This doesn't cause the vCPU to actually be run immediately; it will be taken
2280 * when the vCPU is next run, which is up to the scheduler.
2281 *
Andrew Walbran3d84a262018-12-13 14:41:19 +00002282 * Returns:
2283 * - -1 on failure because the target VM or vCPU doesn't exist, the interrupt
2284 * ID is invalid, or the current VM is not allowed to inject interrupts to
2285 * the target VM.
2286 * - 0 on success if no further action is needed.
2287 * - 1 if it was called by the primary VM and the primary VM now needs to wake
2288 * up or kick the target vCPU.
Andrew Walbran318f5732018-11-20 16:23:42 +00002289 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002290int64_t api_interrupt_inject(ffa_vm_id_t target_vm_id,
2291 ffa_vcpu_index_t target_vcpu_idx, uint32_t intid,
Andrew Walbran42347a92019-05-09 13:59:03 +01002292 struct vcpu *current, struct vcpu **next)
Andrew Walbran318f5732018-11-20 16:23:42 +00002293{
Andrew Walbran318f5732018-11-20 16:23:42 +00002294 struct vcpu *target_vcpu;
Andrew Walbran42347a92019-05-09 13:59:03 +01002295 struct vm *target_vm = vm_find(target_vm_id);
Andrew Walbran318f5732018-11-20 16:23:42 +00002296
2297 if (intid >= HF_NUM_INTIDS) {
2298 return -1;
2299 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002300
Andrew Walbran318f5732018-11-20 16:23:42 +00002301 if (target_vm == NULL) {
2302 return -1;
2303 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002304
Andrew Walbran318f5732018-11-20 16:23:42 +00002305 if (target_vcpu_idx >= target_vm->vcpu_count) {
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00002306 /* The requested vCPU must exist. */
Andrew Walbran318f5732018-11-20 16:23:42 +00002307 return -1;
2308 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002309
Andrew Walbran318f5732018-11-20 16:23:42 +00002310 if (!is_injection_allowed(target_vm_id, current)) {
2311 return -1;
2312 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00002313
Andrew Walbrane1310df2019-04-29 17:28:28 +01002314 target_vcpu = vm_get_vcpu(target_vm, target_vcpu_idx);
Andrew Walbran318f5732018-11-20 16:23:42 +00002315
Manish Pandey35e452f2021-02-18 21:36:34 +00002316 dlog_verbose(
2317 "Injecting interrupt %u for VM %#x vCPU %u from VM %#x vCPU "
2318 "%u\n",
2319 intid, target_vm_id, target_vcpu_idx, current->vm->id,
2320 vcpu_index(current));
Andrew Walbranfc9d4382019-05-10 18:07:21 +01002321 return internal_interrupt_inject(target_vcpu, intid, current, next);
Andrew Walbran318f5732018-11-20 16:23:42 +00002322}
Andrew Scull6386f252018-12-06 13:29:10 +00002323
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002324/** Returns the version of the implemented FF-A specification. */
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002325struct ffa_value api_ffa_version(struct vcpu *current,
2326 uint32_t requested_version)
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002327{
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002328 struct vm_locked current_vm_locked;
2329
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002330 /*
2331 * Ensure that both major and minor revision representation occupies at
2332 * most 15 bits.
2333 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002334 static_assert(0x8000 > FFA_VERSION_MAJOR,
Andrew Walbran9fd29072020-04-22 12:12:14 +01002335 "Major revision representation takes more than 15 bits.");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002336 static_assert(0x10000 > FFA_VERSION_MINOR,
Andrew Walbran9fd29072020-04-22 12:12:14 +01002337 "Minor revision representation takes more than 16 bits.");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002338 if (requested_version & FFA_VERSION_RESERVED_BIT) {
Andrew Walbran9fd29072020-04-22 12:12:14 +01002339 /* Invalid encoding, return an error. */
J-Alves13318e32021-02-22 17:21:00 +00002340 return (struct ffa_value){.func = (uint32_t)FFA_NOT_SUPPORTED};
Andrew Walbran9fd29072020-04-22 12:12:14 +01002341 }
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002342
Daniel Boulbybaeaf2e2021-12-09 11:42:36 +00002343 current_vm_locked = vm_lock(current->vm);
2344 current_vm_locked.vm->ffa_version = requested_version;
2345 vm_unlock(&current_vm_locked);
2346
Daniel Boulby6e32c612021-02-17 15:09:41 +00002347 return ((struct ffa_value){.func = FFA_VERSION_COMPILED});
Jose Marinhofc0b2b62019-06-06 11:18:45 +01002348}
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01002349
2350int64_t api_debug_log(char c, struct vcpu *current)
2351{
Andrew Sculld54e1be2019-08-20 11:09:42 +01002352 bool flush;
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01002353 struct vm *vm = current->vm;
2354 struct vm_locked vm_locked = vm_lock(vm);
2355
Andrew Sculld54e1be2019-08-20 11:09:42 +01002356 if (c == '\n' || c == '\0') {
2357 flush = true;
2358 } else {
2359 vm->log_buffer[vm->log_buffer_length++] = c;
2360 flush = (vm->log_buffer_length == sizeof(vm->log_buffer));
2361 }
2362
2363 if (flush) {
Andrew Walbran7f904bf2019-07-12 16:38:38 +01002364 dlog_flush_vm_buffer(vm->id, vm->log_buffer,
2365 vm->log_buffer_length);
2366 vm->log_buffer_length = 0;
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01002367 }
2368
2369 vm_unlock(&vm_locked);
2370
2371 return 0;
2372}
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002373
2374/**
J-Alves6f72ca82021-11-01 12:34:58 +00002375 * Helper for success return of FFA_FEATURES, for when it is used to query
2376 * an interrupt ID.
2377 */
2378struct ffa_value api_ffa_feature_success(uint32_t arg2)
2379{
2380 return (struct ffa_value){
2381 .func = FFA_SUCCESS_32, .arg1 = 0U, .arg2 = arg2};
2382}
2383
2384/**
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002385 * Discovery function returning information about the implementation of optional
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002386 * FF-A interfaces.
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002387 */
Karl Meakin34b8ae92023-01-13 13:33:07 +00002388struct ffa_value api_ffa_features(uint32_t feature_function_id,
2389 uint32_t input_property, uint32_t ffa_version)
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002390{
J-Alves6f72ca82021-11-01 12:34:58 +00002391 /*
2392 * According to table 13.8 of FF-A v1.1 Beta 0 spec, bits [30:8] MBZ
2393 * if using a feature ID.
2394 */
2395 if ((feature_function_id & FFA_FEATURES_FUNC_ID_MASK) == 0U &&
J-Alvesff676c12022-05-13 17:25:33 +01002396 (feature_function_id & ~FFA_FEATURES_FEATURE_ID_MASK) != 0U) {
J-Alves6f72ca82021-11-01 12:34:58 +00002397 return ffa_error(FFA_NOT_SUPPORTED);
2398 }
2399
Karl Meakin34b8ae92023-01-13 13:33:07 +00002400 if (feature_function_id != FFA_MEM_RETRIEVE_REQ_32 &&
2401 input_property != 0U) {
2402 dlog_verbose(
2403 "input_property must be zero.\ninput_property = %u.\n",
2404 input_property);
2405 return ffa_error(FFA_INVALID_PARAMETERS);
2406 }
2407
J-Alves6f72ca82021-11-01 12:34:58 +00002408 switch (feature_function_id) {
2409 /* Check support of the given Function ID. */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002410 case FFA_ERROR_32:
2411 case FFA_SUCCESS_32:
2412 case FFA_INTERRUPT_32:
2413 case FFA_VERSION_32:
2414 case FFA_FEATURES_32:
2415 case FFA_RX_RELEASE_32:
2416 case FFA_RXTX_MAP_64:
Daniel Boulby9e420ca2021-07-07 15:03:49 +01002417 case FFA_RXTX_UNMAP_32:
Fuad Tabbae4efcc32020-07-16 15:37:27 +01002418 case FFA_PARTITION_INFO_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002419 case FFA_ID_GET_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002420 case FFA_MSG_WAIT_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002421 case FFA_RUN_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002422 case FFA_MEM_DONATE_32:
2423 case FFA_MEM_LEND_32:
2424 case FFA_MEM_SHARE_32:
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002425 case FFA_MEM_RETRIEVE_RESP_32:
2426 case FFA_MEM_RELINQUISH_32:
2427 case FFA_MEM_RECLAIM_32:
J-Alvesff676c12022-05-13 17:25:33 +01002428 case FFA_MEM_FRAG_RX_32:
2429 case FFA_MEM_FRAG_TX_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002430 case FFA_MSG_SEND_DIRECT_RESP_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002431 case FFA_MSG_SEND_DIRECT_RESP_32:
J-Alvesbc3de8b2020-12-07 14:32:04 +00002432 case FFA_MSG_SEND_DIRECT_REQ_64:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002433 case FFA_MSG_SEND_DIRECT_REQ_32:
J-Alves3829fc02021-03-18 12:49:18 +00002434#if (MAKE_FFA_VERSION(1, 1) <= FFA_VERSION_COMPILED)
Daniel Boulbyb2fb80e2021-02-03 15:09:23 +00002435 /* FF-A v1.1 features. */
2436 case FFA_SPM_ID_GET_32:
J-Alves6f72ca82021-11-01 12:34:58 +00002437 case FFA_NOTIFICATION_BITMAP_CREATE_32:
2438 case FFA_NOTIFICATION_BITMAP_DESTROY_32:
2439 case FFA_NOTIFICATION_BIND_32:
2440 case FFA_NOTIFICATION_UNBIND_32:
2441 case FFA_NOTIFICATION_SET_32:
2442 case FFA_NOTIFICATION_GET_32:
2443 case FFA_NOTIFICATION_INFO_GET_64:
Raghu Krishnamurthy6764b072021-10-18 12:54:24 -07002444 case FFA_MEM_PERM_GET_32:
2445 case FFA_MEM_PERM_SET_32:
2446 case FFA_MEM_PERM_GET_64:
2447 case FFA_MEM_PERM_SET_64:
Federico Recanati25053ee2022-03-14 15:01:53 +01002448 case FFA_MSG_SEND2_32:
Raghu Krishnamurthy7592bcb2022-12-25 13:09:00 -08002449 case FFA_PARTITION_INFO_GET_REGS_64:
J-Alves3829fc02021-03-18 12:49:18 +00002450#endif
2451 return (struct ffa_value){.func = FFA_SUCCESS_32};
Karl Meakin34b8ae92023-01-13 13:33:07 +00002452 case FFA_MEM_RETRIEVE_REQ_32:
2453 if ((input_property & FFA_FEATURES_MEM_RETRIEVE_REQ_MBZ_MASK) !=
2454 0U) {
2455 dlog_verbose(
2456 "Bits[31:2] and Bit[0] of input_property must "
2457 "be zero.\ninput_property = %u.\n",
2458 input_property);
2459 return ffa_error(FFA_INVALID_PARAMETERS);
2460 }
2461
2462 if (ffa_version >= MAKE_FFA_VERSION(1, 1)) {
2463 if ((input_property &
2464 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT) == 0U) {
2465 dlog_verbose("NS bit support must be 1.\n");
2466 return ffa_error(FFA_INVALID_PARAMETERS);
2467 }
2468 }
2469
2470 return api_ffa_feature_success(
2471 FFA_FEATURES_MEM_RETRIEVE_REQ_BUFFER_SUPPORT |
2472 (input_property &
2473 FFA_FEATURES_MEM_RETRIEVE_REQ_NS_SUPPORT) |
2474 FFA_FEATURES_MEM_RETRIEVE_REQ_HYPERVISOR_SUPPORT);
J-Alves6f72ca82021-11-01 12:34:58 +00002475
2476#if (MAKE_FFA_VERSION(1, 1) <= FFA_VERSION_COMPILED)
2477 /* Check support of a feature provided respective feature ID. */
2478 case FFA_FEATURE_NPI:
2479 return api_ffa_feature_success(HF_NOTIFICATION_PENDING_INTID);
2480 case FFA_FEATURE_SRI:
2481 return api_ffa_feature_success(HF_SCHEDULE_RECEIVER_INTID);
2482#endif
2483 /* Platform specific feature support. */
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002484 default:
J-Alves6f72ca82021-11-01 12:34:58 +00002485 return arch_ffa_features(feature_function_id);
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01002486 }
2487}
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002488
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002489/**
J-Alves645eabe2021-02-22 16:08:27 +00002490 * FF-A specification states that x2/w2 Must Be Zero for direct messaging
2491 * interfaces.
2492 */
2493static inline bool api_ffa_dir_msg_is_arg2_zero(struct ffa_value args)
2494{
2495 return args.arg2 == 0U;
2496}
2497
2498/**
J-Alves76d99af2021-03-10 17:42:11 +00002499 * Limits size of arguments in ffa_value structure to 32-bit.
2500 */
2501static struct ffa_value api_ffa_value_copy32(struct ffa_value args)
2502{
2503 return (struct ffa_value){
2504 .func = (uint32_t)args.func,
2505 .arg1 = (uint32_t)args.arg1,
2506 .arg2 = (uint32_t)0,
2507 .arg3 = (uint32_t)args.arg3,
2508 .arg4 = (uint32_t)args.arg4,
2509 .arg5 = (uint32_t)args.arg5,
2510 .arg6 = (uint32_t)args.arg6,
2511 .arg7 = (uint32_t)args.arg7,
2512 };
2513}
2514
2515/**
2516 * Helper to copy direct message payload, depending on SMC used and expected
2517 * registers size.
2518 */
2519static struct ffa_value api_ffa_dir_msg_value(struct ffa_value args)
2520{
2521 if (args.func == FFA_MSG_SEND_DIRECT_REQ_32 ||
2522 args.func == FFA_MSG_SEND_DIRECT_RESP_32) {
2523 return api_ffa_value_copy32(args);
2524 }
2525
2526 return (struct ffa_value){
2527 .func = args.func,
2528 .arg1 = args.arg1,
2529 .arg2 = 0,
2530 .arg3 = args.arg3,
2531 .arg4 = args.arg4,
2532 .arg5 = args.arg5,
2533 .arg6 = args.arg6,
2534 .arg7 = args.arg7,
2535 };
2536}
2537
2538/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002539 * Send an FF-A direct message request.
2540 */
2541struct ffa_value api_ffa_msg_send_direct_req(ffa_vm_id_t sender_vm_id,
2542 ffa_vm_id_t receiver_vm_id,
2543 struct ffa_value args,
2544 struct vcpu *current,
2545 struct vcpu **next)
2546{
J-Alves17228f72021-04-20 17:13:19 +01002547 struct ffa_value ret;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002548 struct vm *receiver_vm;
J-Alves6e2abc62021-12-02 14:58:56 +00002549 struct vm_locked receiver_locked;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002550 struct vcpu *receiver_vcpu;
2551 struct two_vcpu_locked vcpus_locked;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002552 enum vcpu_state next_state = VCPU_STATE_BLOCKED;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002553
J-Alves645eabe2021-02-22 16:08:27 +00002554 if (!api_ffa_dir_msg_is_arg2_zero(args)) {
2555 return ffa_error(FFA_INVALID_PARAMETERS);
2556 }
2557
Olivier Deprez55a189e2021-06-09 15:45:27 +02002558 if (!plat_ffa_is_direct_request_valid(current, sender_vm_id,
2559 receiver_vm_id)) {
J-Alvese0caac32022-12-19 14:37:08 +00002560 dlog_verbose("Invalid direct message request.\n");
J-Alvesaa336102021-03-01 13:02:45 +00002561 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002562 }
2563
Olivier Deprez55a189e2021-06-09 15:45:27 +02002564 if (plat_ffa_direct_request_forward(receiver_vm_id, args, &ret)) {
J-Alves17228f72021-04-20 17:13:19 +01002565 return ret;
2566 }
2567
2568 ret = (struct ffa_value){.func = FFA_INTERRUPT_32};
2569
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002570 receiver_vm = vm_find(receiver_vm_id);
2571 if (receiver_vm == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002572 dlog_verbose("Invalid Receiver!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002573 return ffa_error(FFA_INVALID_PARAMETERS);
2574 }
2575
2576 /*
J-Alves439ac972021-11-18 17:32:03 +00002577 * Check if sender supports sending direct message req, and if
2578 * receiver supports receipt of direct message requests.
2579 */
2580 if (!plat_ffa_is_direct_request_supported(current->vm, receiver_vm)) {
2581 return ffa_error(FFA_DENIED);
2582 }
2583
2584 /*
Olivier Deprezc13a8692022-04-08 17:47:14 +02002585 * Per FF-A EAC spec section 4.4.1 the firmware framework supports
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002586 * UP (migratable) or MP partitions with a number of vCPUs matching the
2587 * number of PEs in the system. It further states that MP partitions
2588 * accepting direct request messages cannot migrate.
2589 */
J-Alvesad6a0432021-04-09 16:06:21 +01002590 receiver_vcpu = api_ffa_get_vm_vcpu(receiver_vm, current);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002591 if (receiver_vcpu == NULL) {
J-Alves88a13542021-12-14 15:39:52 +00002592 dlog_verbose("Invalid vCPU!\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002593 return ffa_error(FFA_INVALID_PARAMETERS);
2594 }
2595
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002596 if (!plat_ffa_check_runtime_state_transition(
2597 current, sender_vm_id, HF_INVALID_VM_ID, receiver_vcpu,
2598 args.func, &next_state)) {
2599 return ffa_error(FFA_DENIED);
2600 }
2601
J-Alves6e2abc62021-12-02 14:58:56 +00002602 receiver_locked = vm_lock(receiver_vm);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002603 vcpus_locked = vcpu_lock_both(receiver_vcpu, current);
2604
2605 /*
2606 * If destination vCPU is executing or already received an
2607 * FFA_MSG_SEND_DIRECT_REQ then return to caller hinting recipient is
2608 * busy. There is a brief period of time where the vCPU state has
2609 * changed but regs_available is still false thus consider this case as
2610 * the vCPU not yet ready to receive a direct message request.
2611 */
2612 if (is_ffa_direct_msg_request_ongoing(vcpus_locked.vcpu1) ||
2613 receiver_vcpu->state == VCPU_STATE_RUNNING ||
2614 !receiver_vcpu->regs_available) {
J-Alves88a13542021-12-14 15:39:52 +00002615 dlog_verbose("Receiver is busy with another request.\n");
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002616 ret = ffa_error(FFA_BUSY);
2617 goto out;
2618 }
2619
2620 if (atomic_load_explicit(&receiver_vcpu->vm->aborting,
2621 memory_order_relaxed)) {
2622 if (receiver_vcpu->state != VCPU_STATE_ABORTED) {
Olivier Deprezf92e5d42020-11-13 16:00:54 +01002623 dlog_notice("Aborting VM %#x vCPU %u\n",
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002624 receiver_vcpu->vm->id,
2625 vcpu_index(receiver_vcpu));
2626 receiver_vcpu->state = VCPU_STATE_ABORTED;
2627 }
2628
2629 ret = ffa_error(FFA_ABORTED);
2630 goto out;
2631 }
2632
2633 switch (receiver_vcpu->state) {
2634 case VCPU_STATE_OFF:
2635 case VCPU_STATE_RUNNING:
2636 case VCPU_STATE_ABORTED:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002637 case VCPU_STATE_BLOCKED_INTERRUPT:
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05002638 case VCPU_STATE_BLOCKED:
2639 case VCPU_STATE_PREEMPTED:
J-Alves88a13542021-12-14 15:39:52 +00002640 dlog_verbose("Receiver's vCPU can't receive request (%u)!\n",
2641 vcpu_index(receiver_vcpu));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002642 ret = ffa_error(FFA_BUSY);
2643 goto out;
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05002644 case VCPU_STATE_WAITING:
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002645 /*
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05002646 * We expect target vCPU to be in WAITING state after either
2647 * having called ffa_msg_wait or sent a direct message response.
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002648 */
2649 break;
2650 }
2651
2652 /* Inject timer interrupt if any pending */
2653 if (arch_timer_pending(&receiver_vcpu->regs)) {
Manish Pandeya5f39fb2020-09-11 09:47:11 +01002654 api_interrupt_inject_locked(vcpus_locked.vcpu1,
2655 HF_VIRTUAL_TIMER_INTID, current,
2656 NULL);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002657
2658 arch_timer_mask(&receiver_vcpu->regs);
2659 }
2660
2661 /* The receiver vCPU runs upon direct message invocation */
2662 receiver_vcpu->cpu = current->cpu;
2663 receiver_vcpu->state = VCPU_STATE_RUNNING;
2664 receiver_vcpu->regs_available = false;
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02002665 receiver_vcpu->direct_request_origin_vm_id = sender_vm_id;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002666
J-Alves76d99af2021-03-10 17:42:11 +00002667 arch_regs_set_retval(&receiver_vcpu->regs, api_ffa_dir_msg_value(args));
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002668
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002669 assert(next_state == VCPU_STATE_BLOCKED);
Madhukar Pappireddyb11e0d12021-08-02 19:44:35 -05002670 current->state = VCPU_STATE_BLOCKED;
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002671
Madhukar Pappireddy49fe6702022-06-21 17:52:23 -05002672 plat_ffa_wind_call_chain_ffa_direct_req(vcpus_locked.vcpu2,
2673 vcpus_locked.vcpu1);
2674
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002675 /* Switch to receiver vCPU targeted to by direct msg request */
2676 *next = receiver_vcpu;
2677
J-Alves6e2abc62021-12-02 14:58:56 +00002678 if (!receiver_locked.vm->el0_partition) {
2679 /*
2680 * If the scheduler in the system is giving CPU cycles to the
2681 * receiver, due to pending notifications, inject the NPI
2682 * interrupt. Following call assumes that '*next' has been set
2683 * to receiver_vcpu.
2684 */
2685 plat_ffa_inject_notification_pending_interrupt(
2686 vcpus_locked.vcpu1.vcpu == receiver_vcpu
2687 ? vcpus_locked.vcpu1
2688 : vcpus_locked.vcpu2,
2689 current, receiver_locked);
2690 }
2691
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002692 /*
2693 * Since this flow will lead to a VM switch, the return value will not
2694 * be applied to current vCPU.
2695 */
2696
2697out:
2698 sl_unlock(&receiver_vcpu->lock);
2699 sl_unlock(&current->lock);
J-Alves6e2abc62021-12-02 14:58:56 +00002700 vm_unlock(&receiver_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002701
2702 return ret;
2703}
2704
2705/**
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05002706 * Resume the target vCPU after the current vCPU sent a direct response.
2707 * Current vCPU moves to waiting state.
2708 */
2709void api_ffa_resume_direct_resp_target(struct vcpu *current, struct vcpu **next,
2710 ffa_vm_id_t receiver_vm_id,
2711 struct ffa_value to_ret,
2712 bool is_nwd_call_chain)
2713{
2714 if (!vm_id_is_current_world(receiver_vm_id)) {
2715 *next = api_switch_to_other_world(current, to_ret,
2716 VCPU_STATE_WAITING);
2717
2718 /* End of NWd scheduled call chain. */
2719 assert(!is_nwd_call_chain ||
2720 (current->call_chain.prev_node == NULL));
2721 } else if (receiver_vm_id == HF_PRIMARY_VM_ID) {
2722 *next = api_switch_to_primary(current, to_ret,
2723 VCPU_STATE_WAITING);
2724
2725 /* Removing a node from NWd scheduled call chain. */
2726 if (is_nwd_call_chain) {
2727 vcpu_call_chain_remove_node(current, *next);
2728 }
2729 } else if (vm_id_is_current_world(receiver_vm_id)) {
2730 /*
2731 * It is expected the receiver_vm_id to be from an SP, otherwise
2732 * 'plat_ffa_is_direct_response_valid' should have
2733 * made function return error before getting to this point.
2734 */
2735 *next = api_switch_to_vm(current, to_ret, VCPU_STATE_WAITING,
2736 receiver_vm_id);
2737 } else {
2738 panic("Invalid direct message response invocation");
2739 }
2740}
2741
2742/**
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002743 * Send an FF-A direct message response.
2744 */
2745struct ffa_value api_ffa_msg_send_direct_resp(ffa_vm_id_t sender_vm_id,
2746 ffa_vm_id_t receiver_vm_id,
2747 struct ffa_value args,
2748 struct vcpu *current,
2749 struct vcpu **next)
2750{
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02002751 struct vcpu_locked current_locked;
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002752 enum vcpu_state next_state = VCPU_STATE_WAITING;
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05002753 struct ffa_value signal_interrupt =
2754 (struct ffa_value){.func = FFA_INTERRUPT_32};
J-Alves645eabe2021-02-22 16:08:27 +00002755
2756 if (!api_ffa_dir_msg_is_arg2_zero(args)) {
2757 return ffa_error(FFA_INVALID_PARAMETERS);
2758 }
2759
J-Alves76d99af2021-03-10 17:42:11 +00002760 struct ffa_value to_ret = api_ffa_dir_msg_value(args);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002761
Olivier Deprez55a189e2021-06-09 15:45:27 +02002762 if (!plat_ffa_is_direct_response_valid(current, sender_vm_id,
2763 receiver_vm_id)) {
J-Alvese0caac32022-12-19 14:37:08 +00002764 dlog_verbose("Invalid direct response call.\n");
J-Alvesaa336102021-03-01 13:02:45 +00002765 return ffa_error(FFA_INVALID_PARAMETERS);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002766 }
2767
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002768 if (!plat_ffa_check_runtime_state_transition(current, sender_vm_id,
2769 receiver_vm_id, NULL,
2770 args.func, &next_state)) {
2771 return ffa_error(FFA_DENIED);
2772 }
2773
Madhukar Pappireddy5fd32482022-01-07 14:53:26 -06002774 if (plat_ffa_is_direct_response_interrupted(current)) {
2775 return ffa_error(FFA_INTERRUPTED);
2776 }
2777
Madhukar Pappireddyc857ac22022-06-21 17:37:53 -05002778 assert(next_state == VCPU_STATE_WAITING);
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02002779 current_locked = vcpu_lock(current);
Madhukar Pappireddy469fa712022-06-21 18:53:33 -05002780
2781 /*
2782 * Ensure the terminating FFA_MSG_SEND_DIRECT_REQ had a
2783 * defined originator.
2784 */
2785 if (!is_ffa_direct_msg_request_ongoing(current_locked)) {
2786 /*
2787 * Sending direct response but direct request origin
2788 * vCPU is not set.
2789 */
2790 vcpu_unlock(&current_locked);
2791 return ffa_error(FFA_DENIED);
2792 }
2793
Manish Pandeya5f39fb2020-09-11 09:47:11 +01002794 if (api_ffa_is_managed_exit_ongoing(current_locked)) {
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002795 /*
Madhukar Pappireddy469fa712022-06-21 18:53:33 -05002796 * Per FF-A v1.1 EAC0 section 8.3.1.2.1 rule 6, SPMC can signal
Madhukar Pappireddyed4ab942021-08-03 14:22:53 -05002797 * a secure interrupt to a SP that is performing managed exit.
2798 * We have taken a implementation defined choice to not allow
2799 * Managed exit while a SP is processing a secure interrupt.
2800 */
2801 CHECK(!current->processing_secure_interrupt);
2802
Madhukar Pappireddydd6fdfb2021-12-14 12:30:36 -06002803 plat_interrupts_set_priority_mask(current->priority_mask);
Madhukar Pappireddya1019112022-06-21 18:57:44 -05002804 /*
2805 * A SP may be signaled a managed exit but actually not trap
2806 * the virtual interrupt, probably because it has virtual
2807 * interrupts masked, and emit direct resp. In this case the
2808 * managed exit operation is considered completed and it would
2809 * also need to clear the pending managed exit flag for the SP
2810 * vCPU.
2811 */
Manish Pandeya5f39fb2020-09-11 09:47:11 +01002812 current->processing_managed_exit = false;
Madhukar Pappireddya1019112022-06-21 18:57:44 -05002813 struct interrupts *interrupts = &current->interrupts;
2814
2815 if (vcpu_is_virt_interrupt_pending(interrupts,
2816 HF_MANAGED_EXIT_INTID)) {
2817 api_interrupt_clear_decrement(current_locked,
2818 interrupts,
2819 HF_MANAGED_EXIT_INTID);
2820 }
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002821 }
2822
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05002823 if (plat_ffa_intercept_direct_response(current_locked, next, to_ret,
2824 &signal_interrupt)) {
2825 vcpu_unlock(&current_locked);
2826 return signal_interrupt;
2827 }
2828
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002829 /* Clear direct request origin for the caller. */
2830 current->direct_request_origin_vm_id = HF_INVALID_VM_ID;
2831
Olivier Deprez2ebae3a2020-06-11 16:34:30 +02002832 vcpu_unlock(&current_locked);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002833
Madhukar Pappireddy2f76e492022-09-06 15:21:59 -05002834 api_ffa_resume_direct_resp_target(current, next, receiver_vm_id, to_ret,
2835 false);
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002836
Madhukar Pappireddyc0fb87e2022-06-21 17:59:15 -05002837 plat_ffa_unwind_call_chain_ffa_direct_resp(current, *next);
2838
Olivier Deprezee9d6a92019-11-26 09:14:11 +00002839 return (struct ffa_value){.func = FFA_INTERRUPT_32};
2840}
2841
J-Alves84658fc2021-06-17 14:37:32 +01002842static bool api_memory_region_check_flags(
2843 struct ffa_memory_region *memory_region, uint32_t share_func)
2844{
2845 switch (share_func) {
2846 case FFA_MEM_SHARE_32:
2847 if ((memory_region->flags & FFA_MEMORY_REGION_FLAG_CLEAR) !=
2848 0U) {
2849 return false;
2850 }
2851 /* Intentional fall-through */
2852 case FFA_MEM_LEND_32:
2853 case FFA_MEM_DONATE_32: {
2854 /* Bits 31:2 Must Be Zero. */
2855 ffa_memory_receiver_flags_t to_mask =
2856 ~(FFA_MEMORY_REGION_FLAG_CLEAR |
2857 FFA_MEMORY_REGION_FLAG_TIME_SLICE);
2858
2859 if ((memory_region->flags & to_mask) != 0U) {
2860 return false;
2861 }
2862 break;
2863 }
2864 default:
2865 panic("Check for mem send calls only.\n");
2866 }
2867
2868 /* Last check reserved values are 0 */
2869 return true;
2870}
2871
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002872struct ffa_value api_ffa_mem_send(uint32_t share_func, uint32_t length,
2873 uint32_t fragment_length, ipaddr_t address,
Andrew Walbran1a86aa92020-05-15 17:22:28 +01002874 uint32_t page_count, struct vcpu *current)
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002875{
2876 struct vm *from = current->vm;
2877 struct vm *to;
2878 const void *from_msg;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002879 struct ffa_memory_region *memory_region;
2880 struct ffa_value ret;
J-Alves363f5722022-04-25 17:37:37 +01002881 bool targets_other_world = false;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002882
2883 if (ipa_addr(address) != 0 || page_count != 0) {
2884 /*
2885 * Hafnium only supports passing the descriptor in the TX
2886 * mailbox.
2887 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002888 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002889 }
2890
Andrew Walbranca808b12020-05-15 17:22:28 +01002891 if (fragment_length > length) {
2892 dlog_verbose(
2893 "Fragment length %d greater than total length %d.\n",
2894 fragment_length, length);
2895 return ffa_error(FFA_INVALID_PARAMETERS);
2896 }
2897 if (fragment_length < sizeof(struct ffa_memory_region) +
2898 sizeof(struct ffa_memory_access)) {
2899 dlog_verbose(
2900 "Initial fragment length %d smaller than header size "
2901 "%d.\n",
2902 fragment_length,
2903 sizeof(struct ffa_memory_region) +
2904 sizeof(struct ffa_memory_access));
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002905 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002906 }
2907
2908 /*
2909 * Check that the sender has configured its send buffer. If the TX
2910 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
2911 * be safely accessed after releasing the lock since the TX mailbox
2912 * address can only be configured once.
2913 */
2914 sl_lock(&from->lock);
2915 from_msg = from->mailbox.send;
2916 sl_unlock(&from->lock);
2917
2918 if (from_msg == NULL) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002919 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002920 }
2921
2922 /*
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002923 * Copy the memory region descriptor to a fresh page from the memory
2924 * pool. This prevents the sender from changing it underneath us, and
2925 * also lets us keep it around in the share state table if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002926 */
Andrew Walbran1a86aa92020-05-15 17:22:28 +01002927 if (fragment_length > HF_MAILBOX_SIZE ||
2928 fragment_length > MM_PPOOL_ENTRY_SIZE) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002929 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002930 }
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002931 memory_region = (struct ffa_memory_region *)mpool_alloc(&api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002932 if (memory_region == NULL) {
2933 dlog_verbose("Failed to allocate memory region copy.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002934 return ffa_error(FFA_NO_MEMORY);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002935 }
Andrew Walbran1a86aa92020-05-15 17:22:28 +01002936 memcpy_s(memory_region, MM_PPOOL_ENTRY_SIZE, from_msg, fragment_length);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002937
J-Alves84658fc2021-06-17 14:37:32 +01002938 if (!api_memory_region_check_flags(memory_region, share_func)) {
2939 dlog_verbose(
2940 "Memory region reserved arguments must be zero.\n");
2941 ret = ffa_error(FFA_INVALID_PARAMETERS);
2942 goto out;
2943 }
2944
J-Alves363f5722022-04-25 17:37:37 +01002945 if (memory_region->receiver_count == 0U) {
2946 dlog_verbose("Receiver count can't be 0.\n");
2947 ret = ffa_error(FFA_INVALID_PARAMETERS);
2948 goto out;
2949 }
2950
2951 if (share_func == FFA_MEM_DONATE_32 &&
2952 memory_region->receiver_count != 1U) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002953 dlog_verbose(
J-Alves363f5722022-04-25 17:37:37 +01002954 "FFA_MEM_DONATE only supports one recipient. "
2955 "Specified %u\n",
2956 memory_region->receiver_count);
2957 ret = ffa_error(FFA_INVALID_PARAMETERS);
2958 goto out;
2959 }
2960
2961 if (memory_region->receiver_count > MAX_MEM_SHARE_RECIPIENTS) {
2962 dlog_verbose(
2963 "Max number of recipients supported is %u "
2964 "specified %u\n",
2965 MAX_MEM_SHARE_RECIPIENTS,
Andrew Walbrana65a1322020-04-06 19:32:32 +01002966 memory_region->receiver_count);
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01002967 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002968 goto out;
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002969 }
2970
2971 /*
2972 * Ensure that the receiver VM exists and isn't the same as the sender.
J-Alves363f5722022-04-25 17:37:37 +01002973 * If there is a receiver from the other world, track it for later
2974 * forwarding if needed.
Andrew Walbrane908c4a2019-12-02 17:13:47 +00002975 */
J-Alves363f5722022-04-25 17:37:37 +01002976 for (uint32_t i = 0U; i < memory_region->receiver_count; i++) {
2977 ffa_vm_id_t receiver_id =
2978 memory_region->receivers[i]
2979 .receiver_permissions.receiver;
2980 to = vm_find(receiver_id);
2981
2982 if (vm_id_is_current_world(receiver_id) &&
2983 (to == NULL || to == from)) {
2984 dlog_verbose("%s: invalid receiver.\n", __func__);
2985 ret = ffa_error(FFA_INVALID_PARAMETERS);
2986 goto out;
2987 }
2988
2989 if (!plat_ffa_is_memory_send_valid(receiver_id, share_func)) {
2990 ret = ffa_error(FFA_DENIED);
2991 goto out;
2992 }
2993
2994 /* Capture if any of the receivers is from the other world. */
2995 if (!targets_other_world) {
2996 targets_other_world =
2997 !vm_id_is_current_world(receiver_id);
2998 }
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00002999 }
3000
J-Alves363f5722022-04-25 17:37:37 +01003001 if (targets_other_world) {
J-Alves66652252022-07-06 09:49:51 +01003002 ret = plat_ffa_other_world_mem_send(
3003 from, share_func, &memory_region, length,
3004 fragment_length, &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003005 } else {
3006 struct vm_locked from_locked = vm_lock(from);
3007
Andrew Walbran1a86aa92020-05-15 17:22:28 +01003008 ret = ffa_memory_send(from_locked, memory_region, length,
3009 fragment_length, share_func,
3010 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003011 /*
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003012 * ffa_memory_send takes ownership of the memory_region, so
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003013 * make sure we don't free it.
3014 */
3015 memory_region = NULL;
3016
3017 vm_unlock(&from_locked);
3018 }
3019
3020out:
3021 if (memory_region != NULL) {
3022 mpool_free(&api_page_pool, memory_region);
3023 }
3024
3025 return ret;
3026}
3027
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003028struct ffa_value api_ffa_mem_retrieve_req(uint32_t length,
3029 uint32_t fragment_length,
3030 ipaddr_t address, uint32_t page_count,
3031 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003032{
3033 struct vm *to = current->vm;
3034 struct vm_locked to_locked;
3035 const void *to_msg;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003036 struct ffa_memory_region *retrieve_request;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003037 uint32_t message_buffer_size;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003038 struct ffa_value ret;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003039
3040 if (ipa_addr(address) != 0 || page_count != 0) {
3041 /*
3042 * Hafnium only supports passing the descriptor in the TX
3043 * mailbox.
3044 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003045 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003046 }
3047
Andrew Walbrana65a1322020-04-06 19:32:32 +01003048 if (fragment_length != length) {
3049 dlog_verbose("Fragmentation not yet supported.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003050 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003051 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003052
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003053 retrieve_request =
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003054 (struct ffa_memory_region *)cpu_get_buffer(current->cpu);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003055 message_buffer_size = cpu_get_buffer_size(current->cpu);
3056 if (length > HF_MAILBOX_SIZE || length > message_buffer_size) {
3057 dlog_verbose("Retrieve request too long.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003058 return ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003059 }
3060
3061 to_locked = vm_lock(to);
3062 to_msg = to->mailbox.send;
3063
3064 if (to_msg == NULL) {
3065 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003066 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003067 goto out;
3068 }
3069
3070 /*
3071 * Copy the retrieve request descriptor to an internal buffer, so that
3072 * the caller can't change it underneath us.
3073 */
3074 memcpy_s(retrieve_request, message_buffer_size, to_msg, length);
3075
J-Alves122f1a12022-12-12 15:55:42 +00003076 if (vm_is_mailbox_busy(to_locked)) {
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003077 /*
3078 * Can't retrieve memory information if the mailbox is not
3079 * available.
3080 */
J-Alves59ed0042022-07-28 18:26:41 +01003081 dlog_verbose("%s: RX buffer not ready.\n", __func__);
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003082 ret = ffa_error(FFA_BUSY);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003083 goto out;
3084 }
3085
J-Alvesb5084cf2022-07-06 14:20:12 +01003086 if (plat_ffa_memory_handle_allocated_by_current_world(
3087 retrieve_request->handle)) {
3088 ret = ffa_memory_retrieve(to_locked, retrieve_request, length,
3089 &api_page_pool);
3090 } else {
3091 ret = plat_ffa_other_world_mem_retrieve(
3092 to_locked, retrieve_request, length, &api_page_pool);
3093 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003094out:
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003095 vm_unlock(&to_locked);
3096 return ret;
3097}
3098
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003099struct ffa_value api_ffa_mem_relinquish(struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003100{
3101 struct vm *from = current->vm;
3102 struct vm_locked from_locked;
3103 const void *from_msg;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003104 struct ffa_mem_relinquish *relinquish_request;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003105 uint32_t message_buffer_size;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003106 struct ffa_value ret;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003107 uint32_t length;
3108
3109 from_locked = vm_lock(from);
3110 from_msg = from->mailbox.send;
3111
3112 if (from_msg == NULL) {
3113 dlog_verbose("TX buffer not setup.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003114 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003115 goto out;
3116 }
3117
3118 /*
3119 * Calculate length from relinquish descriptor before copying. We will
3120 * check again later to make sure it hasn't changed.
3121 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003122 length = sizeof(struct ffa_mem_relinquish) +
3123 ((struct ffa_mem_relinquish *)from_msg)->endpoint_count *
3124 sizeof(ffa_vm_id_t);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003125 /*
3126 * Copy the relinquish descriptor to an internal buffer, so that the
3127 * caller can't change it underneath us.
3128 */
3129 relinquish_request =
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003130 (struct ffa_mem_relinquish *)cpu_get_buffer(current->cpu);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003131 message_buffer_size = cpu_get_buffer_size(current->cpu);
3132 if (length > HF_MAILBOX_SIZE || length > message_buffer_size) {
3133 dlog_verbose("Relinquish message too long.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003134 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003135 goto out;
3136 }
3137 memcpy_s(relinquish_request, message_buffer_size, from_msg, length);
3138
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003139 if (sizeof(struct ffa_mem_relinquish) +
3140 relinquish_request->endpoint_count * sizeof(ffa_vm_id_t) !=
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003141 length) {
3142 dlog_verbose(
3143 "Endpoint count changed while copying to internal "
3144 "buffer.\n");
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003145 ret = ffa_error(FFA_INVALID_PARAMETERS);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003146 goto out;
3147 }
3148
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003149 ret = ffa_memory_relinquish(from_locked, relinquish_request,
3150 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003151
3152out:
3153 vm_unlock(&from_locked);
3154 return ret;
3155}
3156
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003157struct ffa_value api_ffa_mem_reclaim(ffa_memory_handle_t handle,
3158 ffa_memory_region_flags_t flags,
3159 struct vcpu *current)
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003160{
3161 struct vm *to = current->vm;
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003162 struct ffa_value ret;
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003163
Olivier Deprez55a189e2021-06-09 15:45:27 +02003164 if (plat_ffa_memory_handle_allocated_by_current_world(handle)) {
Andrew Walbran290b0c92020-02-03 16:37:14 +00003165 struct vm_locked to_locked = vm_lock(to);
3166
Andrew Walbranca808b12020-05-15 17:22:28 +01003167 ret = ffa_memory_reclaim(to_locked, handle, flags,
Andrew Walbranb5ab43c2020-04-30 11:32:54 +01003168 &api_page_pool);
Andrew Walbran5de9c3d2020-02-10 13:35:29 +00003169
Andrew Walbran290b0c92020-02-03 16:37:14 +00003170 vm_unlock(&to_locked);
3171 } else {
J-Alvesfc19b372022-07-06 12:17:35 +01003172 ret = plat_ffa_other_world_mem_reclaim(to, handle, flags,
3173 &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01003174 }
3175
3176 return ret;
3177}
3178
3179struct ffa_value api_ffa_mem_frag_rx(ffa_memory_handle_t handle,
3180 uint32_t fragment_offset,
3181 ffa_vm_id_t sender_vm_id,
3182 struct vcpu *current)
3183{
3184 struct vm *to = current->vm;
3185 struct vm_locked to_locked;
3186 struct ffa_value ret;
3187
3188 /* Sender ID MBZ at virtual instance. */
J-Alves59ed0042022-07-28 18:26:41 +01003189 if (vm_id_is_current_world(to->id)) {
3190 if (sender_vm_id != 0) {
3191 dlog_verbose("%s: Invalid sender.\n", __func__);
3192 return ffa_error(FFA_INVALID_PARAMETERS);
3193 }
Andrew Walbranca808b12020-05-15 17:22:28 +01003194 }
3195
3196 to_locked = vm_lock(to);
3197
J-Alves122f1a12022-12-12 15:55:42 +00003198 if (vm_is_mailbox_busy(to_locked)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01003199 /*
3200 * Can't retrieve memory information if the mailbox is not
3201 * available.
3202 */
J-Alves59ed0042022-07-28 18:26:41 +01003203 dlog_verbose("%s: RX buffer not ready partition %x.\n",
3204 __func__, to_locked.vm->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01003205 ret = ffa_error(FFA_BUSY);
3206 goto out;
3207 }
3208
3209 ret = ffa_memory_retrieve_continue(to_locked, handle, fragment_offset,
J-Alves59ed0042022-07-28 18:26:41 +01003210 sender_vm_id, &api_page_pool);
Andrew Walbranca808b12020-05-15 17:22:28 +01003211out:
3212 vm_unlock(&to_locked);
3213 return ret;
3214}
3215
3216struct ffa_value api_ffa_mem_frag_tx(ffa_memory_handle_t handle,
3217 uint32_t fragment_length,
3218 ffa_vm_id_t sender_vm_id,
3219 struct vcpu *current)
3220{
3221 struct vm *from = current->vm;
3222 const void *from_msg;
3223 void *fragment_copy;
3224 struct ffa_value ret;
3225
3226 /* Sender ID MBZ at virtual instance. */
J-Alvesfdd29272022-07-19 13:16:31 +01003227 if (vm_id_is_current_world(from->id) && sender_vm_id != 0) {
3228 dlog_verbose("Invalid sender.");
Andrew Walbranca808b12020-05-15 17:22:28 +01003229 return ffa_error(FFA_INVALID_PARAMETERS);
3230 }
3231
3232 /*
3233 * Check that the sender has configured its send buffer. If the TX
3234 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
3235 * be safely accessed after releasing the lock since the TX mailbox
3236 * address can only be configured once.
3237 */
3238 sl_lock(&from->lock);
3239 from_msg = from->mailbox.send;
3240 sl_unlock(&from->lock);
3241
3242 if (from_msg == NULL) {
J-Alves59ed0042022-07-28 18:26:41 +01003243 dlog_verbose("Mailbox from %x is not set.\n", from->id);
Andrew Walbranca808b12020-05-15 17:22:28 +01003244 return ffa_error(FFA_INVALID_PARAMETERS);
3245 }
3246
3247 /*
3248 * Copy the fragment to a fresh page from the memory pool. This prevents
3249 * the sender from changing it underneath us, and also lets us keep it
3250 * around in the share state table if needed.
3251 */
3252 if (fragment_length > HF_MAILBOX_SIZE ||
3253 fragment_length > MM_PPOOL_ENTRY_SIZE) {
3254 dlog_verbose(
3255 "Fragment length %d larger than mailbox size %d.\n",
3256 fragment_length, HF_MAILBOX_SIZE);
3257 return ffa_error(FFA_INVALID_PARAMETERS);
3258 }
3259 if (fragment_length < sizeof(struct ffa_memory_region_constituent) ||
3260 fragment_length % sizeof(struct ffa_memory_region_constituent) !=
3261 0) {
3262 dlog_verbose("Invalid fragment length %d.\n", fragment_length);
3263 return ffa_error(FFA_INVALID_PARAMETERS);
3264 }
3265 fragment_copy = mpool_alloc(&api_page_pool);
3266 if (fragment_copy == NULL) {
3267 dlog_verbose("Failed to allocate fragment copy.\n");
3268 return ffa_error(FFA_NO_MEMORY);
3269 }
3270 memcpy_s(fragment_copy, MM_PPOOL_ENTRY_SIZE, from_msg, fragment_length);
3271
3272 /*
3273 * Hafnium doesn't support fragmentation of memory retrieve requests
3274 * (because it doesn't support caller-specified mappings, so a request
3275 * will never be larger than a single page), so this must be part of a
3276 * memory send (i.e. donate, lend or share) request.
3277 *
3278 * We can tell from the handle whether the memory transaction is for the
J-Alvesfdd29272022-07-19 13:16:31 +01003279 * other world or not.
Andrew Walbranca808b12020-05-15 17:22:28 +01003280 */
J-Alvesfdd29272022-07-19 13:16:31 +01003281 if (plat_ffa_memory_handle_allocated_by_current_world(handle)) {
Andrew Walbranca808b12020-05-15 17:22:28 +01003282 struct vm_locked from_locked = vm_lock(from);
3283
3284 ret = ffa_memory_send_continue(from_locked, fragment_copy,
3285 fragment_length, handle,
3286 &api_page_pool);
3287 /*
3288 * `ffa_memory_send_continue` takes ownership of the
3289 * fragment_copy, so we don't need to free it here.
3290 */
3291 vm_unlock(&from_locked);
3292 } else {
J-Alvesfdd29272022-07-19 13:16:31 +01003293 ret = plat_ffa_other_world_mem_send_continue(
3294 from, fragment_copy, fragment_length, handle,
3295 &api_page_pool);
Andrew Walbran290b0c92020-02-03 16:37:14 +00003296 }
Andrew Walbrane908c4a2019-12-02 17:13:47 +00003297
3298 return ret;
3299}
Max Shvetsov40108e72020-08-27 12:39:50 +01003300
Olivier Deprezd614d322021-06-18 15:21:00 +02003301/**
3302 * Register an entry point for a vCPU in warm boot cases.
3303 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1 FFA_SECONDARY_EP_REGISTER.
3304 */
Max Shvetsov40108e72020-08-27 12:39:50 +01003305struct ffa_value api_ffa_secondary_ep_register(ipaddr_t entry_point,
3306 struct vcpu *current)
3307{
3308 struct vm_locked vm_locked;
Olivier Deprezb2808332023-02-02 15:25:40 +01003309 struct vcpu_locked current_locked;
Max Shvetsov40108e72020-08-27 12:39:50 +01003310
Olivier Deprezd614d322021-06-18 15:21:00 +02003311 /*
3312 * Reject if interface is not supported at this FF-A instance
3313 * (DEN0077A FF-A v1.1 Beta0 Table 18.29) or the VM is UP.
3314 */
3315 if (!plat_ffa_is_secondary_ep_register_supported() ||
3316 current->vm->vcpu_count == 1) {
3317 return ffa_error(FFA_NOT_SUPPORTED);
3318 }
3319
3320 /*
3321 * No further check is made on the address validity
3322 * (FF-A v1.1 Beta0 Table 18.29) as the VM boundaries are not known
3323 * from the VM or vCPU structure.
3324 * DEN0077A FF-A v1.1 Beta0 section 18.3.2.1.1:
3325 * For each SP [...] the Framework assumes that the same entry point
3326 * address is used for initializing any execution context during a
3327 * secondary cold boot.
3328 * If this function is invoked multiple times, then the entry point
3329 * address specified in the last valid invocation must be used by the
3330 * callee.
3331 */
Olivier Deprezb2808332023-02-02 15:25:40 +01003332 current_locked = vcpu_lock(current);
3333 if (current->rt_model != RTM_SP_INIT) {
3334 dlog_error(
3335 "FFA_SECONDARY_EP_REGISTER can only be called while "
3336 "vCPU in run-time state for initialization.\n");
3337 vcpu_unlock(&current_locked);
3338 return ffa_error(FFA_DENIED);
Olivier Deprezd614d322021-06-18 15:21:00 +02003339 }
Olivier Deprezb2808332023-02-02 15:25:40 +01003340 vcpu_unlock(&current_locked);
Olivier Deprezd614d322021-06-18 15:21:00 +02003341
Olivier Deprezb2808332023-02-02 15:25:40 +01003342 vm_locked = vm_lock(current->vm);
Max Shvetsov40108e72020-08-27 12:39:50 +01003343 vm_locked.vm->secondary_ep = entry_point;
3344 vm_unlock(&vm_locked);
3345
Olivier Deprezb2808332023-02-02 15:25:40 +01003346 return (struct ffa_value){.func = FFA_SUCCESS_32};
Max Shvetsov40108e72020-08-27 12:39:50 +01003347}
J-Alvesa0f317d2021-06-09 13:31:59 +01003348
3349struct ffa_value api_ffa_notification_bitmap_create(ffa_vm_id_t vm_id,
3350 ffa_vcpu_count_t vcpu_count,
3351 struct vcpu *current)
3352{
3353 if (!plat_ffa_is_notifications_create_valid(current, vm_id)) {
3354 dlog_verbose("Bitmap create for NWd VM IDs only (%x).\n",
3355 vm_id);
3356 return ffa_error(FFA_NOT_SUPPORTED);
3357 }
3358
3359 return plat_ffa_notifications_bitmap_create(vm_id, vcpu_count);
3360}
3361
3362struct ffa_value api_ffa_notification_bitmap_destroy(ffa_vm_id_t vm_id,
3363 struct vcpu *current)
3364{
3365 /*
3366 * Validity of use of this interface is the same as for bitmap create.
3367 */
3368 if (!plat_ffa_is_notifications_create_valid(current, vm_id)) {
3369 dlog_verbose("Bitmap destroy for NWd VM IDs only (%x).\n",
3370 vm_id);
3371 return ffa_error(FFA_NOT_SUPPORTED);
3372 }
3373
3374 return plat_ffa_notifications_bitmap_destroy(vm_id);
3375}
J-Alvesc003a7a2021-03-18 13:06:53 +00003376
3377struct ffa_value api_ffa_notification_update_bindings(
3378 ffa_vm_id_t sender_vm_id, ffa_vm_id_t receiver_vm_id, uint32_t flags,
3379 ffa_notifications_bitmap_t notifications, bool is_bind,
3380 struct vcpu *current)
3381{
3382 struct ffa_value ret = {.func = FFA_SUCCESS_32};
3383 struct vm_locked receiver_locked;
3384 const bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
3385 const ffa_vm_id_t id_to_update =
3386 is_bind ? sender_vm_id : HF_INVALID_VM_ID;
3387 const ffa_vm_id_t id_to_validate =
3388 is_bind ? HF_INVALID_VM_ID : sender_vm_id;
J-Alves1daeaea2022-09-06 17:41:24 +01003389 const uint32_t flags_mbz =
3390 is_bind ? ~FFA_NOTIFICATIONS_FLAG_PER_VCPU : ~0U;
3391
3392 if ((flags_mbz & flags) != 0U) {
3393 return ffa_error(FFA_INVALID_PARAMETERS);
3394 }
J-Alvesc003a7a2021-03-18 13:06:53 +00003395
3396 if (!plat_ffa_is_notifications_bind_valid(current, sender_vm_id,
3397 receiver_vm_id)) {
3398 dlog_verbose("Invalid use of notifications bind interface.\n");
3399 return ffa_error(FFA_INVALID_PARAMETERS);
3400 }
3401
J-Alvesb15e9402021-09-08 11:44:42 +01003402 if (plat_ffa_notifications_update_bindings_forward(
3403 receiver_vm_id, sender_vm_id, flags, notifications, is_bind,
3404 &ret)) {
J-Alvesb15e9402021-09-08 11:44:42 +01003405 return ret;
3406 }
3407
J-Alvesc003a7a2021-03-18 13:06:53 +00003408 if (notifications == 0U) {
3409 dlog_verbose("No notifications have been specified.\n");
3410 return ffa_error(FFA_INVALID_PARAMETERS);
3411 }
3412
3413 /**
3414 * This check assumes receiver is the current VM, and has been enforced
3415 * by 'plat_ffa_is_notifications_bind_valid'.
3416 */
3417 receiver_locked = plat_ffa_vm_find_locked(receiver_vm_id);
3418
3419 if (receiver_locked.vm == NULL) {
3420 dlog_verbose("Receiver doesn't exist!\n");
3421 return ffa_error(FFA_DENIED);
3422 }
3423
J-Alves09ff9d82021-11-02 11:55:20 +00003424 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesc003a7a2021-03-18 13:06:53 +00003425 dlog_verbose("Notifications are not enabled.\n");
3426 ret = ffa_error(FFA_NOT_SUPPORTED);
3427 goto out;
3428 }
3429
3430 if (is_bind && vm_id_is_current_world(sender_vm_id) &&
3431 vm_find(sender_vm_id) == NULL) {
3432 dlog_verbose("Sender VM does not exist!\n");
3433 ret = ffa_error(FFA_INVALID_PARAMETERS);
3434 goto out;
3435 }
3436
3437 /*
3438 * Can't bind/unbind notifications if at least one is bound to a
3439 * different sender.
3440 */
3441 if (!vm_notifications_validate_bound_sender(
3442 receiver_locked, plat_ffa_is_vm_id(sender_vm_id),
3443 id_to_validate, notifications)) {
3444 dlog_verbose("Notifications are bound to other sender.\n");
3445 ret = ffa_error(FFA_DENIED);
3446 goto out;
3447 }
3448
3449 /**
3450 * Check if there is a pending notification within those specified in
3451 * the bitmap.
3452 */
3453 if (vm_are_notifications_pending(receiver_locked,
3454 plat_ffa_is_vm_id(sender_vm_id),
3455 notifications)) {
3456 dlog_verbose("Notifications within '%x' pending.\n",
3457 notifications);
3458 ret = ffa_error(FFA_DENIED);
3459 goto out;
3460 }
3461
3462 vm_notifications_update_bindings(
3463 receiver_locked, plat_ffa_is_vm_id(sender_vm_id), id_to_update,
3464 notifications, is_per_vcpu && is_bind);
3465
3466out:
3467 vm_unlock(&receiver_locked);
3468 return ret;
3469}
J-Alvesaa79c012021-07-09 14:29:45 +01003470
3471struct ffa_value api_ffa_notification_set(
3472 ffa_vm_id_t sender_vm_id, ffa_vm_id_t receiver_vm_id, uint32_t flags,
3473 ffa_notifications_bitmap_t notifications, struct vcpu *current)
3474{
3475 struct ffa_value ret;
3476 struct vm_locked receiver_locked;
3477
3478 /*
3479 * Check if is per-vCPU or global, and extracting vCPU ID according
3480 * to table 17.19 of the FF-A v1.1 Beta 0 spec.
3481 */
3482 bool is_per_vcpu = (flags & FFA_NOTIFICATION_FLAG_PER_VCPU) != 0U;
3483 ffa_vcpu_index_t vcpu_id = (uint16_t)(flags >> 16);
3484
J-Alvesaa79c012021-07-09 14:29:45 +01003485 if (!plat_ffa_is_notification_set_valid(current, sender_vm_id,
3486 receiver_vm_id)) {
3487 dlog_verbose("Invalid use of notifications set interface.\n");
3488 return ffa_error(FFA_INVALID_PARAMETERS);
3489 }
3490
3491 if (notifications == 0U) {
3492 dlog_verbose("No notifications have been specified.\n");
3493 return ffa_error(FFA_INVALID_PARAMETERS);
3494 }
3495
J-Alvesde7bd2f2021-09-09 19:54:35 +01003496 if (plat_ffa_notification_set_forward(sender_vm_id, receiver_vm_id,
3497 flags, notifications, &ret)) {
3498 return ret;
3499 }
3500
J-Alvesaa79c012021-07-09 14:29:45 +01003501 /*
3502 * This check assumes receiver is the current VM, and has been enforced
3503 * by 'plat_ffa_is_notification_set_valid'.
3504 */
3505 receiver_locked = plat_ffa_vm_find_locked(receiver_vm_id);
3506
3507 if (receiver_locked.vm == NULL) {
3508 dlog_verbose("Receiver ID is not valid.\n");
3509 return ffa_error(FFA_INVALID_PARAMETERS);
3510 }
3511
J-Alves09ff9d82021-11-02 11:55:20 +00003512 if (!vm_locked_are_notifications_enabled(receiver_locked)) {
J-Alvesaa79c012021-07-09 14:29:45 +01003513 dlog_verbose("Receiver's notifications not enabled.\n");
3514 ret = ffa_error(FFA_DENIED);
3515 goto out;
3516 }
3517
3518 /*
3519 * If notifications are not bound to the sender, they wouldn't be
3520 * enabled either for the receiver.
3521 */
3522 if (!vm_notifications_validate_binding(
3523 receiver_locked, plat_ffa_is_vm_id(sender_vm_id),
3524 sender_vm_id, notifications, is_per_vcpu)) {
3525 dlog_verbose("Notifications bindings not valid.\n");
3526 ret = ffa_error(FFA_DENIED);
3527 goto out;
3528 }
3529
3530 if (is_per_vcpu && vcpu_id >= receiver_locked.vm->vcpu_count) {
3531 dlog_verbose("Invalid VCPU ID!\n");
3532 ret = ffa_error(FFA_INVALID_PARAMETERS);
3533 goto out;
3534 }
3535
J-Alves7461ef22021-10-18 17:21:33 +01003536 /* Set notifications pending. */
J-Alves5a16c962022-03-25 12:32:51 +00003537 vm_notifications_partition_set_pending(
3538 receiver_locked, plat_ffa_is_vm_id(sender_vm_id), notifications,
3539 vcpu_id, is_per_vcpu);
3540
J-Alvesaa79c012021-07-09 14:29:45 +01003541 dlog_verbose("Set the notifications: %x.\n", notifications);
3542
J-Alves13394022021-06-30 13:48:49 +01003543 if ((FFA_NOTIFICATIONS_FLAG_DELAY_SRI & flags) == 0) {
3544 dlog_verbose("SRI was NOT delayed. vcpu: %u!\n",
3545 vcpu_index(current));
3546 plat_ffa_sri_trigger_not_delayed(current->cpu);
3547 } else {
3548 plat_ffa_sri_state_set(DELAYED);
3549 }
J-Alvesaa79c012021-07-09 14:29:45 +01003550
J-Alves13394022021-06-30 13:48:49 +01003551 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
J-Alvesaa79c012021-07-09 14:29:45 +01003552out:
3553 vm_unlock(&receiver_locked);
3554
3555 return ret;
3556}
3557
3558static struct ffa_value api_ffa_notification_get_success_return(
3559 ffa_notifications_bitmap_t from_sp, ffa_notifications_bitmap_t from_vm,
3560 ffa_notifications_bitmap_t from_framework)
3561{
3562 return (struct ffa_value){
3563 .func = FFA_SUCCESS_32,
3564 .arg1 = 0U,
3565 .arg2 = (uint32_t)from_sp,
3566 .arg3 = (uint32_t)(from_sp >> 32),
3567 .arg4 = (uint32_t)from_vm,
3568 .arg5 = (uint32_t)(from_vm >> 32),
3569 .arg6 = (uint32_t)from_framework,
3570 .arg7 = (uint32_t)(from_framework >> 32),
3571 };
3572}
3573
3574struct ffa_value api_ffa_notification_get(ffa_vm_id_t receiver_vm_id,
3575 ffa_vcpu_index_t vcpu_id,
3576 uint32_t flags, struct vcpu *current)
3577{
J-Alves663682a2022-03-25 13:56:51 +00003578 ffa_notifications_bitmap_t framework_notifications = 0;
J-Alvesaa79c012021-07-09 14:29:45 +01003579 ffa_notifications_bitmap_t sp_notifications = 0;
3580 ffa_notifications_bitmap_t vm_notifications = 0;
3581 struct vm_locked receiver_locked;
3582 struct ffa_value ret;
J-Alvesfc95a302022-04-22 14:18:23 +01003583 const uint32_t flags_mbz = ~(FFA_NOTIFICATION_FLAG_BITMAP_HYP |
3584 FFA_NOTIFICATION_FLAG_BITMAP_SPM |
3585 FFA_NOTIFICATION_FLAG_BITMAP_SP |
3586 FFA_NOTIFICATION_FLAG_BITMAP_VM);
3587
3588 /* The FF-A v1.1 EAC0 specification states bits [31:4] Must Be Zero. */
3589 if ((flags & flags_mbz) != 0U) {
3590 dlog_verbose(
3591 "Invalid flags bit(s) set in notifications get. [31:4] "
3592 "MBZ(%x)\n",
3593 flags);
3594 return ffa_error(FFA_INVALID_PARAMETERS);
3595 }
J-Alvesaa79c012021-07-09 14:29:45 +01003596
3597 /*
J-Alvesfc95a302022-04-22 14:18:23 +01003598 * Following check should capture wrong uses of the interface,
3599 * depending on whether Hafnium is SPMC or hypervisor. On the
3600 * rest of the function it is assumed this condition is met.
J-Alvesaa79c012021-07-09 14:29:45 +01003601 */
J-Alvesfc95a302022-04-22 14:18:23 +01003602 if (!plat_ffa_is_notification_get_valid(current, receiver_vm_id,
3603 flags)) {
J-Alvesaa79c012021-07-09 14:29:45 +01003604 dlog_verbose("Invalid use of notifications get interface.\n");
3605 return ffa_error(FFA_INVALID_PARAMETERS);
3606 }
3607
3608 /*
3609 * This check assumes receiver is the current VM, and has been enforced
3610 * by `plat_ffa_is_notifications_get_valid`.
3611 */
3612 receiver_locked = plat_ffa_vm_find_locked(receiver_vm_id);
3613
3614 /*
3615 * `plat_ffa_is_notifications_get_valid` ensures following is never
3616 * true.
3617 */
3618 CHECK(receiver_locked.vm != NULL);
3619
3620 if (receiver_locked.vm->vcpu_count <= vcpu_id ||
3621 (receiver_locked.vm->vcpu_count != 1 &&
3622 cpu_index(current->cpu) != vcpu_id)) {
J-Alves1abb3342022-01-05 11:59:10 +00003623 dlog_verbose(
3624 "Invalid VCPU ID %u. vcpu count %u current core: %u!\n",
3625 vcpu_id, receiver_locked.vm->vcpu_count,
3626 cpu_index(current->cpu));
J-Alvesaa79c012021-07-09 14:29:45 +01003627 ret = ffa_error(FFA_INVALID_PARAMETERS);
3628 goto out;
3629 }
3630
3631 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_SP) != 0U) {
J-Alves98ff9562021-09-09 14:39:41 +01003632 if (!plat_ffa_notifications_get_from_sp(
3633 receiver_locked, vcpu_id, &sp_notifications,
3634 &ret)) {
3635 dlog_verbose("Failed to get notifications from sps.");
3636 goto out;
3637 }
J-Alvesaa79c012021-07-09 14:29:45 +01003638 }
3639
3640 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_VM) != 0U) {
J-Alves5136dda2022-03-25 12:26:38 +00003641 vm_notifications = vm_notifications_partition_get_pending(
J-Alvesaa79c012021-07-09 14:29:45 +01003642 receiver_locked, true, vcpu_id);
3643 }
3644
J-Alvesd605a092022-03-28 14:20:48 +01003645 if ((flags & FFA_NOTIFICATION_FLAG_BITMAP_HYP) != 0U ||
3646 (flags & FFA_NOTIFICATION_FLAG_BITMAP_SPM) != 0U) {
3647 if (!plat_ffa_notifications_get_framework_notifications(
3648 receiver_locked, &framework_notifications, flags,
3649 vcpu_id, &ret)) {
3650 dlog_verbose(
3651 "Failed to get notifications from "
3652 "framework.\n");
3653 goto out;
3654 }
3655 }
3656
J-Alves663682a2022-03-25 13:56:51 +00003657 ret = api_ffa_notification_get_success_return(
3658 sp_notifications, vm_notifications, framework_notifications);
J-Alvesaa79c012021-07-09 14:29:45 +01003659
J-Alvesfe23ebe2021-10-13 16:07:07 +01003660 /*
3661 * If there are no more pending notifications, change `sri_state` to
3662 * handled.
3663 */
3664 if (vm_is_notifications_pending_count_zero()) {
3665 plat_ffa_sri_state_set(HANDLED);
3666 }
3667
J-Alves6e2abc62021-12-02 14:58:56 +00003668 if (!receiver_locked.vm->el0_partition &&
3669 !vm_are_global_notifications_pending(receiver_locked)) {
3670 vm_notifications_set_npi_injected(receiver_locked, false);
3671 }
3672
J-Alvesaa79c012021-07-09 14:29:45 +01003673out:
3674 vm_unlock(&receiver_locked);
3675
3676 return ret;
3677}
J-Alvesc8e8a222021-06-08 17:33:52 +01003678
3679/**
3680 * Prepares successful return for FFA_NOTIFICATION_INFO_GET, as described by
3681 * the section 17.7.1 of the FF-A v1.1 Beta0 specification.
3682 */
3683static struct ffa_value api_ffa_notification_info_get_success_return(
3684 const uint16_t *ids, uint32_t ids_count, const uint32_t *lists_sizes,
J-Alvesfe23ebe2021-10-13 16:07:07 +01003685 uint32_t lists_count)
J-Alvesc8e8a222021-06-08 17:33:52 +01003686{
3687 struct ffa_value ret = (struct ffa_value){.func = FFA_SUCCESS_64};
3688
3689 /*
3690 * Copying content of ids into ret structure. Use 5 registers (x3-x7) to
3691 * hold the list of ids.
3692 */
3693 memcpy_s(&ret.arg3,
3694 sizeof(ret.arg3) * FFA_NOTIFICATIONS_INFO_GET_REGS_RET, ids,
3695 sizeof(ids[0]) * ids_count);
3696
3697 /*
3698 * According to the spec x2 should have:
3699 * - Bit flagging if there are more notifications pending;
3700 * - The total number of elements (i.e. total list size);
3701 * - The number of VCPU IDs within each VM specific list.
3702 */
J-Alvesfe23ebe2021-10-13 16:07:07 +01003703 ret.arg2 = vm_notifications_pending_not_retrieved_by_scheduler()
3704 ? FFA_NOTIFICATIONS_INFO_GET_FLAG_MORE_PENDING
3705 : 0;
J-Alvesc8e8a222021-06-08 17:33:52 +01003706
3707 ret.arg2 |= (lists_count & FFA_NOTIFICATIONS_LISTS_COUNT_MASK)
3708 << FFA_NOTIFICATIONS_LISTS_COUNT_SHIFT;
3709
3710 for (unsigned int i = 0; i < lists_count; i++) {
3711 ret.arg2 |= (lists_sizes[i] & FFA_NOTIFICATIONS_LIST_SIZE_MASK)
3712 << FFA_NOTIFICATIONS_LIST_SHIFT(i + 1);
3713 }
3714
3715 return ret;
3716}
3717
3718struct ffa_value api_ffa_notification_info_get(struct vcpu *current)
3719{
3720 /*
3721 * Following set of variables should be populated with the return info.
3722 * At a successfull handling of this interface, they should be used
3723 * to populate the 'ret' structure in accordance to the table 17.29
3724 * of the FF-A v1.1 Beta0 specification.
3725 */
3726 uint16_t ids[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS];
3727 uint32_t lists_sizes[FFA_NOTIFICATIONS_INFO_GET_MAX_IDS] = {0};
3728 uint32_t lists_count = 0;
3729 uint32_t ids_count = 0;
3730 bool list_is_full = false;
J-Alves13394022021-06-30 13:48:49 +01003731 struct ffa_value result;
J-Alvesc8e8a222021-06-08 17:33:52 +01003732
3733 /*
3734 * This interface can only be called at NS virtual/physical FF-A
3735 * instance by the endpoint implementing the primary scheduler and the
3736 * Hypervisor/OS kernel.
3737 * In the SPM, following check passes if call has been forwarded from
3738 * the hypervisor.
3739 */
3740 if (current->vm->id != HF_PRIMARY_VM_ID) {
3741 dlog_verbose(
3742 "Only the receiver's scheduler can use this "
3743 "interface\n");
3744 return ffa_error(FFA_NOT_SUPPORTED);
3745 }
3746
J-Alvesca058c22021-09-10 14:02:07 +01003747 /*
3748 * Forward call to the other world, and fill the arrays used to assemble
3749 * return.
3750 */
3751 plat_ffa_notification_info_get_forward(
3752 ids, &ids_count, lists_sizes, &lists_count,
3753 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
3754
3755 list_is_full = ids_count == FFA_NOTIFICATIONS_INFO_GET_MAX_IDS;
3756
J-Alvesc8e8a222021-06-08 17:33:52 +01003757 /* Get notifications' info from this world */
3758 for (ffa_vm_count_t index = 0; index < vm_get_count() && !list_is_full;
3759 ++index) {
3760 struct vm_locked vm_locked = vm_lock(vm_find_index(index));
3761
3762 list_is_full = vm_notifications_info_get(
3763 vm_locked, ids, &ids_count, lists_sizes, &lists_count,
3764 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
3765
3766 vm_unlock(&vm_locked);
3767 }
3768
3769 if (!list_is_full) {
3770 /* Grab notifications info from other world */
J-Alvesfe23ebe2021-10-13 16:07:07 +01003771 plat_ffa_vm_notifications_info_get(
J-Alvesc8e8a222021-06-08 17:33:52 +01003772 ids, &ids_count, lists_sizes, &lists_count,
3773 FFA_NOTIFICATIONS_INFO_GET_MAX_IDS);
3774 }
3775
3776 if (ids_count == 0) {
J-Alvesca058c22021-09-10 14:02:07 +01003777 dlog_verbose(
3778 "Notification info get has no data to retrieve.\n");
J-Alves13394022021-06-30 13:48:49 +01003779 result = ffa_error(FFA_NO_DATA);
3780 } else {
3781 result = api_ffa_notification_info_get_success_return(
J-Alvesfe23ebe2021-10-13 16:07:07 +01003782 ids, ids_count, lists_sizes, lists_count);
J-Alvesc8e8a222021-06-08 17:33:52 +01003783 }
3784
J-Alvesfe23ebe2021-10-13 16:07:07 +01003785 plat_ffa_sri_state_set(HANDLED);
3786
J-Alves13394022021-06-30 13:48:49 +01003787 return result;
J-Alvesc8e8a222021-06-08 17:33:52 +01003788}
Raghu Krishnamurthyea6d25f2021-09-14 15:27:06 -07003789
3790struct ffa_value api_ffa_mem_perm_get(vaddr_t base_addr, struct vcpu *current)
3791{
3792 struct vm_locked vm_locked;
3793 struct ffa_value ret = ffa_error(FFA_INVALID_PARAMETERS);
3794 bool mode_ret = false;
3795 uint32_t mode = 0;
3796
3797 if (!plat_ffa_is_mem_perm_get_valid(current)) {
3798 return ffa_error(FFA_NOT_SUPPORTED);
3799 }
3800
3801 if (!(current->vm->el0_partition)) {
3802 return ffa_error(FFA_DENIED);
3803 }
3804
3805 vm_locked = vm_lock(current->vm);
3806
3807 /*
3808 * mm_get_mode is used to check if the given base_addr page is already
3809 * mapped. If the page is unmapped, return error. If the page is mapped
3810 * appropriate attributes are returned to the caller. Note that
3811 * mm_get_mode returns true if the address is in the valid VA range as
3812 * supported by the architecture and MMU configurations, as opposed to
3813 * whether a page is mapped or not. For a page to be known as mapped,
3814 * the API must return true AND the returned mode must not have
3815 * MM_MODE_INVALID set.
3816 */
3817 mode_ret = mm_get_mode(&vm_locked.vm->ptable, base_addr,
3818 va_add(base_addr, PAGE_SIZE), &mode);
3819 if (!mode_ret || (mode & MM_MODE_INVALID)) {
3820 ret = ffa_error(FFA_INVALID_PARAMETERS);
3821 goto out;
3822 }
3823
3824 /* No memory should be marked RWX */
3825 CHECK((mode & (MM_MODE_R | MM_MODE_W | MM_MODE_X)) !=
3826 (MM_MODE_R | MM_MODE_W | MM_MODE_X));
3827
3828 /*
3829 * S-EL0 partitions are expected to have all their pages marked as
3830 * non-global.
3831 */
3832 CHECK((mode & (MM_MODE_NG | MM_MODE_USER)) ==
3833 (MM_MODE_NG | MM_MODE_USER));
3834
3835 if (mode & MM_MODE_W) {
3836 /* No memory should be writeable but not readable. */
3837 CHECK(mode & MM_MODE_R);
3838 ret = (struct ffa_value){.func = FFA_SUCCESS_32,
3839 .arg2 = (uint32_t)(FFA_MEM_PERM_RW)};
3840 } else if (mode & MM_MODE_R) {
3841 ret = (struct ffa_value){.func = FFA_SUCCESS_32,
3842 .arg2 = (uint32_t)(FFA_MEM_PERM_RX)};
3843 if (!(mode & MM_MODE_X)) {
3844 ret.arg2 = (uint32_t)(FFA_MEM_PERM_RO);
3845 }
3846 }
3847out:
3848 vm_unlock(&vm_locked);
3849 return ret;
3850}
3851
3852struct ffa_value api_ffa_mem_perm_set(vaddr_t base_addr, uint32_t page_count,
3853 uint32_t mem_perm, struct vcpu *current)
3854{
3855 struct vm_locked vm_locked;
3856 struct ffa_value ret;
3857 bool mode_ret = false;
3858 uint32_t original_mode;
3859 uint32_t new_mode;
3860 struct mpool local_page_pool;
3861
3862 if (!plat_ffa_is_mem_perm_set_valid(current)) {
3863 return ffa_error(FFA_NOT_SUPPORTED);
3864 }
3865
3866 if (!(current->vm->el0_partition)) {
3867 return ffa_error(FFA_DENIED);
3868 }
3869
3870 if (!is_aligned(va_addr(base_addr), PAGE_SIZE)) {
3871 return ffa_error(FFA_INVALID_PARAMETERS);
3872 }
3873
3874 if ((mem_perm != FFA_MEM_PERM_RW) && (mem_perm != FFA_MEM_PERM_RO) &&
3875 (mem_perm != FFA_MEM_PERM_RX)) {
3876 return ffa_error(FFA_INVALID_PARAMETERS);
3877 }
3878
3879 /*
3880 * Create a local pool so any freed memory can't be used by another
3881 * thread. This is to ensure the original mapping can be restored if any
3882 * stage of the process fails.
3883 */
3884 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
3885
3886 vm_locked = vm_lock(current->vm);
3887
3888 /*
3889 * All regions accessible by the partition are mapped during boot. If we
3890 * cannot get a successful translation for the page range, the request
3891 * to change permissions is rejected.
3892 * mm_get_mode is used to check if the given address range is already
3893 * mapped. If the range is unmapped, return error. If the range is
3894 * mapped appropriate attributes are returned to the caller. Note that
3895 * mm_get_mode returns true if the address is in the valid VA range as
3896 * supported by the architecture and MMU configurations, as opposed to
3897 * whether a page is mapped or not. For a page to be known as mapped,
3898 * the API must return true AND the returned mode must not have
3899 * MM_MODE_INVALID set.
3900 */
3901
3902 mode_ret = mm_get_mode(&vm_locked.vm->ptable, base_addr,
3903 va_add(base_addr, page_count * PAGE_SIZE),
3904 &original_mode);
3905 if (!mode_ret || (original_mode & MM_MODE_INVALID)) {
3906 ret = ffa_error(FFA_INVALID_PARAMETERS);
3907 goto out;
3908 }
3909
3910 /* Device memory cannot be marked as executable */
3911 if ((original_mode & MM_MODE_D) && (mem_perm == FFA_MEM_PERM_RX)) {
3912 ret = ffa_error(FFA_INVALID_PARAMETERS);
3913 goto out;
3914 }
3915
3916 new_mode = MM_MODE_USER | MM_MODE_NG;
3917
3918 if (mem_perm == FFA_MEM_PERM_RW) {
3919 new_mode |= MM_MODE_R | MM_MODE_W;
3920 } else if (mem_perm == FFA_MEM_PERM_RX) {
3921 new_mode |= MM_MODE_R | MM_MODE_X;
3922 } else if (mem_perm == FFA_MEM_PERM_RO) {
3923 new_mode |= MM_MODE_R;
3924 }
3925
3926 /*
3927 * Safe to re-map memory, since we know the requested permissions are
3928 * valid, and the memory requested to be re-mapped is also valid.
3929 */
3930 if (!mm_identity_prepare(
3931 &vm_locked.vm->ptable, pa_from_va(base_addr),
3932 pa_from_va(va_add(base_addr, page_count * PAGE_SIZE)),
3933 new_mode, &local_page_pool)) {
3934 /*
3935 * Defrag the table into the local page pool.
3936 * mm_identity_prepare could have allocated or freed pages to
3937 * split blocks or tables etc.
3938 */
3939 mm_stage1_defrag(&vm_locked.vm->ptable, &local_page_pool);
3940
3941 /*
3942 * Guaranteed to succeed mapping with old mode since the mapping
3943 * with old mode already existed and we have a local page pool
3944 * that should have sufficient memory to go back to the original
3945 * state.
3946 */
3947 CHECK(mm_identity_prepare(
3948 &vm_locked.vm->ptable, pa_from_va(base_addr),
3949 pa_from_va(va_add(base_addr, page_count * PAGE_SIZE)),
3950 original_mode, &local_page_pool));
3951 mm_identity_commit(
3952 &vm_locked.vm->ptable, pa_from_va(base_addr),
3953 pa_from_va(va_add(base_addr, page_count * PAGE_SIZE)),
3954 original_mode, &local_page_pool);
3955
3956 mm_stage1_defrag(&vm_locked.vm->ptable, &api_page_pool);
3957 ret = ffa_error(FFA_NO_MEMORY);
3958 goto out;
3959 }
3960
3961 mm_identity_commit(
3962 &vm_locked.vm->ptable, pa_from_va(base_addr),
3963 pa_from_va(va_add(base_addr, page_count * PAGE_SIZE)), new_mode,
3964 &local_page_pool);
3965
3966 ret = (struct ffa_value){.func = FFA_SUCCESS_32};
3967
3968out:
3969 mpool_fini(&local_page_pool);
3970 vm_unlock(&vm_locked);
3971
3972 return ret;
3973}
Maksims Svecovs71b76702022-05-20 15:32:58 +01003974
3975/**
3976 * Helper function for FFA_CONSOLE_LOG ABI.
3977 * Writes number of characters to a given VM buffer.
3978 */
3979static rsize_t arg_to_char_helper(struct vm_locked from_locked,
3980 const uint64_t src, rsize_t src_size,
3981 rsize_t to_write)
3982{
3983 bool flush = false;
3984 char c;
3985 rsize_t size = src_size < to_write ? src_size : to_write;
3986 rsize_t written = 0;
3987
3988 if (size == 0) {
3989 return 0;
3990 }
3991
3992 while (written < size) {
3993 c = ((char *)&src)[written++];
3994 if (c == '\n' || c == '\0') {
3995 flush = true;
3996 } else {
3997 from_locked.vm->log_buffer
3998 [from_locked.vm->log_buffer_length++] = c;
3999 flush = (from_locked.vm->log_buffer_length ==
4000 LOG_BUFFER_SIZE);
4001 }
4002
4003 if (flush) {
4004 dlog_flush_vm_buffer(from_locked.vm->id,
4005 from_locked.vm->log_buffer,
4006 from_locked.vm->log_buffer_length);
4007 from_locked.vm->log_buffer_length = 0;
4008 }
4009 }
4010
4011 return written;
4012}
4013
4014/**
4015 * Implements FFA_CONSOLE_LOG buffered logging.
4016 */
4017struct ffa_value api_ffa_console_log(const struct ffa_value args,
4018 struct vcpu *current)
4019{
4020 struct vm *vm = current->vm;
4021 struct vm_locked vm_locked;
4022 size_t chars_in_param = args.func == FFA_CONSOLE_LOG_32
4023 ? sizeof(uint32_t)
4024 : sizeof(uint64_t);
4025 size_t total_to_write = args.arg1;
4026
4027 if (total_to_write == 0 || total_to_write > chars_in_param * 6) {
4028 return ffa_error(FFA_INVALID_PARAMETERS);
4029 }
4030
4031 vm_locked = vm_lock(vm);
4032
4033 total_to_write -= arg_to_char_helper(vm_locked, args.arg2,
4034 chars_in_param, total_to_write);
4035 total_to_write -= arg_to_char_helper(vm_locked, args.arg3,
4036 chars_in_param, total_to_write);
4037 total_to_write -= arg_to_char_helper(vm_locked, args.arg4,
4038 chars_in_param, total_to_write);
4039 total_to_write -= arg_to_char_helper(vm_locked, args.arg5,
4040 chars_in_param, total_to_write);
4041 total_to_write -= arg_to_char_helper(vm_locked, args.arg6,
4042 chars_in_param, total_to_write);
4043 arg_to_char_helper(vm_locked, args.arg7, chars_in_param,
4044 total_to_write);
4045
4046 vm_unlock(&vm_locked);
4047
4048 return (struct ffa_value){.func = FFA_SUCCESS_32};
4049}