blob: 825cb42430ad4283228101b988b104302a78247a [file] [log] [blame]
Andrew Scull18834872018-10-12 11:48:09 +01001/*
Andrew Walbran692b3252019-03-07 15:51:31 +00002 * Copyright 2018 The Hafnium Authors.
Andrew Scull18834872018-10-12 11:48:09 +01003 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * https://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Andrew Scull18c78fc2018-08-20 12:57:41 +010017#include "hf/api.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010018
Andrew Walbran318f5732018-11-20 16:23:42 +000019#include "hf/arch/cpu.h"
Andrew Walbran2619e0a2020-01-10 16:37:50 +000020#include "hf/arch/tee.h"
Andrew Walbran508e63c2018-12-20 17:02:37 +000021#include "hf/arch/timer.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000022
Andrew Scull877ae4b2019-07-02 12:52:33 +010023#include "hf/check.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000024#include "hf/dlog.h"
Andrew Scull6386f252018-12-06 13:29:10 +000025#include "hf/mm.h"
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +010026#include "hf/plat/console.h"
Jose Marinho40d55f32019-07-01 15:41:54 +010027#include "hf/spci_internal.h"
Andrew Scull6386f252018-12-06 13:29:10 +000028#include "hf/spinlock.h"
Andrew Scull877ae4b2019-07-02 12:52:33 +010029#include "hf/static_assert.h"
Andrew Scull8d9e1212019-04-05 13:52:55 +010030#include "hf/std.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010031#include "hf/vm.h"
32
Andrew Scullf35a5c92018-08-07 18:09:46 +010033#include "vmapi/hf/call.h"
Jose Marinhoa1dfeda2019-02-27 16:46:03 +000034#include "vmapi/hf/spci.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010035
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000036/*
37 * To eliminate the risk of deadlocks, we define a partial order for the
38 * acquisition of locks held concurrently by the same physical CPU. Our current
39 * ordering requirements are as follows:
40 *
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +010041 * vm::lock -> vcpu::lock -> mm_stage1_lock -> dlog sl
Andrew Scull6386f252018-12-06 13:29:10 +000042 *
Andrew Scull4caadaf2019-07-03 13:13:47 +010043 * Locks of the same kind require the lock of lowest address to be locked first,
44 * see `sl_lock_both()`.
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000045 */
46
Andrew Scullaa039b32018-10-04 15:02:26 +010047static_assert(HF_MAILBOX_SIZE == PAGE_SIZE,
Andrew Scull13652af2018-09-17 14:49:08 +010048 "Currently, a page is mapped for the send and receive buffers so "
49 "the maximum request is the size of a page.");
50
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000051static struct mpool api_page_pool;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000052
53/**
Wedson Almeida Filho81568c42019-01-04 13:33:02 +000054 * Initialises the API page pool by taking ownership of the contents of the
55 * given page pool.
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000056 */
57void api_init(struct mpool *ppool)
58{
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000059 mpool_init_from(&api_page_pool, ppool);
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000060}
61
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010062/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +000063 * Switches the physical CPU back to the corresponding vCPU of the primary VM.
Andrew Scullaa039b32018-10-04 15:02:26 +010064 *
65 * This triggers the scheduling logic to run. Run in the context of secondary VM
Andrew Walbranf0c314d2019-10-02 14:24:26 +010066 * to cause SPCI_RUN to return and the primary VM to regain control of the CPU.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010067 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +010068static struct vcpu *api_switch_to_primary(struct vcpu *current,
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +010069 struct spci_value primary_ret,
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000070 enum vcpu_state secondary_state)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010071{
Andrew Walbran42347a92019-05-09 13:59:03 +010072 struct vm *primary = vm_find(HF_PRIMARY_VM_ID);
Andrew Walbrane1310df2019-04-29 17:28:28 +010073 struct vcpu *next = vm_get_vcpu(primary, cpu_index(current->cpu));
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010074
Andrew Walbran508e63c2018-12-20 17:02:37 +000075 /*
76 * If the secondary is blocked but has a timer running, sleep until the
77 * timer fires rather than indefinitely.
78 */
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +010079 switch (primary_ret.func) {
80 case HF_SPCI_RUN_WAIT_FOR_INTERRUPT:
81 case SPCI_MSG_WAIT_32: {
82 if (arch_timer_enabled_current()) {
83 uint64_t remaining_ns =
84 arch_timer_remaining_ns_current();
85
86 if (remaining_ns == 0) {
87 /*
88 * Timer is pending, so the current vCPU should
89 * be run again right away.
90 */
91 primary_ret.func = SPCI_INTERRUPT_32;
92 /*
93 * primary_ret.arg1 should already be set to the
94 * current VM ID and vCPU ID.
95 */
96 primary_ret.arg2 = 0;
97 } else {
98 primary_ret.arg2 = remaining_ns;
99 }
100 } else {
101 primary_ret.arg2 = SPCI_SLEEP_INDEFINITE;
102 }
Andrew Scullb06d1752019-02-04 10:15:48 +0000103 break;
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100104 }
Andrew Scullb06d1752019-02-04 10:15:48 +0000105
106 default:
107 /* Do nothing. */
108 break;
Andrew Walbran508e63c2018-12-20 17:02:37 +0000109 }
110
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100111 /* Set the return value for the primary VM's call to HF_VCPU_RUN. */
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100112 arch_regs_set_retval(&next->regs, primary_ret);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100113
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000114 /* Mark the current vCPU as waiting. */
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000115 sl_lock(&current->lock);
116 current->state = secondary_state;
117 sl_unlock(&current->lock);
118
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100119 return next;
120}
121
122/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000123 * Returns to the primary VM and signals that the vCPU still has work to do so.
Andrew Scull33fecd32019-01-08 14:48:27 +0000124 */
125struct vcpu *api_preempt(struct vcpu *current)
126{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100127 struct spci_value ret = {
128 .func = SPCI_INTERRUPT_32,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000129 .arg1 = spci_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull33fecd32019-01-08 14:48:27 +0000130 };
131
Andrew Sculld6ee1102019-04-05 22:12:42 +0100132 return api_switch_to_primary(current, ret, VCPU_STATE_READY);
Andrew Scull33fecd32019-01-08 14:48:27 +0000133}
134
135/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000136 * Puts the current vCPU in wait for interrupt mode, and returns to the primary
Fuad Tabbaed294af2019-12-20 10:43:01 +0000137 * VM.
Andrew Scullaa039b32018-10-04 15:02:26 +0100138 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100139struct vcpu *api_wait_for_interrupt(struct vcpu *current)
Andrew Scullaa039b32018-10-04 15:02:26 +0100140{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100141 struct spci_value ret = {
142 .func = HF_SPCI_RUN_WAIT_FOR_INTERRUPT,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000143 .arg1 = spci_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull6d2db332018-10-10 15:28:17 +0100144 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000145
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000146 return api_switch_to_primary(current, ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100147 VCPU_STATE_BLOCKED_INTERRUPT);
Andrew Scullaa039b32018-10-04 15:02:26 +0100148}
149
150/**
Andrew Walbran33645652019-04-15 12:29:31 +0100151 * Puts the current vCPU in off mode, and returns to the primary VM.
152 */
153struct vcpu *api_vcpu_off(struct vcpu *current)
154{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100155 struct spci_value ret = {
156 .func = HF_SPCI_RUN_WAIT_FOR_INTERRUPT,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000157 .arg1 = spci_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Walbran33645652019-04-15 12:29:31 +0100158 };
159
160 /*
161 * Disable the timer, so the scheduler doesn't get told to call back
162 * based on it.
163 */
164 arch_timer_disable_current();
165
166 return api_switch_to_primary(current, ret, VCPU_STATE_OFF);
167}
168
169/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000170 * Returns to the primary VM to allow this CPU to be used for other tasks as the
171 * vCPU does not have work to do at this moment. The current vCPU is marked as
Andrew Walbran16075b62019-09-03 17:11:07 +0100172 * ready to be scheduled again.
Andrew Scull66d62bf2019-02-01 13:54:10 +0000173 */
Andrew Walbran16075b62019-09-03 17:11:07 +0100174void api_yield(struct vcpu *current, struct vcpu **next)
Andrew Scull66d62bf2019-02-01 13:54:10 +0000175{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100176 struct spci_value primary_ret = {
177 .func = SPCI_YIELD_32,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000178 .arg1 = spci_vm_vcpu(current->vm->id, vcpu_index(current)),
Andrew Scull66d62bf2019-02-01 13:54:10 +0000179 };
180
181 if (current->vm->id == HF_PRIMARY_VM_ID) {
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000182 /* NOOP on the primary as it makes the scheduling decisions. */
Andrew Walbran16075b62019-09-03 17:11:07 +0100183 return;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000184 }
185
Andrew Walbran16075b62019-09-03 17:11:07 +0100186 *next = api_switch_to_primary(current, primary_ret, VCPU_STATE_READY);
Andrew Scull66d62bf2019-02-01 13:54:10 +0000187}
188
189/**
Andrew Walbran33645652019-04-15 12:29:31 +0100190 * Switches to the primary so that it can switch to the target, or kick it if it
191 * is already running on a different physical CPU.
192 */
193struct vcpu *api_wake_up(struct vcpu *current, struct vcpu *target_vcpu)
194{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100195 struct spci_value ret = {
196 .func = HF_SPCI_RUN_WAKE_UP,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000197 .arg1 = spci_vm_vcpu(target_vcpu->vm->id,
198 vcpu_index(target_vcpu)),
Andrew Walbran33645652019-04-15 12:29:31 +0100199 };
200 return api_switch_to_primary(current, ret, VCPU_STATE_READY);
201}
202
203/**
Andrew Scull38772ab2019-01-24 15:16:50 +0000204 * Aborts the vCPU and triggers its VM to abort fully.
Andrew Scull9726c252019-01-23 13:44:19 +0000205 */
206struct vcpu *api_abort(struct vcpu *current)
207{
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100208 struct spci_value ret = spci_error(SPCI_ABORTED);
Andrew Scull9726c252019-01-23 13:44:19 +0000209
210 dlog("Aborting VM %u vCPU %u\n", current->vm->id, vcpu_index(current));
211
212 if (current->vm->id == HF_PRIMARY_VM_ID) {
213 /* TODO: what to do when the primary aborts? */
214 for (;;) {
215 /* Do nothing. */
216 }
217 }
218
219 atomic_store_explicit(&current->vm->aborting, true,
220 memory_order_relaxed);
221
222 /* TODO: free resources once all vCPUs abort. */
223
Andrew Sculld6ee1102019-04-05 22:12:42 +0100224 return api_switch_to_primary(current, ret, VCPU_STATE_ABORTED);
Andrew Scull9726c252019-01-23 13:44:19 +0000225}
226
227/**
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000228 * Returns the ID of the VM.
229 */
Andrew Walbrand230f662019-10-07 18:03:36 +0100230struct spci_value api_spci_id_get(const struct vcpu *current)
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000231{
Andrew Walbrand230f662019-10-07 18:03:36 +0100232 return (struct spci_value){.func = SPCI_SUCCESS_32,
233 .arg2 = current->vm->id};
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000234}
235
236/**
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100237 * Returns the number of VMs configured to run.
238 */
Andrew Walbran52d99672019-06-25 15:51:11 +0100239spci_vm_count_t api_vm_get_count(void)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100240{
Andrew Scull19503262018-09-20 14:48:39 +0100241 return vm_get_count();
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100242}
243
244/**
Andrew Walbranc6d23c42019-06-26 13:30:42 +0100245 * Returns the number of vCPUs configured in the given VM, or 0 if there is no
246 * such VM or the caller is not the primary VM.
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100247 */
Andrew Walbranc6d23c42019-06-26 13:30:42 +0100248spci_vcpu_count_t api_vcpu_get_count(spci_vm_id_t vm_id,
249 const struct vcpu *current)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100250{
Andrew Scull19503262018-09-20 14:48:39 +0100251 struct vm *vm;
252
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000253 /* Only the primary VM needs to know about vCPUs for scheduling. */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100254 if (current->vm->id != HF_PRIMARY_VM_ID) {
Andrew Walbranc6d23c42019-06-26 13:30:42 +0100255 return 0;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100256 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100257
Andrew Walbran42347a92019-05-09 13:59:03 +0100258 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +0100259 if (vm == NULL) {
Andrew Walbranc6d23c42019-06-26 13:30:42 +0100260 return 0;
Andrew Scull19503262018-09-20 14:48:39 +0100261 }
262
263 return vm->vcpu_count;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100264}
265
266/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000267 * This function is called by the architecture-specific context switching
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000268 * function to indicate that register state for the given vCPU has been saved
269 * and can therefore be used by other pCPUs.
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000270 */
271void api_regs_state_saved(struct vcpu *vcpu)
272{
273 sl_lock(&vcpu->lock);
274 vcpu->regs_available = true;
275 sl_unlock(&vcpu->lock);
276}
277
278/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000279 * Retrieves the next waiter and removes it from the wait list if the VM's
280 * mailbox is in a writable state.
281 */
282static struct wait_entry *api_fetch_waiter(struct vm_locked locked_vm)
283{
284 struct wait_entry *entry;
285 struct vm *vm = locked_vm.vm;
286
Andrew Sculld6ee1102019-04-05 22:12:42 +0100287 if (vm->mailbox.state != MAILBOX_STATE_EMPTY ||
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000288 vm->mailbox.recv == NULL || list_empty(&vm->mailbox.waiter_list)) {
289 /* The mailbox is not writable or there are no waiters. */
290 return NULL;
291 }
292
293 /* Remove waiter from the wait list. */
294 entry = CONTAINER_OF(vm->mailbox.waiter_list.next, struct wait_entry,
295 wait_links);
296 list_remove(&entry->wait_links);
297 return entry;
298}
299
300/**
Andrew Walbran508e63c2018-12-20 17:02:37 +0000301 * Assuming that the arguments have already been checked by the caller, injects
302 * a virtual interrupt of the given ID into the given target vCPU. This doesn't
303 * cause the vCPU to actually be run immediately; it will be taken when the vCPU
304 * is next run, which is up to the scheduler.
305 *
306 * Returns:
307 * - 0 on success if no further action is needed.
308 * - 1 if it was called by the primary VM and the primary VM now needs to wake
309 * up or kick the target vCPU.
310 */
Andrew Walbranfc9d4382019-05-10 18:07:21 +0100311static int64_t internal_interrupt_inject(struct vcpu *target_vcpu,
Andrew Walbran508e63c2018-12-20 17:02:37 +0000312 uint32_t intid, struct vcpu *current,
313 struct vcpu **next)
314{
315 uint32_t intid_index = intid / INTERRUPT_REGISTER_BITS;
Andrew Walbrane52006c2019-10-22 18:01:28 +0100316 uint32_t intid_mask = 1U << (intid % INTERRUPT_REGISTER_BITS);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000317 int64_t ret = 0;
318
319 sl_lock(&target_vcpu->lock);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000320
321 /*
322 * We only need to change state and (maybe) trigger a virtual IRQ if it
323 * is enabled and was not previously pending. Otherwise we can skip
324 * everything except setting the pending bit.
325 *
326 * If you change this logic make sure to update the need_vm_lock logic
327 * above to match.
328 */
329 if (!(target_vcpu->interrupts.interrupt_enabled[intid_index] &
330 ~target_vcpu->interrupts.interrupt_pending[intid_index] &
331 intid_mask)) {
332 goto out;
333 }
334
335 /* Increment the count. */
336 target_vcpu->interrupts.enabled_and_pending_count++;
337
338 /*
339 * Only need to update state if there was not already an
340 * interrupt enabled and pending.
341 */
342 if (target_vcpu->interrupts.enabled_and_pending_count != 1) {
343 goto out;
344 }
345
Andrew Walbran508e63c2018-12-20 17:02:37 +0000346 if (current->vm->id == HF_PRIMARY_VM_ID) {
347 /*
348 * If the call came from the primary VM, let it know that it
349 * should run or kick the target vCPU.
350 */
351 ret = 1;
352 } else if (current != target_vcpu && next != NULL) {
Andrew Walbran33645652019-04-15 12:29:31 +0100353 *next = api_wake_up(current, target_vcpu);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000354 }
355
356out:
357 /* Either way, make it pending. */
358 target_vcpu->interrupts.interrupt_pending[intid_index] |= intid_mask;
359
360 sl_unlock(&target_vcpu->lock);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000361
362 return ret;
363}
364
365/**
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100366 * Constructs an SPCI_MSG_SEND value to return from a successful SPCI_MSG_POLL
367 * or SPCI_MSG_WAIT call.
368 */
369static struct spci_value spci_msg_recv_return(const struct vm *receiver)
370{
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000371 switch (receiver->mailbox.recv_func) {
372 case SPCI_MSG_SEND_32:
373 return (struct spci_value){
374 .func = SPCI_MSG_SEND_32,
375 .arg1 = (receiver->mailbox.recv_sender << 16) |
376 receiver->id,
377 .arg3 = receiver->mailbox.recv_size};
378 case SPCI_MEM_DONATE_32:
379 case SPCI_MEM_LEND_32:
380 case SPCI_MEM_SHARE_32:
381 case HF_SPCI_MEM_RELINQUISH:
382 return (struct spci_value){.func = receiver->mailbox.recv_func,
Andrew Walbran0f6cede2020-01-10 15:38:09 +0000383 .arg3 = receiver->mailbox.recv_size,
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000384 .arg4 = receiver->mailbox.recv_size};
385 default:
386 /* This should never be reached, but return an error in case. */
387 dlog("Tried to return an invalid message function %#x\n",
388 receiver->mailbox.recv_func);
389 return spci_error(SPCI_DENIED);
390 }
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100391}
392
393/**
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000394 * Prepares the vCPU to run by updating its state and fetching whether a return
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000395 * value needs to be forced onto the vCPU.
396 */
Andrew Scull38772ab2019-01-24 15:16:50 +0000397static bool api_vcpu_prepare_run(const struct vcpu *current, struct vcpu *vcpu,
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100398 struct spci_value *run_ret)
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000399{
Andrew Scullb06d1752019-02-04 10:15:48 +0000400 bool need_vm_lock;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000401 bool ret;
402
Andrew Scullb06d1752019-02-04 10:15:48 +0000403 /*
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000404 * Check that the registers are available so that the vCPU can be run.
Andrew Scullb06d1752019-02-04 10:15:48 +0000405 *
Andrew Scull4caadaf2019-07-03 13:13:47 +0100406 * The VM lock is not needed in the common case so it must only be taken
407 * when it is going to be needed. This ensures there are no inter-vCPU
408 * dependencies in the common run case meaning the sensitive context
409 * switch performance is consistent.
Andrew Scullb06d1752019-02-04 10:15:48 +0000410 */
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000411 sl_lock(&vcpu->lock);
Andrew Scullb06d1752019-02-04 10:15:48 +0000412
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000413 /* The VM needs to be locked to deliver mailbox messages. */
414 need_vm_lock = vcpu->state == VCPU_STATE_BLOCKED_MAILBOX;
415 if (need_vm_lock) {
Andrew Scullb06d1752019-02-04 10:15:48 +0000416 sl_unlock(&vcpu->lock);
Andrew Walbrand81c7d82019-11-27 18:34:46 +0000417 sl_lock(&vcpu->vm->lock);
418 sl_lock(&vcpu->lock);
419 }
420
421 /*
422 * If the vCPU is already running somewhere then we can't run it here
423 * simultaneously. While it is actually running then the state should be
424 * `VCPU_STATE_RUNNING` and `regs_available` should be false. Once it
425 * stops running but while Hafnium is in the process of switching back
426 * to the primary there will be a brief period while the state has been
427 * updated but `regs_available` is still false (until
428 * `api_regs_state_saved` is called). We can't start running it again
429 * until this has finished, so count this state as still running for the
430 * purposes of this check.
431 */
432 if (vcpu->state == VCPU_STATE_RUNNING || !vcpu->regs_available) {
433 /*
434 * vCPU is running on another pCPU.
435 *
436 * It's okay not to return the sleep duration here because the
437 * other physical CPU that is currently running this vCPU will
438 * return the sleep duration if needed.
439 */
440 *run_ret = spci_error(SPCI_BUSY);
441 ret = false;
442 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000443 }
Andrew Scull9726c252019-01-23 13:44:19 +0000444
445 if (atomic_load_explicit(&vcpu->vm->aborting, memory_order_relaxed)) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100446 if (vcpu->state != VCPU_STATE_ABORTED) {
Andrew Scull82331282019-01-25 10:29:34 +0000447 dlog("Aborting VM %u vCPU %u\n", vcpu->vm->id,
448 vcpu_index(vcpu));
Andrew Sculld6ee1102019-04-05 22:12:42 +0100449 vcpu->state = VCPU_STATE_ABORTED;
Andrew Scull9726c252019-01-23 13:44:19 +0000450 }
451 ret = false;
452 goto out;
453 }
454
Andrew Walbran508e63c2018-12-20 17:02:37 +0000455 switch (vcpu->state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100456 case VCPU_STATE_RUNNING:
457 case VCPU_STATE_OFF:
458 case VCPU_STATE_ABORTED:
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000459 ret = false;
460 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000461
Andrew Sculld6ee1102019-04-05 22:12:42 +0100462 case VCPU_STATE_BLOCKED_MAILBOX:
Andrew Scullb06d1752019-02-04 10:15:48 +0000463 /*
464 * A pending message allows the vCPU to run so the message can
465 * be delivered directly.
466 */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100467 if (vcpu->vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
Andrew Walbrand4d2fa12019-10-01 16:47:25 +0100468 arch_regs_set_retval(&vcpu->regs,
469 spci_msg_recv_return(vcpu->vm));
Andrew Sculld6ee1102019-04-05 22:12:42 +0100470 vcpu->vm->mailbox.state = MAILBOX_STATE_READ;
Andrew Scullb06d1752019-02-04 10:15:48 +0000471 break;
472 }
473 /* Fall through. */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100474 case VCPU_STATE_BLOCKED_INTERRUPT:
Andrew Scullb06d1752019-02-04 10:15:48 +0000475 /* Allow virtual interrupts to be delivered. */
476 if (vcpu->interrupts.enabled_and_pending_count > 0) {
477 break;
478 }
479
Andrew Walbran508e63c2018-12-20 17:02:37 +0000480 if (arch_timer_enabled(&vcpu->regs)) {
Andrew Walbran2fc856a2019-11-04 15:17:24 +0000481 uint64_t timer_remaining_ns =
482 arch_timer_remaining_ns(&vcpu->regs);
483
484 /*
485 * The timer expired so allow the interrupt to be
486 * delivered.
487 */
488 if (timer_remaining_ns == 0) {
489 break;
490 }
491
492 /*
493 * The vCPU is not ready to run, return the appropriate
494 * code to the primary which called vcpu_run.
495 */
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100496 run_ret->func =
Andrew Sculld6ee1102019-04-05 22:12:42 +0100497 vcpu->state == VCPU_STATE_BLOCKED_MAILBOX
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100498 ? SPCI_MSG_WAIT_32
499 : HF_SPCI_RUN_WAIT_FOR_INTERRUPT;
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000500 run_ret->arg1 =
501 spci_vm_vcpu(vcpu->vm->id, vcpu_index(vcpu));
Andrew Walbran2fc856a2019-11-04 15:17:24 +0000502 run_ret->arg2 = timer_remaining_ns;
Andrew Walbran508e63c2018-12-20 17:02:37 +0000503 }
504
505 ret = false;
506 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000507
Andrew Sculld6ee1102019-04-05 22:12:42 +0100508 case VCPU_STATE_READY:
Andrew Walbran508e63c2018-12-20 17:02:37 +0000509 break;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000510 }
511
Andrew Scullb06d1752019-02-04 10:15:48 +0000512 /* It has been decided that the vCPU should be run. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000513 vcpu->cpu = current->cpu;
Andrew Sculld6ee1102019-04-05 22:12:42 +0100514 vcpu->state = VCPU_STATE_RUNNING;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000515
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000516 /*
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000517 * Mark the registers as unavailable now that we're about to reflect
518 * them onto the real registers. This will also prevent another physical
519 * CPU from trying to read these registers.
520 */
521 vcpu->regs_available = false;
522
523 ret = true;
524
525out:
526 sl_unlock(&vcpu->lock);
Andrew Scullb06d1752019-02-04 10:15:48 +0000527 if (need_vm_lock) {
528 sl_unlock(&vcpu->vm->lock);
529 }
530
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000531 return ret;
532}
533
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100534struct spci_value api_spci_run(spci_vm_id_t vm_id, spci_vcpu_index_t vcpu_idx,
535 const struct vcpu *current, struct vcpu **next)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100536{
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100537 struct vm *vm;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100538 struct vcpu *vcpu;
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100539 struct spci_value ret = spci_error(SPCI_INVALID_PARAMETERS);
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100540
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000541 /* Only the primary VM can switch vCPUs. */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100542 if (current->vm->id != HF_PRIMARY_VM_ID) {
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100543 ret.arg2 = SPCI_DENIED;
Andrew Scull6d2db332018-10-10 15:28:17 +0100544 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100545 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100546
Fuad Tabbab0ef2a42019-12-19 11:19:25 +0000547 /* Only secondary VM vCPUs can be run. */
Andrew Scull19503262018-09-20 14:48:39 +0100548 if (vm_id == HF_PRIMARY_VM_ID) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100549 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100550 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100551
Andrew Scull19503262018-09-20 14:48:39 +0100552 /* The requested VM must exist. */
Andrew Walbran42347a92019-05-09 13:59:03 +0100553 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +0100554 if (vm == NULL) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100555 goto out;
Andrew Scull19503262018-09-20 14:48:39 +0100556 }
557
Fuad Tabbaed294af2019-12-20 10:43:01 +0000558 /* The requested vCPU must exist. */
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100559 if (vcpu_idx >= vm->vcpu_count) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100560 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100561 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100562
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000563 /* Update state if allowed. */
Andrew Walbrane1310df2019-04-29 17:28:28 +0100564 vcpu = vm_get_vcpu(vm, vcpu_idx);
Andrew Scullb06d1752019-02-04 10:15:48 +0000565 if (!api_vcpu_prepare_run(current, vcpu, &ret)) {
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000566 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100567 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000568
Andrew Walbran508e63c2018-12-20 17:02:37 +0000569 /*
570 * Inject timer interrupt if timer has expired. It's safe to access
571 * vcpu->regs here because api_vcpu_prepare_run already made sure that
572 * regs_available was true (and then set it to false) before returning
573 * true.
574 */
575 if (arch_timer_pending(&vcpu->regs)) {
576 /* Make virtual timer interrupt pending. */
Andrew Walbranfc9d4382019-05-10 18:07:21 +0100577 internal_interrupt_inject(vcpu, HF_VIRTUAL_TIMER_INTID, vcpu,
578 NULL);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000579
580 /*
581 * Set the mask bit so the hardware interrupt doesn't fire
582 * again. Ideally we wouldn't do this because it affects what
583 * the secondary vCPU sees, but if we don't then we end up with
584 * a loop of the interrupt firing each time we try to return to
585 * the secondary vCPU.
586 */
587 arch_timer_mask(&vcpu->regs);
588 }
589
Fuad Tabbaed294af2019-12-20 10:43:01 +0000590 /* Switch to the vCPU. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000591 *next = vcpu;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000592
Andrew Scull33fecd32019-01-08 14:48:27 +0000593 /*
594 * Set a placeholder return code to the scheduler. This will be
595 * overwritten when the switch back to the primary occurs.
596 */
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100597 ret.func = SPCI_INTERRUPT_32;
Andrew Walbran4db5f3a2019-11-04 11:42:42 +0000598 ret.arg1 = spci_vm_vcpu(vm_id, vcpu_idx);
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100599 ret.arg2 = 0;
Andrew Scull33fecd32019-01-08 14:48:27 +0000600
Andrew Scull6d2db332018-10-10 15:28:17 +0100601out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100602 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100603}
604
605/**
Andrew Scull81e85092018-12-12 12:56:20 +0000606 * Check that the mode indicates memory that is valid, owned and exclusive.
607 */
Andrew Walbran1281ed42019-10-22 17:23:40 +0100608static bool api_mode_valid_owned_and_exclusive(uint32_t mode)
Andrew Scull81e85092018-12-12 12:56:20 +0000609{
Andrew Scullb5f49e02019-10-02 13:20:47 +0100610 return (mode & (MM_MODE_D | MM_MODE_INVALID | MM_MODE_UNOWNED |
611 MM_MODE_SHARED)) == 0;
Andrew Scull81e85092018-12-12 12:56:20 +0000612}
613
614/**
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +0000615 * Determines the value to be returned by api_vm_configure and spci_rx_release
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000616 * after they've succeeded. If a secondary VM is running and there are waiters,
617 * it also switches back to the primary VM for it to wake waiters up.
618 */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000619static struct spci_value api_waiter_result(struct vm_locked locked_vm,
620 struct vcpu *current,
621 struct vcpu **next)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000622{
623 struct vm *vm = locked_vm.vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000624
625 if (list_empty(&vm->mailbox.waiter_list)) {
626 /* No waiters, nothing else to do. */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000627 return (struct spci_value){.func = SPCI_SUCCESS_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000628 }
629
630 if (vm->id == HF_PRIMARY_VM_ID) {
631 /* The caller is the primary VM. Tell it to wake up waiters. */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000632 return (struct spci_value){.func = SPCI_RX_RELEASE_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000633 }
634
635 /*
636 * Switch back to the primary VM, informing it that there are waiters
637 * that need to be notified.
638 */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000639 *next = api_switch_to_primary(
640 current, (struct spci_value){.func = SPCI_RX_RELEASE_32},
641 VCPU_STATE_READY);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000642
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000643 return (struct spci_value){.func = SPCI_SUCCESS_32};
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000644}
645
646/**
Andrew Sculle1322792019-07-01 17:46:10 +0100647 * Configures the hypervisor's stage-1 view of the send and receive pages. The
648 * stage-1 page tables must be locked so memory cannot be taken by another core
649 * which could result in this transaction being unable to roll back in the case
650 * of an error.
651 */
652static bool api_vm_configure_stage1(struct vm_locked vm_locked,
653 paddr_t pa_send_begin, paddr_t pa_send_end,
654 paddr_t pa_recv_begin, paddr_t pa_recv_end,
655 struct mpool *local_page_pool)
656{
657 bool ret;
658 struct mm_stage1_locked mm_stage1_locked = mm_lock_stage1();
659
660 /* Map the send page as read-only in the hypervisor address space. */
661 vm_locked.vm->mailbox.send =
662 mm_identity_map(mm_stage1_locked, pa_send_begin, pa_send_end,
663 MM_MODE_R, local_page_pool);
664 if (!vm_locked.vm->mailbox.send) {
665 /* TODO: partial defrag of failed range. */
666 /* Recover any memory consumed in failed mapping. */
667 mm_defrag(mm_stage1_locked, local_page_pool);
668 goto fail;
669 }
670
671 /*
672 * Map the receive page as writable in the hypervisor address space. On
673 * failure, unmap the send page before returning.
674 */
675 vm_locked.vm->mailbox.recv =
676 mm_identity_map(mm_stage1_locked, pa_recv_begin, pa_recv_end,
677 MM_MODE_W, local_page_pool);
678 if (!vm_locked.vm->mailbox.recv) {
679 /* TODO: partial defrag of failed range. */
680 /* Recover any memory consumed in failed mapping. */
681 mm_defrag(mm_stage1_locked, local_page_pool);
682 goto fail_undo_send;
683 }
684
685 ret = true;
686 goto out;
687
688 /*
689 * The following mappings will not require more memory than is available
690 * in the local pool.
691 */
692fail_undo_send:
693 vm_locked.vm->mailbox.send = NULL;
Andrew Scull7e8de322019-07-02 13:00:56 +0100694 CHECK(mm_unmap(mm_stage1_locked, pa_send_begin, pa_send_end,
695 local_page_pool));
Andrew Sculle1322792019-07-01 17:46:10 +0100696
697fail:
698 ret = false;
699
700out:
701 mm_unlock_stage1(&mm_stage1_locked);
702
703 return ret;
704}
705
706/**
707 * Configures the send and receive pages in the VM stage-2 and hypervisor
708 * stage-1 page tables. Locking of the page tables combined with a local memory
709 * pool ensures there will always be enough memory to recover from any errors
710 * that arise.
711 */
712static bool api_vm_configure_pages(struct vm_locked vm_locked,
713 paddr_t pa_send_begin, paddr_t pa_send_end,
Andrew Walbran1281ed42019-10-22 17:23:40 +0100714 uint32_t orig_send_mode,
715 paddr_t pa_recv_begin, paddr_t pa_recv_end,
716 uint32_t orig_recv_mode)
Andrew Sculle1322792019-07-01 17:46:10 +0100717{
718 bool ret;
719 struct mpool local_page_pool;
720
721 /*
722 * Create a local pool so any freed memory can't be used by another
723 * thread. This is to ensure the original mapping can be restored if any
724 * stage of the process fails.
725 */
726 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
727
728 /* Take memory ownership away from the VM and mark as shared. */
Andrew Scull3c257452019-11-26 13:32:50 +0000729 if (!vm_identity_map(
730 vm_locked, pa_send_begin, pa_send_end,
Andrew Sculle1322792019-07-01 17:46:10 +0100731 MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R | MM_MODE_W,
Andrew Walbran8ec2b9f2019-11-25 15:05:40 +0000732 &local_page_pool, NULL)) {
Andrew Sculle1322792019-07-01 17:46:10 +0100733 goto fail;
734 }
735
Andrew Scull3c257452019-11-26 13:32:50 +0000736 if (!vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
737 MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R,
738 &local_page_pool, NULL)) {
Andrew Sculle1322792019-07-01 17:46:10 +0100739 /* TODO: partial defrag of failed range. */
740 /* Recover any memory consumed in failed mapping. */
741 mm_vm_defrag(&vm_locked.vm->ptable, &local_page_pool);
742 goto fail_undo_send;
743 }
744
745 if (!api_vm_configure_stage1(vm_locked, pa_send_begin, pa_send_end,
746 pa_recv_begin, pa_recv_end,
747 &local_page_pool)) {
748 goto fail_undo_send_and_recv;
749 }
750
751 ret = true;
752 goto out;
753
754 /*
755 * The following mappings will not require more memory than is available
756 * in the local pool.
757 */
758fail_undo_send_and_recv:
Andrew Scull3c257452019-11-26 13:32:50 +0000759 CHECK(vm_identity_map(vm_locked, pa_recv_begin, pa_recv_end,
760 orig_recv_mode, &local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +0100761
762fail_undo_send:
Andrew Scull3c257452019-11-26 13:32:50 +0000763 CHECK(vm_identity_map(vm_locked, pa_send_begin, pa_send_end,
764 orig_send_mode, &local_page_pool, NULL));
Andrew Sculle1322792019-07-01 17:46:10 +0100765
766fail:
767 ret = false;
768
769out:
770 mpool_fini(&local_page_pool);
771
772 return ret;
773}
774
775/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100776 * Configures the VM to send/receive data through the specified pages. The pages
777 * must not be shared.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000778 *
779 * Returns:
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000780 * - SPCI_ERROR SPCI_INVALID_PARAMETERS if the given addresses are not properly
781 * aligned or are the same.
782 * - SPCI_ERROR SPCI_NO_MEMORY if the hypervisor was unable to map the buffers
783 * due to insuffient page table memory.
784 * - SPCI_ERROR SPCI_DENIED if the pages are already mapped or are not owned by
785 * the caller.
786 * - SPCI_SUCCESS on success if no further action is needed.
787 * - SPCI_RX_RELEASE if it was called by the primary VM and the primary VM now
788 * needs to wake up or kick waiters.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100789 */
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000790struct spci_value api_spci_rxtx_map(ipaddr_t send, ipaddr_t recv,
791 uint32_t page_count, struct vcpu *current,
792 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100793{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100794 struct vm *vm = current->vm;
Andrew Sculle1322792019-07-01 17:46:10 +0100795 struct vm_locked vm_locked;
Andrew Scull80871322018-08-06 12:04:09 +0100796 paddr_t pa_send_begin;
797 paddr_t pa_send_end;
798 paddr_t pa_recv_begin;
799 paddr_t pa_recv_end;
Andrew Walbran1281ed42019-10-22 17:23:40 +0100800 uint32_t orig_send_mode;
801 uint32_t orig_recv_mode;
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000802 struct spci_value ret;
803
804 /* Hafnium only supports a fixed size of RX/TX buffers. */
805 if (page_count != HF_MAILBOX_SIZE / SPCI_PAGE_SIZE) {
806 return spci_error(SPCI_INVALID_PARAMETERS);
807 }
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100808
809 /* Fail if addresses are not page-aligned. */
Alfredo Mazzinghieb1997c2019-02-07 18:00:01 +0000810 if (!is_aligned(ipa_addr(send), PAGE_SIZE) ||
811 !is_aligned(ipa_addr(recv), PAGE_SIZE)) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000812 return spci_error(SPCI_INVALID_PARAMETERS);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100813 }
814
Andrew Scullc2eb6a32018-12-13 16:54:24 +0000815 /* Convert to physical addresses. */
816 pa_send_begin = pa_from_ipa(send);
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000817 pa_send_end = pa_add(pa_send_begin, HF_MAILBOX_SIZE);
Andrew Scullc2eb6a32018-12-13 16:54:24 +0000818
819 pa_recv_begin = pa_from_ipa(recv);
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000820 pa_recv_end = pa_add(pa_recv_begin, HF_MAILBOX_SIZE);
Andrew Scullc2eb6a32018-12-13 16:54:24 +0000821
Andrew Scullc9ccb3f2018-08-13 15:27:12 +0100822 /* Fail if the same page is used for the send and receive pages. */
823 if (pa_addr(pa_send_begin) == pa_addr(pa_recv_begin)) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000824 return spci_error(SPCI_INVALID_PARAMETERS);
Andrew Scull220e6212018-12-21 18:09:00 +0000825 }
826
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100827 /*
828 * The hypervisor's memory map must be locked for the duration of this
829 * operation to ensure there will be sufficient memory to recover from
830 * any failures.
831 *
832 * TODO: the scope of the can be reduced but will require restructuring
833 * to keep a single unlock point.
834 */
Andrew Sculle1322792019-07-01 17:46:10 +0100835 vm_locked = vm_lock(vm);
Andrew Scull220e6212018-12-21 18:09:00 +0000836
837 /* We only allow these to be setup once. */
838 if (vm->mailbox.send || vm->mailbox.recv) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000839 ret = spci_error(SPCI_DENIED);
840 goto exit;
Andrew Scull220e6212018-12-21 18:09:00 +0000841 }
842
843 /*
844 * Ensure the pages are valid, owned and exclusive to the VM and that
845 * the VM has the required access to the memory.
846 */
847 if (!mm_vm_get_mode(&vm->ptable, send, ipa_add(send, PAGE_SIZE),
848 &orig_send_mode) ||
849 !api_mode_valid_owned_and_exclusive(orig_send_mode) ||
850 (orig_send_mode & MM_MODE_R) == 0 ||
851 (orig_send_mode & MM_MODE_W) == 0) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000852 ret = spci_error(SPCI_DENIED);
853 goto exit;
Andrew Scull220e6212018-12-21 18:09:00 +0000854 }
855
856 if (!mm_vm_get_mode(&vm->ptable, recv, ipa_add(recv, PAGE_SIZE),
857 &orig_recv_mode) ||
858 !api_mode_valid_owned_and_exclusive(orig_recv_mode) ||
859 (orig_recv_mode & MM_MODE_R) == 0) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000860 ret = spci_error(SPCI_DENIED);
861 goto exit;
Andrew Scull220e6212018-12-21 18:09:00 +0000862 }
863
Andrew Sculle1322792019-07-01 17:46:10 +0100864 if (!api_vm_configure_pages(vm_locked, pa_send_begin, pa_send_end,
865 orig_send_mode, pa_recv_begin, pa_recv_end,
866 orig_recv_mode)) {
Andrew Walbranbfffb0f2019-11-05 14:02:34 +0000867 ret = spci_error(SPCI_NO_MEMORY);
868 goto exit;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100869 }
870
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000871 /* Tell caller about waiters, if any. */
Andrew Sculle1322792019-07-01 17:46:10 +0100872 ret = api_waiter_result(vm_locked, current, next);
Andrew Scull220e6212018-12-21 18:09:00 +0000873
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100874exit:
Andrew Sculle1322792019-07-01 17:46:10 +0100875 vm_unlock(&vm_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100876
877 return ret;
878}
879
880/**
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100881 * Checks whether the given `to` VM's mailbox is currently busy, and optionally
882 * registers the `from` VM to be notified when it becomes available.
883 */
Andrew Walbranf76f5752019-12-03 18:33:08 +0000884static bool msg_receiver_busy(struct vm_locked to, struct vm *from, bool notify)
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100885{
886 if (to.vm->mailbox.state != MAILBOX_STATE_EMPTY ||
887 to.vm->mailbox.recv == NULL) {
888 /*
889 * Fail if the receiver isn't currently ready to receive data,
890 * setting up for notification if requested.
891 */
892 if (notify) {
893 struct wait_entry *entry =
Andrew Walbranaad8f982019-12-04 10:56:39 +0000894 vm_get_wait_entry(from, to.vm->id);
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100895
896 /* Append waiter only if it's not there yet. */
897 if (list_empty(&entry->wait_links)) {
898 list_append(&to.vm->mailbox.waiter_list,
899 &entry->wait_links);
900 }
901 }
902
903 return true;
904 }
905
906 return false;
907}
908
909/**
910 * Notifies the `to` VM about the message currently in its mailbox, possibly
911 * with the help of the primary VM.
912 */
Andrew Walbran2619e0a2020-01-10 16:37:50 +0000913static struct spci_value deliver_msg(struct vm_locked to, spci_vm_id_t from_id,
914 struct vcpu *current, struct vcpu **next)
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100915{
Andrew Walbran2619e0a2020-01-10 16:37:50 +0000916 struct spci_value ret = (struct spci_value){.func = SPCI_SUCCESS_32};
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +0100917 struct spci_value primary_ret = {
918 .func = SPCI_MSG_SEND_32,
Andrew Walbranf76f5752019-12-03 18:33:08 +0000919 .arg1 = ((uint32_t)from_id << 16) | to.vm->id,
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100920 };
921
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100922 /* Messages for the primary VM are delivered directly. */
923 if (to.vm->id == HF_PRIMARY_VM_ID) {
924 /*
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000925 * Only tell the primary VM the size and other details if the
926 * message is for it, to avoid leaking data about messages for
927 * other VMs.
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100928 */
Andrew Walbrane7ad3c02019-12-24 17:03:04 +0000929 primary_ret = spci_msg_recv_return(to.vm);
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100930
931 to.vm->mailbox.state = MAILBOX_STATE_READ;
932 *next = api_switch_to_primary(current, primary_ret,
933 VCPU_STATE_READY);
Andrew Walbran2619e0a2020-01-10 16:37:50 +0000934 return ret;
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100935 }
936
937 to.vm->mailbox.state = MAILBOX_STATE_RECEIVED;
938
Andrew Walbran2619e0a2020-01-10 16:37:50 +0000939 /* Messages for the TEE are sent on via the dispatcher. */
940 if (to.vm->id == HF_TEE_VM_ID) {
941 struct spci_value call = spci_msg_recv_return(to.vm);
942
943 return arch_tee_call(call);
944 /*
945 * Don't return to the primary VM in this case, as the TEE is
946 * not (yet) scheduled via SPCI.
947 */
948 }
949
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100950 /* Return to the primary VM directly or with a switch. */
Andrew Walbranf76f5752019-12-03 18:33:08 +0000951 if (from_id != HF_PRIMARY_VM_ID) {
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100952 *next = api_switch_to_primary(current, primary_ret,
953 VCPU_STATE_READY);
954 }
Andrew Walbran2619e0a2020-01-10 16:37:50 +0000955
956 return ret;
Andrew Walbrane0f575f2019-10-16 16:00:12 +0100957}
958
959/**
Andrew Scullaa039b32018-10-04 15:02:26 +0100960 * Copies data from the sender's send buffer to the recipient's receive buffer
961 * and notifies the recipient.
Wedson Almeida Filho17c997f2019-01-09 18:50:09 +0000962 *
963 * If the recipient's receive buffer is busy, it can optionally register the
964 * caller to be notified when the recipient's receive buffer becomes available.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100965 */
Andrew Walbran70bc8622019-10-07 14:15:58 +0100966struct spci_value api_spci_msg_send(spci_vm_id_t sender_vm_id,
967 spci_vm_id_t receiver_vm_id, uint32_t size,
968 uint32_t attributes, struct vcpu *current,
969 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100970{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100971 struct vm *from = current->vm;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100972 struct vm *to;
Andrew Walbran82d6d152019-12-24 15:02:06 +0000973 struct vm_locked to_locked;
Andrew Walbran70bc8622019-10-07 14:15:58 +0100974 const void *from_msg;
Andrew Walbran70bc8622019-10-07 14:15:58 +0100975 struct spci_value ret;
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000976 bool notify = (attributes & SPCI_MSG_SEND_NOTIFY_MASK) ==
977 SPCI_MSG_SEND_NOTIFY;
Andrew Scull19503262018-09-20 14:48:39 +0100978
Andrew Walbran70bc8622019-10-07 14:15:58 +0100979 /* Ensure sender VM ID corresponds to the current VM. */
980 if (sender_vm_id != from->id) {
981 return spci_error(SPCI_INVALID_PARAMETERS);
982 }
983
984 /* Disallow reflexive requests as this suggests an error in the VM. */
985 if (receiver_vm_id == from->id) {
986 return spci_error(SPCI_INVALID_PARAMETERS);
987 }
988
989 /* Limit the size of transfer. */
990 if (size > SPCI_MSG_PAYLOAD_MAX) {
991 return spci_error(SPCI_INVALID_PARAMETERS);
992 }
993
Andrew Walbran0b60c4f2019-12-10 17:05:29 +0000994 /* Ensure the receiver VM exists. */
995 to = vm_find(receiver_vm_id);
996 if (to == NULL) {
997 return spci_error(SPCI_INVALID_PARAMETERS);
998 }
999
Jose Marinhoa1dfeda2019-02-27 16:46:03 +00001000 /*
Andrew Walbran70bc8622019-10-07 14:15:58 +01001001 * Check that the sender has configured its send buffer. If the tx
1002 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
1003 * be safely accessed after releasing the lock since the tx mailbox
1004 * address can only be configured once.
Jose Marinhoa1dfeda2019-02-27 16:46:03 +00001005 */
1006 sl_lock(&from->lock);
1007 from_msg = from->mailbox.send;
1008 sl_unlock(&from->lock);
1009
1010 if (from_msg == NULL) {
Andrew Walbran70bc8622019-10-07 14:15:58 +01001011 return spci_error(SPCI_INVALID_PARAMETERS);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001012 }
1013
Andrew Walbran82d6d152019-12-24 15:02:06 +00001014 to_locked = vm_lock(to);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001015
Andrew Walbran82d6d152019-12-24 15:02:06 +00001016 if (msg_receiver_busy(to_locked, from, notify)) {
Andrew Walbran70bc8622019-10-07 14:15:58 +01001017 ret = spci_error(SPCI_BUSY);
Andrew Scullaa039b32018-10-04 15:02:26 +01001018 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001019 }
1020
Andrew Walbran82d6d152019-12-24 15:02:06 +00001021 /* Copy data. */
1022 memcpy_s(to->mailbox.recv, SPCI_MSG_PAYLOAD_MAX, from_msg, size);
1023 to->mailbox.recv_size = size;
1024 to->mailbox.recv_sender = sender_vm_id;
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001025 to->mailbox.recv_func = SPCI_MSG_SEND_32;
Andrew Walbran2619e0a2020-01-10 16:37:50 +00001026 ret = deliver_msg(to_locked, sender_vm_id, current, next);
Andrew Scullaa039b32018-10-04 15:02:26 +01001027
1028out:
Andrew Walbran82d6d152019-12-24 15:02:06 +00001029 vm_unlock(&to_locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001030
Wedson Almeida Filho80eb4a32018-11-30 17:11:15 +00001031 return ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001032}
1033
1034/**
Andrew Scullec52ddf2019-08-20 10:41:01 +01001035 * Checks whether the vCPU's attempt to block for a message has already been
1036 * interrupted or whether it is allowed to block.
1037 */
1038bool api_spci_msg_recv_block_interrupted(struct vcpu *current)
1039{
1040 bool interrupted;
1041
1042 sl_lock(&current->lock);
1043
1044 /*
1045 * Don't block if there are enabled and pending interrupts, to match
1046 * behaviour of wait_for_interrupt.
1047 */
1048 interrupted = (current->interrupts.enabled_and_pending_count > 0);
1049
1050 sl_unlock(&current->lock);
1051
1052 return interrupted;
1053}
1054
1055/**
Andrew Scullaa039b32018-10-04 15:02:26 +01001056 * Receives a message from the mailbox. If one isn't available, this function
1057 * can optionally block the caller until one becomes available.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001058 *
Andrew Scullaa039b32018-10-04 15:02:26 +01001059 * No new messages can be received until the mailbox has been cleared.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001060 */
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001061struct spci_value api_spci_msg_recv(bool block, struct vcpu *current,
1062 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001063{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +01001064 struct vm *vm = current->vm;
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001065 struct spci_value return_code;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001066
Andrew Scullaa039b32018-10-04 15:02:26 +01001067 /*
1068 * The primary VM will receive messages as a status code from running
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001069 * vCPUs and must not call this function.
Andrew Scullaa039b32018-10-04 15:02:26 +01001070 */
Andrew Scull19503262018-09-20 14:48:39 +01001071 if (vm->id == HF_PRIMARY_VM_ID) {
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001072 return spci_error(SPCI_NOT_SUPPORTED);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001073 }
1074
1075 sl_lock(&vm->lock);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001076
Andrew Scullaa039b32018-10-04 15:02:26 +01001077 /* Return pending messages without blocking. */
Andrew Sculld6ee1102019-04-05 22:12:42 +01001078 if (vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
1079 vm->mailbox.state = MAILBOX_STATE_READ;
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001080 return_code = spci_msg_recv_return(vm);
Jose Marinho3e2442f2019-03-12 13:30:37 +00001081 goto out;
1082 }
1083
1084 /* No pending message so fail if not allowed to block. */
1085 if (!block) {
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001086 return_code = spci_error(SPCI_RETRY);
Andrew Scullaa039b32018-10-04 15:02:26 +01001087 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001088 }
Andrew Scullaa039b32018-10-04 15:02:26 +01001089
Andrew Walbran9311c9a2019-03-12 16:59:04 +00001090 /*
Jose Marinho3e2442f2019-03-12 13:30:37 +00001091 * From this point onward this call can only be interrupted or a message
1092 * received. If a message is received the return value will be set at
1093 * that time to SPCI_SUCCESS.
Andrew Walbran9311c9a2019-03-12 16:59:04 +00001094 */
Andrew Walbrand4d2fa12019-10-01 16:47:25 +01001095 return_code = spci_error(SPCI_INTERRUPTED);
Andrew Scullec52ddf2019-08-20 10:41:01 +01001096 if (api_spci_msg_recv_block_interrupted(current)) {
Andrew Scullaa039b32018-10-04 15:02:26 +01001097 goto out;
1098 }
1099
Fuad Tabbaed294af2019-12-20 10:43:01 +00001100 /* Switch back to primary VM to block. */
Andrew Walbranb4816552018-12-05 17:35:42 +00001101 {
Andrew Walbran7a1ea0b2019-10-02 18:18:44 +01001102 struct spci_value run_return = {
1103 .func = SPCI_MSG_WAIT_32,
Andrew Walbran4db5f3a2019-11-04 11:42:42 +00001104 .arg1 = spci_vm_vcpu(vm->id, vcpu_index(current)),
Andrew Walbranb4816552018-12-05 17:35:42 +00001105 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001106
Andrew Walbranb4816552018-12-05 17:35:42 +00001107 *next = api_switch_to_primary(current, run_return,
Andrew Sculld6ee1102019-04-05 22:12:42 +01001108 VCPU_STATE_BLOCKED_MAILBOX);
Andrew Walbranb4816552018-12-05 17:35:42 +00001109 }
Andrew Scullaa039b32018-10-04 15:02:26 +01001110out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001111 sl_unlock(&vm->lock);
1112
Jose Marinho3e2442f2019-03-12 13:30:37 +00001113 return return_code;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001114}
1115
1116/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001117 * Retrieves the next VM whose mailbox became writable. For a VM to be notified
1118 * by this function, the caller must have called api_mailbox_send before with
1119 * the notify argument set to true, and this call must have failed because the
1120 * mailbox was not available.
1121 *
1122 * It should be called repeatedly to retrieve a list of VMs.
1123 *
1124 * Returns -1 if no VM became writable, or the id of the VM whose mailbox
1125 * became writable.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001126 */
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001127int64_t api_mailbox_writable_get(const struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001128{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +01001129 struct vm *vm = current->vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001130 struct wait_entry *entry;
Andrew Scullc0e569a2018-10-02 18:05:21 +01001131 int64_t ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001132
1133 sl_lock(&vm->lock);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001134 if (list_empty(&vm->mailbox.ready_list)) {
1135 ret = -1;
1136 goto exit;
1137 }
1138
1139 entry = CONTAINER_OF(vm->mailbox.ready_list.next, struct wait_entry,
1140 ready_links);
1141 list_remove(&entry->ready_links);
Andrew Walbranaad8f982019-12-04 10:56:39 +00001142 ret = vm_id_for_wait_entry(vm, entry);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001143
1144exit:
1145 sl_unlock(&vm->lock);
1146 return ret;
1147}
1148
1149/**
1150 * Retrieves the next VM waiting to be notified that the mailbox of the
1151 * specified VM became writable. Only primary VMs are allowed to call this.
1152 *
Wedson Almeida Filhob790f652019-01-22 23:41:56 +00001153 * Returns -1 on failure or if there are no waiters; the VM id of the next
1154 * waiter otherwise.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001155 */
Andrew Walbran42347a92019-05-09 13:59:03 +01001156int64_t api_mailbox_waiter_get(spci_vm_id_t vm_id, const struct vcpu *current)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001157{
1158 struct vm *vm;
1159 struct vm_locked locked;
1160 struct wait_entry *entry;
1161 struct vm *waiting_vm;
1162
1163 /* Only primary VMs are allowed to call this function. */
1164 if (current->vm->id != HF_PRIMARY_VM_ID) {
1165 return -1;
1166 }
1167
Andrew Walbran42347a92019-05-09 13:59:03 +01001168 vm = vm_find(vm_id);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001169 if (vm == NULL) {
1170 return -1;
1171 }
1172
Fuad Tabbaed294af2019-12-20 10:43:01 +00001173 /* Check if there are outstanding notifications from given VM. */
Andrew Walbran7e932bd2019-04-29 16:47:06 +01001174 locked = vm_lock(vm);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001175 entry = api_fetch_waiter(locked);
1176 vm_unlock(&locked);
1177
1178 if (entry == NULL) {
1179 return -1;
1180 }
1181
1182 /* Enqueue notification to waiting VM. */
1183 waiting_vm = entry->waiting_vm;
1184
1185 sl_lock(&waiting_vm->lock);
1186 if (list_empty(&entry->ready_links)) {
1187 list_append(&waiting_vm->mailbox.ready_list,
1188 &entry->ready_links);
1189 }
1190 sl_unlock(&waiting_vm->lock);
1191
1192 return waiting_vm->id;
1193}
1194
1195/**
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00001196 * Releases the caller's mailbox so that a new message can be received. The
1197 * caller must have copied out all data they wish to preserve as new messages
1198 * will overwrite the old and will arrive asynchronously.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001199 *
1200 * Returns:
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00001201 * - SPCI_ERROR SPCI_DENIED on failure, if the mailbox hasn't been read.
1202 * - SPCI_SUCCESS on success if no further action is needed.
1203 * - SPCI_RX_RELEASE if it was called by the primary VM and the primary VM now
1204 * needs to wake up or kick waiters. Waiters should be retrieved by calling
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001205 * hf_mailbox_waiter_get.
1206 */
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00001207struct spci_value api_spci_rx_release(struct vcpu *current, struct vcpu **next)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001208{
1209 struct vm *vm = current->vm;
1210 struct vm_locked locked;
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00001211 struct spci_value ret;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001212
Andrew Walbran7e932bd2019-04-29 16:47:06 +01001213 locked = vm_lock(vm);
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001214 switch (vm->mailbox.state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +01001215 case MAILBOX_STATE_EMPTY:
Andrew Sculld6ee1102019-04-05 22:12:42 +01001216 case MAILBOX_STATE_RECEIVED:
Andrew Walbran8a0f5ca2019-11-05 13:12:23 +00001217 ret = spci_error(SPCI_DENIED);
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001218 break;
1219
Andrew Sculld6ee1102019-04-05 22:12:42 +01001220 case MAILBOX_STATE_READ:
Andrew Walbranbfffb0f2019-11-05 14:02:34 +00001221 ret = api_waiter_result(locked, current, next);
Andrew Sculld6ee1102019-04-05 22:12:42 +01001222 vm->mailbox.state = MAILBOX_STATE_EMPTY;
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001223 break;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001224 }
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001225 vm_unlock(&locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001226
1227 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001228}
Andrew Walbran318f5732018-11-20 16:23:42 +00001229
1230/**
1231 * Enables or disables a given interrupt ID for the calling vCPU.
1232 *
1233 * Returns 0 on success, or -1 if the intid is invalid.
1234 */
Wedson Almeida Filhoc559d132019-01-09 19:33:40 +00001235int64_t api_interrupt_enable(uint32_t intid, bool enable, struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00001236{
1237 uint32_t intid_index = intid / INTERRUPT_REGISTER_BITS;
Andrew Walbrane52006c2019-10-22 18:01:28 +01001238 uint32_t intid_mask = 1U << (intid % INTERRUPT_REGISTER_BITS);
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001239
Andrew Walbran318f5732018-11-20 16:23:42 +00001240 if (intid >= HF_NUM_INTIDS) {
1241 return -1;
1242 }
1243
1244 sl_lock(&current->lock);
1245 if (enable) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001246 /*
1247 * If it is pending and was not enabled before, increment the
1248 * count.
1249 */
1250 if (current->interrupts.interrupt_pending[intid_index] &
1251 ~current->interrupts.interrupt_enabled[intid_index] &
1252 intid_mask) {
1253 current->interrupts.enabled_and_pending_count++;
1254 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001255 current->interrupts.interrupt_enabled[intid_index] |=
1256 intid_mask;
Andrew Walbran318f5732018-11-20 16:23:42 +00001257 } else {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001258 /*
1259 * If it is pending and was enabled before, decrement the count.
1260 */
1261 if (current->interrupts.interrupt_pending[intid_index] &
1262 current->interrupts.interrupt_enabled[intid_index] &
1263 intid_mask) {
1264 current->interrupts.enabled_and_pending_count--;
1265 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001266 current->interrupts.interrupt_enabled[intid_index] &=
1267 ~intid_mask;
1268 }
1269
1270 sl_unlock(&current->lock);
1271 return 0;
1272}
1273
1274/**
1275 * Returns the ID of the next pending interrupt for the calling vCPU, and
1276 * acknowledges it (i.e. marks it as no longer pending). Returns
1277 * HF_INVALID_INTID if there are no pending interrupts.
1278 */
Wedson Almeida Filhoc559d132019-01-09 19:33:40 +00001279uint32_t api_interrupt_get(struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00001280{
1281 uint8_t i;
1282 uint32_t first_interrupt = HF_INVALID_INTID;
Andrew Walbran318f5732018-11-20 16:23:42 +00001283
1284 /*
1285 * Find the first enabled and pending interrupt ID, return it, and
1286 * deactivate it.
1287 */
1288 sl_lock(&current->lock);
1289 for (i = 0; i < HF_NUM_INTIDS / INTERRUPT_REGISTER_BITS; ++i) {
1290 uint32_t enabled_and_pending =
1291 current->interrupts.interrupt_enabled[i] &
1292 current->interrupts.interrupt_pending[i];
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001293
Andrew Walbran318f5732018-11-20 16:23:42 +00001294 if (enabled_and_pending != 0) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001295 uint8_t bit_index = ctz(enabled_and_pending);
1296 /*
1297 * Mark it as no longer pending and decrement the count.
1298 */
1299 current->interrupts.interrupt_pending[i] &=
Andrew Walbrane52006c2019-10-22 18:01:28 +01001300 ~(1U << bit_index);
Andrew Walbran3d84a262018-12-13 14:41:19 +00001301 current->interrupts.enabled_and_pending_count--;
1302 first_interrupt =
1303 i * INTERRUPT_REGISTER_BITS + bit_index;
Andrew Walbran318f5732018-11-20 16:23:42 +00001304 break;
1305 }
1306 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001307
1308 sl_unlock(&current->lock);
1309 return first_interrupt;
1310}
1311
1312/**
Andrew Walbran4cf217a2018-12-14 15:24:50 +00001313 * Returns whether the current vCPU is allowed to inject an interrupt into the
Andrew Walbran318f5732018-11-20 16:23:42 +00001314 * given VM and vCPU.
1315 */
1316static inline bool is_injection_allowed(uint32_t target_vm_id,
1317 struct vcpu *current)
1318{
1319 uint32_t current_vm_id = current->vm->id;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001320
Andrew Walbran318f5732018-11-20 16:23:42 +00001321 /*
1322 * The primary VM is allowed to inject interrupts into any VM. Secondary
1323 * VMs are only allowed to inject interrupts into their own vCPUs.
1324 */
1325 return current_vm_id == HF_PRIMARY_VM_ID ||
1326 current_vm_id == target_vm_id;
1327}
1328
1329/**
1330 * Injects a virtual interrupt of the given ID into the given target vCPU.
1331 * This doesn't cause the vCPU to actually be run immediately; it will be taken
1332 * when the vCPU is next run, which is up to the scheduler.
1333 *
Andrew Walbran3d84a262018-12-13 14:41:19 +00001334 * Returns:
1335 * - -1 on failure because the target VM or vCPU doesn't exist, the interrupt
1336 * ID is invalid, or the current VM is not allowed to inject interrupts to
1337 * the target VM.
1338 * - 0 on success if no further action is needed.
1339 * - 1 if it was called by the primary VM and the primary VM now needs to wake
1340 * up or kick the target vCPU.
Andrew Walbran318f5732018-11-20 16:23:42 +00001341 */
Andrew Walbran42347a92019-05-09 13:59:03 +01001342int64_t api_interrupt_inject(spci_vm_id_t target_vm_id,
Andrew Walbranb037d5b2019-06-25 17:19:41 +01001343 spci_vcpu_index_t target_vcpu_idx, uint32_t intid,
Andrew Walbran42347a92019-05-09 13:59:03 +01001344 struct vcpu *current, struct vcpu **next)
Andrew Walbran318f5732018-11-20 16:23:42 +00001345{
Andrew Walbran318f5732018-11-20 16:23:42 +00001346 struct vcpu *target_vcpu;
Andrew Walbran42347a92019-05-09 13:59:03 +01001347 struct vm *target_vm = vm_find(target_vm_id);
Andrew Walbran318f5732018-11-20 16:23:42 +00001348
1349 if (intid >= HF_NUM_INTIDS) {
1350 return -1;
1351 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001352
Andrew Walbran318f5732018-11-20 16:23:42 +00001353 if (target_vm == NULL) {
1354 return -1;
1355 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001356
Andrew Walbran318f5732018-11-20 16:23:42 +00001357 if (target_vcpu_idx >= target_vm->vcpu_count) {
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001358 /* The requested vCPU must exist. */
Andrew Walbran318f5732018-11-20 16:23:42 +00001359 return -1;
1360 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001361
Andrew Walbran318f5732018-11-20 16:23:42 +00001362 if (!is_injection_allowed(target_vm_id, current)) {
1363 return -1;
1364 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001365
Andrew Walbrane1310df2019-04-29 17:28:28 +01001366 target_vcpu = vm_get_vcpu(target_vm, target_vcpu_idx);
Andrew Walbran318f5732018-11-20 16:23:42 +00001367
Fuad Tabbab0ef2a42019-12-19 11:19:25 +00001368 dlog("Injecting IRQ %d for VM %d vCPU %d from VM %d vCPU %d\n", intid,
Andrew Walbran318f5732018-11-20 16:23:42 +00001369 target_vm_id, target_vcpu_idx, current->vm->id, current->cpu->id);
Andrew Walbranfc9d4382019-05-10 18:07:21 +01001370 return internal_interrupt_inject(target_vcpu, intid, current, next);
Andrew Walbran318f5732018-11-20 16:23:42 +00001371}
Andrew Scull6386f252018-12-06 13:29:10 +00001372
Jose Marinhofc0b2b62019-06-06 11:18:45 +01001373/** Returns the version of the implemented SPCI specification. */
Andrew Walbran7f920af2019-09-03 17:09:30 +01001374struct spci_value api_spci_version(void)
Jose Marinhofc0b2b62019-06-06 11:18:45 +01001375{
1376 /*
1377 * Ensure that both major and minor revision representation occupies at
1378 * most 15 bits.
1379 */
1380 static_assert(0x8000 > SPCI_VERSION_MAJOR,
1381 "Major revision representation take more than 15 bits.");
1382 static_assert(0x10000 > SPCI_VERSION_MINOR,
1383 "Minor revision representation take more than 16 bits.");
1384
Andrew Walbran7f920af2019-09-03 17:09:30 +01001385 struct spci_value ret = {
1386 .func = SPCI_SUCCESS_32,
Andrew Walbran455c53a2019-10-10 13:56:19 +01001387 .arg2 = (SPCI_VERSION_MAJOR << SPCI_VERSION_MAJOR_OFFSET) |
Andrew Walbran7f920af2019-09-03 17:09:30 +01001388 SPCI_VERSION_MINOR};
1389 return ret;
Jose Marinhofc0b2b62019-06-06 11:18:45 +01001390}
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01001391
1392int64_t api_debug_log(char c, struct vcpu *current)
1393{
Andrew Sculld54e1be2019-08-20 11:09:42 +01001394 bool flush;
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01001395 struct vm *vm = current->vm;
1396 struct vm_locked vm_locked = vm_lock(vm);
1397
Andrew Sculld54e1be2019-08-20 11:09:42 +01001398 if (c == '\n' || c == '\0') {
1399 flush = true;
1400 } else {
1401 vm->log_buffer[vm->log_buffer_length++] = c;
1402 flush = (vm->log_buffer_length == sizeof(vm->log_buffer));
1403 }
1404
1405 if (flush) {
Andrew Walbran7f904bf2019-07-12 16:38:38 +01001406 dlog_flush_vm_buffer(vm->id, vm->log_buffer,
1407 vm->log_buffer_length);
1408 vm->log_buffer_length = 0;
Andrew Walbranc1ad4ce2019-05-09 11:41:39 +01001409 }
1410
1411 vm_unlock(&vm_locked);
1412
1413 return 0;
1414}
Jose Marinhoc0f4ff22019-10-09 10:37:42 +01001415
1416/**
1417 * Discovery function returning information about the implementation of optional
1418 * SPCI interfaces.
1419 */
1420struct spci_value api_spci_features(uint32_t function_id)
1421{
1422 switch (function_id) {
1423 case SPCI_ERROR_32:
1424 case SPCI_SUCCESS_32:
1425 case SPCI_ID_GET_32:
1426 case SPCI_YIELD_32:
1427 case SPCI_VERSION_32:
1428 case SPCI_FEATURES_32:
1429 case SPCI_MSG_SEND_32:
1430 case SPCI_MSG_POLL_32:
1431 case SPCI_MSG_WAIT_32:
1432 return (struct spci_value){.func = SPCI_SUCCESS_32};
1433 default:
1434 return spci_error(SPCI_NOT_SUPPORTED);
1435 }
1436}
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001437
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001438struct spci_value api_spci_mem_send(uint32_t share_func, ipaddr_t address,
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001439 uint32_t page_count,
Andrew Walbran0f6cede2020-01-10 15:38:09 +00001440 uint32_t fragment_length, uint32_t length,
1441 uint32_t cookie, struct vcpu *current,
1442 struct vcpu **next)
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001443{
1444 struct vm *from = current->vm;
1445 struct vm *to;
1446 const void *from_msg;
1447 uint32_t message_buffer_size;
1448 struct spci_memory_region *memory_region;
1449 struct two_vm_locked vm_to_from_lock;
1450 struct spci_value ret;
1451
1452 if (ipa_addr(address) != 0 || page_count != 0) {
1453 /*
1454 * Hafnium only supports passing the descriptor in the TX
1455 * mailbox.
1456 */
1457 return spci_error(SPCI_INVALID_PARAMETERS);
1458 }
1459
Andrew Walbran0f6cede2020-01-10 15:38:09 +00001460 if ((cookie == 0) != (fragment_length == length)) {
1461 /* Cookie is required iff there are multiple fragments. */
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001462 return spci_error(SPCI_INVALID_PARAMETERS);
1463 }
1464
1465 /*
1466 * Check that the sender has configured its send buffer. If the TX
1467 * mailbox at from_msg is configured (i.e. from_msg != NULL) then it can
1468 * be safely accessed after releasing the lock since the TX mailbox
1469 * address can only be configured once.
1470 */
1471 sl_lock(&from->lock);
1472 from_msg = from->mailbox.send;
1473 sl_unlock(&from->lock);
1474
1475 if (from_msg == NULL) {
1476 return spci_error(SPCI_INVALID_PARAMETERS);
1477 }
1478
1479 /*
1480 * Copy the memory region descriptor to an internal buffer, so that the
1481 * sender can't change it underneath us.
1482 */
1483 memory_region =
Mahesh Bireddy8ca57862020-01-07 13:43:21 +05301484 (struct spci_memory_region *)cpu_get_buffer(current->cpu);
1485 message_buffer_size = cpu_get_buffer_size(current->cpu);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001486 if (length > HF_MAILBOX_SIZE || length > message_buffer_size) {
1487 return spci_error(SPCI_INVALID_PARAMETERS);
1488 }
1489 memcpy_s(memory_region, message_buffer_size, from_msg, length);
1490
1491 /* The sender must match the caller. */
1492 if (memory_region->sender != from->id) {
1493 return spci_error(SPCI_INVALID_PARAMETERS);
1494 }
1495
1496 if (memory_region->attribute_count != 1) {
1497 /* Hafnium doesn't support multi-way memory sharing for now. */
1498 return spci_error(SPCI_NOT_SUPPORTED);
1499 }
1500
1501 /*
1502 * Ensure that the receiver VM exists and isn't the same as the sender.
1503 */
1504 to = vm_find(memory_region->attributes[0].receiver);
1505 if (to == NULL || to == from) {
1506 return spci_error(SPCI_INVALID_PARAMETERS);
1507 }
1508
1509 vm_to_from_lock = vm_lock_both(to, from);
1510
1511 if (msg_receiver_busy(vm_to_from_lock.vm1, from, false)) {
1512 ret = spci_error(SPCI_BUSY);
1513 goto out;
1514 }
1515
1516 ret = spci_msg_handle_architected_message(
1517 vm_to_from_lock.vm1, vm_to_from_lock.vm2, memory_region, length,
Andrew Walbrane7ad3c02019-12-24 17:03:04 +00001518 share_func, &api_page_pool);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001519
1520 if (ret.func == SPCI_SUCCESS_32) {
Andrew Walbran2619e0a2020-01-10 16:37:50 +00001521 ret = deliver_msg(vm_to_from_lock.vm1, from->id, current, next);
Andrew Walbrane908c4a2019-12-02 17:13:47 +00001522 }
1523
1524out:
1525 vm_unlock(&vm_to_from_lock.vm1);
1526 vm_unlock(&vm_to_from_lock.vm2);
1527
1528 return ret;
1529}