blob: 9bd8f4e7d6ca06d320edad59c34f1fab85acd3f8 [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 Walbran508e63c2018-12-20 17:02:37 +000020#include "hf/arch/timer.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000021
Andrew Scull5c496a32019-04-04 11:57:33 +010022#include "hf/assert.h"
Andrew Walbran318f5732018-11-20 16:23:42 +000023#include "hf/dlog.h"
Andrew Scull6386f252018-12-06 13:29:10 +000024#include "hf/mm.h"
Andrew Walbranb037d5b2019-06-25 17:19:41 +010025#include "hf/spci.h"
Andrew Scull6386f252018-12-06 13:29:10 +000026#include "hf/spinlock.h"
Andrew Scull8d9e1212019-04-05 13:52:55 +010027#include "hf/std.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010028#include "hf/vm.h"
29
Andrew Scullf35a5c92018-08-07 18:09:46 +010030#include "vmapi/hf/call.h"
Jose Marinhoa1dfeda2019-02-27 16:46:03 +000031#include "vmapi/hf/spci.h"
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010032
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000033/*
34 * To eliminate the risk of deadlocks, we define a partial order for the
35 * acquisition of locks held concurrently by the same physical CPU. Our current
36 * ordering requirements are as follows:
37 *
Andrew Scull3c0a90a2019-07-01 11:55:53 +010038 * vm::stage1_locked -> vcpu::stage1_locked -> mm_stage1_lock
Andrew Scull6386f252018-12-06 13:29:10 +000039 *
Andrew Scull3c0a90a2019-07-01 11:55:53 +010040 * Locks of the same kind require the stage1_locked of lowest address to be
41 * locked first, see `sl_lock_both()`.
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000042 */
43
Andrew Scullaa039b32018-10-04 15:02:26 +010044static_assert(HF_MAILBOX_SIZE == PAGE_SIZE,
Andrew Scull13652af2018-09-17 14:49:08 +010045 "Currently, a page is mapped for the send and receive buffers so "
46 "the maximum request is the size of a page.");
47
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000048static struct mpool api_page_pool;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000049
50/**
Wedson Almeida Filho81568c42019-01-04 13:33:02 +000051 * Initialises the API page pool by taking ownership of the contents of the
52 * given page pool.
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000053 */
54void api_init(struct mpool *ppool)
55{
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000056 mpool_init_from(&api_page_pool, ppool);
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000057}
58
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +010059/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010060 * Switches the physical CPU back to the corresponding vcpu of the primary VM.
Andrew Scullaa039b32018-10-04 15:02:26 +010061 *
62 * This triggers the scheduling logic to run. Run in the context of secondary VM
63 * to cause HF_VCPU_RUN to return and the primary VM to regain control of the
64 * cpu.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010065 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +010066static struct vcpu *api_switch_to_primary(struct vcpu *current,
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000067 struct hf_vcpu_run_return primary_ret,
68 enum vcpu_state secondary_state)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010069{
Andrew Walbran42347a92019-05-09 13:59:03 +010070 struct vm *primary = vm_find(HF_PRIMARY_VM_ID);
Andrew Walbrane1310df2019-04-29 17:28:28 +010071 struct vcpu *next = vm_get_vcpu(primary, cpu_index(current->cpu));
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010072
Andrew Walbran508e63c2018-12-20 17:02:37 +000073 /*
74 * If the secondary is blocked but has a timer running, sleep until the
75 * timer fires rather than indefinitely.
76 */
Andrew Scullb06d1752019-02-04 10:15:48 +000077 switch (primary_ret.code) {
78 case HF_VCPU_RUN_WAIT_FOR_INTERRUPT:
79 case HF_VCPU_RUN_WAIT_FOR_MESSAGE:
80 primary_ret.sleep.ns =
81 arch_timer_enabled_current()
82 ? arch_timer_remaining_ns_current()
83 : HF_SLEEP_INDEFINITE;
84 break;
85
86 default:
87 /* Do nothing. */
88 break;
Andrew Walbran508e63c2018-12-20 17:02:37 +000089 }
90
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +010091 /* Set the return value for the primary VM's call to HF_VCPU_RUN. */
Andrew Scull6d2db332018-10-10 15:28:17 +010092 arch_regs_set_retval(&next->regs,
93 hf_vcpu_run_return_encode(primary_ret));
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +010094
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +000095 /* Mark the current vcpu as waiting. */
96 sl_lock(&current->lock);
97 current->state = secondary_state;
98 sl_unlock(&current->lock);
99
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100100 return next;
101}
102
103/**
Andrew Scull33fecd32019-01-08 14:48:27 +0000104 * Returns to the primary vm and signals that the vcpu still has work to do so.
105 */
106struct vcpu *api_preempt(struct vcpu *current)
107{
108 struct hf_vcpu_run_return ret = {
109 .code = HF_VCPU_RUN_PREEMPTED,
110 };
111
Andrew Sculld6ee1102019-04-05 22:12:42 +0100112 return api_switch_to_primary(current, ret, VCPU_STATE_READY);
Andrew Scull33fecd32019-01-08 14:48:27 +0000113}
114
115/**
Andrew Scullaa039b32018-10-04 15:02:26 +0100116 * Puts the current vcpu in wait for interrupt mode, and returns to the primary
117 * vm.
118 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100119struct vcpu *api_wait_for_interrupt(struct vcpu *current)
Andrew Scullaa039b32018-10-04 15:02:26 +0100120{
Andrew Scull6d2db332018-10-10 15:28:17 +0100121 struct hf_vcpu_run_return ret = {
122 .code = HF_VCPU_RUN_WAIT_FOR_INTERRUPT,
123 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000124
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000125 return api_switch_to_primary(current, ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100126 VCPU_STATE_BLOCKED_INTERRUPT);
Andrew Scullaa039b32018-10-04 15:02:26 +0100127}
128
129/**
Andrew Walbran33645652019-04-15 12:29:31 +0100130 * Puts the current vCPU in off mode, and returns to the primary VM.
131 */
132struct vcpu *api_vcpu_off(struct vcpu *current)
133{
134 struct hf_vcpu_run_return ret = {
135 .code = HF_VCPU_RUN_WAIT_FOR_INTERRUPT,
136 };
137
138 /*
139 * Disable the timer, so the scheduler doesn't get told to call back
140 * based on it.
141 */
142 arch_timer_disable_current();
143
144 return api_switch_to_primary(current, ret, VCPU_STATE_OFF);
145}
146
147/**
Andrew Scull66d62bf2019-02-01 13:54:10 +0000148 * Returns to the primary vm to allow this cpu to be used for other tasks as the
149 * vcpu does not have work to do at this moment. The current vcpu is marked as
Jose Marinho135dff32019-02-28 10:25:57 +0000150 * ready to be scheduled again. This SPCI function always returns SPCI_SUCCESS.
Andrew Scull66d62bf2019-02-01 13:54:10 +0000151 */
Jose Marinho135dff32019-02-28 10:25:57 +0000152int32_t api_spci_yield(struct vcpu *current, struct vcpu **next)
Andrew Scull66d62bf2019-02-01 13:54:10 +0000153{
154 struct hf_vcpu_run_return ret = {
155 .code = HF_VCPU_RUN_YIELD,
156 };
157
158 if (current->vm->id == HF_PRIMARY_VM_ID) {
Andrew Scullb06d1752019-02-04 10:15:48 +0000159 /* Noop on the primary as it makes the scheduling decisions. */
Jose Marinho135dff32019-02-28 10:25:57 +0000160 return SPCI_SUCCESS;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000161 }
162
Jose Marinho135dff32019-02-28 10:25:57 +0000163 *next = api_switch_to_primary(current, ret, VCPU_STATE_READY);
164
165 /* SPCI_YIELD always returns SPCI_SUCCESS. */
166 return SPCI_SUCCESS;
Andrew Scull66d62bf2019-02-01 13:54:10 +0000167}
168
169/**
Andrew Walbran33645652019-04-15 12:29:31 +0100170 * Switches to the primary so that it can switch to the target, or kick it if it
171 * is already running on a different physical CPU.
172 */
173struct vcpu *api_wake_up(struct vcpu *current, struct vcpu *target_vcpu)
174{
175 struct hf_vcpu_run_return ret = {
176 .code = HF_VCPU_RUN_WAKE_UP,
177 .wake_up.vm_id = target_vcpu->vm->id,
178 .wake_up.vcpu = vcpu_index(target_vcpu),
179 };
180 return api_switch_to_primary(current, ret, VCPU_STATE_READY);
181}
182
183/**
Andrew Scull38772ab2019-01-24 15:16:50 +0000184 * Aborts the vCPU and triggers its VM to abort fully.
Andrew Scull9726c252019-01-23 13:44:19 +0000185 */
186struct vcpu *api_abort(struct vcpu *current)
187{
188 struct hf_vcpu_run_return ret = {
189 .code = HF_VCPU_RUN_ABORTED,
190 };
191
192 dlog("Aborting VM %u vCPU %u\n", current->vm->id, vcpu_index(current));
193
194 if (current->vm->id == HF_PRIMARY_VM_ID) {
195 /* TODO: what to do when the primary aborts? */
196 for (;;) {
197 /* Do nothing. */
198 }
199 }
200
201 atomic_store_explicit(&current->vm->aborting, true,
202 memory_order_relaxed);
203
204 /* TODO: free resources once all vCPUs abort. */
205
Andrew Sculld6ee1102019-04-05 22:12:42 +0100206 return api_switch_to_primary(current, ret, VCPU_STATE_ABORTED);
Andrew Scull9726c252019-01-23 13:44:19 +0000207}
208
209/**
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000210 * Returns the ID of the VM.
211 */
Andrew Walbranfc6cd9d2019-06-25 15:23:27 +0100212spci_vm_id_t api_vm_get_id(const struct vcpu *current)
Andrew Scull55c4d8b2018-12-18 18:50:18 +0000213{
214 return current->vm->id;
215}
216
217/**
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100218 * Returns the number of VMs configured to run.
219 */
Andrew Walbran52d99672019-06-25 15:51:11 +0100220spci_vm_count_t api_vm_get_count(void)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100221{
Andrew Scull19503262018-09-20 14:48:39 +0100222 return vm_get_count();
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100223}
224
225/**
226 * Returns the number of vcpus configured in the given VM.
227 */
Andrew Walbran42347a92019-05-09 13:59:03 +0100228int64_t api_vcpu_get_count(spci_vm_id_t vm_id, const struct vcpu *current)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100229{
Andrew Scull19503262018-09-20 14:48:39 +0100230 struct vm *vm;
231
232 /* Only the primary VM needs to know about vcpus for scheduling. */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100233 if (current->vm->id != HF_PRIMARY_VM_ID) {
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100234 return -1;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100235 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100236
Andrew Walbran42347a92019-05-09 13:59:03 +0100237 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +0100238 if (vm == NULL) {
239 return -1;
240 }
241
242 return vm->vcpu_count;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100243}
244
245/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000246 * This function is called by the architecture-specific context switching
247 * function to indicate that register state for the given vcpu has been saved
248 * and can therefore be used by other pcpus.
249 */
250void api_regs_state_saved(struct vcpu *vcpu)
251{
252 sl_lock(&vcpu->lock);
253 vcpu->regs_available = true;
254 sl_unlock(&vcpu->lock);
255}
256
257/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000258 * Retrieves the next waiter and removes it from the wait list if the VM's
259 * mailbox is in a writable state.
260 */
261static struct wait_entry *api_fetch_waiter(struct vm_locked locked_vm)
262{
263 struct wait_entry *entry;
264 struct vm *vm = locked_vm.vm;
265
Andrew Sculld6ee1102019-04-05 22:12:42 +0100266 if (vm->mailbox.state != MAILBOX_STATE_EMPTY ||
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000267 vm->mailbox.recv == NULL || list_empty(&vm->mailbox.waiter_list)) {
268 /* The mailbox is not writable or there are no waiters. */
269 return NULL;
270 }
271
272 /* Remove waiter from the wait list. */
273 entry = CONTAINER_OF(vm->mailbox.waiter_list.next, struct wait_entry,
274 wait_links);
275 list_remove(&entry->wait_links);
276 return entry;
277}
278
279/**
Andrew Walbran508e63c2018-12-20 17:02:37 +0000280 * Assuming that the arguments have already been checked by the caller, injects
281 * a virtual interrupt of the given ID into the given target vCPU. This doesn't
282 * cause the vCPU to actually be run immediately; it will be taken when the vCPU
283 * is next run, which is up to the scheduler.
284 *
285 * Returns:
286 * - 0 on success if no further action is needed.
287 * - 1 if it was called by the primary VM and the primary VM now needs to wake
288 * up or kick the target vCPU.
289 */
Andrew Walbranfc9d4382019-05-10 18:07:21 +0100290static int64_t internal_interrupt_inject(struct vcpu *target_vcpu,
Andrew Walbran508e63c2018-12-20 17:02:37 +0000291 uint32_t intid, struct vcpu *current,
292 struct vcpu **next)
293{
294 uint32_t intid_index = intid / INTERRUPT_REGISTER_BITS;
295 uint32_t intid_mask = 1u << (intid % INTERRUPT_REGISTER_BITS);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000296 int64_t ret = 0;
297
298 sl_lock(&target_vcpu->lock);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000299
300 /*
301 * We only need to change state and (maybe) trigger a virtual IRQ if it
302 * is enabled and was not previously pending. Otherwise we can skip
303 * everything except setting the pending bit.
304 *
305 * If you change this logic make sure to update the need_vm_lock logic
306 * above to match.
307 */
308 if (!(target_vcpu->interrupts.interrupt_enabled[intid_index] &
309 ~target_vcpu->interrupts.interrupt_pending[intid_index] &
310 intid_mask)) {
311 goto out;
312 }
313
314 /* Increment the count. */
315 target_vcpu->interrupts.enabled_and_pending_count++;
316
317 /*
318 * Only need to update state if there was not already an
319 * interrupt enabled and pending.
320 */
321 if (target_vcpu->interrupts.enabled_and_pending_count != 1) {
322 goto out;
323 }
324
Andrew Walbran508e63c2018-12-20 17:02:37 +0000325 if (current->vm->id == HF_PRIMARY_VM_ID) {
326 /*
327 * If the call came from the primary VM, let it know that it
328 * should run or kick the target vCPU.
329 */
330 ret = 1;
331 } else if (current != target_vcpu && next != NULL) {
Andrew Walbran33645652019-04-15 12:29:31 +0100332 *next = api_wake_up(current, target_vcpu);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000333 }
334
335out:
336 /* Either way, make it pending. */
337 target_vcpu->interrupts.interrupt_pending[intid_index] |= intid_mask;
338
339 sl_unlock(&target_vcpu->lock);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000340
341 return ret;
342}
343
344/**
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000345 * Prepares the vcpu to run by updating its state and fetching whether a return
346 * value needs to be forced onto the vCPU.
347 */
Andrew Scull38772ab2019-01-24 15:16:50 +0000348static bool api_vcpu_prepare_run(const struct vcpu *current, struct vcpu *vcpu,
Andrew Walbran508e63c2018-12-20 17:02:37 +0000349 struct hf_vcpu_run_return *run_ret)
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000350{
Andrew Scullb06d1752019-02-04 10:15:48 +0000351 bool need_vm_lock;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000352 bool ret;
353
Andrew Scullb06d1752019-02-04 10:15:48 +0000354 /*
355 * Wait until the registers become available. All locks must be
356 * released between iterations of this loop to avoid potential deadlocks
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100357 * if, on any path, a stage1_locked needs to be taken after taking the
358 * decision to switch context but before the registers have been saved.
Andrew Scullb06d1752019-02-04 10:15:48 +0000359 *
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100360 * The VM stage1_locked is not needed in the common case so it must only
361 * be taken when it is going to be needed. This ensures there are no
362 * inter-vCPU dependencies in the common run case meaning the sensitive
363 * context switch performance is consistent.
Andrew Scullb06d1752019-02-04 10:15:48 +0000364 */
365 for (;;) {
366 sl_lock(&vcpu->lock);
367
368 /* The VM needs to be locked to deliver mailbox messages. */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100369 need_vm_lock = vcpu->state == VCPU_STATE_BLOCKED_MAILBOX;
Andrew Scullb06d1752019-02-04 10:15:48 +0000370 if (need_vm_lock) {
371 sl_unlock(&vcpu->lock);
372 sl_lock(&vcpu->vm->lock);
373 sl_lock(&vcpu->lock);
374 }
375
376 if (vcpu->regs_available) {
377 break;
378 }
379
Andrew Sculld6ee1102019-04-05 22:12:42 +0100380 if (vcpu->state == VCPU_STATE_RUNNING) {
Andrew Scullb06d1752019-02-04 10:15:48 +0000381 /*
382 * vCPU is running on another pCPU.
383 *
Andrew Walbranabf88fb2019-06-21 12:17:47 +0100384 * It's ok not to return the sleep duration here because
Andrew Scullb06d1752019-02-04 10:15:48 +0000385 * the other physical CPU that is currently running this
Andrew Walbranabf88fb2019-06-21 12:17:47 +0100386 * vCPU will return the sleep duration if needed. The
387 * default return value is
388 * HF_VCPU_RUN_WAIT_FOR_INTERRUPT, so no need to set it
389 * explicitly.
Andrew Scullb06d1752019-02-04 10:15:48 +0000390 */
391 ret = false;
392 goto out;
393 }
394
395 sl_unlock(&vcpu->lock);
396 if (need_vm_lock) {
397 sl_unlock(&vcpu->vm->lock);
398 }
399 }
Andrew Scull9726c252019-01-23 13:44:19 +0000400
401 if (atomic_load_explicit(&vcpu->vm->aborting, memory_order_relaxed)) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100402 if (vcpu->state != VCPU_STATE_ABORTED) {
Andrew Scull82331282019-01-25 10:29:34 +0000403 dlog("Aborting VM %u vCPU %u\n", vcpu->vm->id,
404 vcpu_index(vcpu));
Andrew Sculld6ee1102019-04-05 22:12:42 +0100405 vcpu->state = VCPU_STATE_ABORTED;
Andrew Scull9726c252019-01-23 13:44:19 +0000406 }
407 ret = false;
408 goto out;
409 }
410
Andrew Walbran508e63c2018-12-20 17:02:37 +0000411 switch (vcpu->state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100412 case VCPU_STATE_RUNNING:
413 case VCPU_STATE_OFF:
414 case VCPU_STATE_ABORTED:
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000415 ret = false;
416 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000417
Andrew Sculld6ee1102019-04-05 22:12:42 +0100418 case VCPU_STATE_BLOCKED_MAILBOX:
Andrew Scullb06d1752019-02-04 10:15:48 +0000419 /*
420 * A pending message allows the vCPU to run so the message can
421 * be delivered directly.
422 */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100423 if (vcpu->vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
Jose Marinho3e2442f2019-03-12 13:30:37 +0000424 arch_regs_set_retval(&vcpu->regs, SPCI_SUCCESS);
Andrew Sculld6ee1102019-04-05 22:12:42 +0100425 vcpu->vm->mailbox.state = MAILBOX_STATE_READ;
Andrew Scullb06d1752019-02-04 10:15:48 +0000426 break;
427 }
428 /* Fall through. */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100429 case VCPU_STATE_BLOCKED_INTERRUPT:
Andrew Scullb06d1752019-02-04 10:15:48 +0000430 /* Allow virtual interrupts to be delivered. */
431 if (vcpu->interrupts.enabled_and_pending_count > 0) {
432 break;
433 }
434
435 /* The timer expired so allow the interrupt to be delivered. */
Andrew Walbran508e63c2018-12-20 17:02:37 +0000436 if (arch_timer_pending(&vcpu->regs)) {
437 break;
438 }
439
440 /*
441 * The vCPU is not ready to run, return the appropriate code to
442 * the primary which called vcpu_run.
443 */
444 if (arch_timer_enabled(&vcpu->regs)) {
Andrew Scullb06d1752019-02-04 10:15:48 +0000445 run_ret->code =
Andrew Sculld6ee1102019-04-05 22:12:42 +0100446 vcpu->state == VCPU_STATE_BLOCKED_MAILBOX
Andrew Scullb06d1752019-02-04 10:15:48 +0000447 ? HF_VCPU_RUN_WAIT_FOR_MESSAGE
448 : HF_VCPU_RUN_WAIT_FOR_INTERRUPT;
Andrew Walbran508e63c2018-12-20 17:02:37 +0000449 run_ret->sleep.ns =
450 arch_timer_remaining_ns(&vcpu->regs);
451 }
452
453 ret = false;
454 goto out;
Andrew Scullb06d1752019-02-04 10:15:48 +0000455
Andrew Sculld6ee1102019-04-05 22:12:42 +0100456 case VCPU_STATE_READY:
Andrew Walbran508e63c2018-12-20 17:02:37 +0000457 break;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000458 }
459
Andrew Scullb06d1752019-02-04 10:15:48 +0000460 /* It has been decided that the vCPU should be run. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000461 vcpu->cpu = current->cpu;
Andrew Sculld6ee1102019-04-05 22:12:42 +0100462 vcpu->state = VCPU_STATE_RUNNING;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000463
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000464 /*
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000465 * Mark the registers as unavailable now that we're about to reflect
466 * them onto the real registers. This will also prevent another physical
467 * CPU from trying to read these registers.
468 */
469 vcpu->regs_available = false;
470
471 ret = true;
472
473out:
474 sl_unlock(&vcpu->lock);
Andrew Scullb06d1752019-02-04 10:15:48 +0000475 if (need_vm_lock) {
476 sl_unlock(&vcpu->vm->lock);
477 }
478
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000479 return ret;
480}
481
482/**
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100483 * Runs the given vcpu of the given vm.
484 */
Andrew Walbranb037d5b2019-06-25 17:19:41 +0100485struct hf_vcpu_run_return api_vcpu_run(spci_vm_id_t vm_id,
486 spci_vcpu_index_t vcpu_idx,
Andrew Scull38772ab2019-01-24 15:16:50 +0000487 const struct vcpu *current,
488 struct vcpu **next)
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100489{
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100490 struct vm *vm;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100491 struct vcpu *vcpu;
Andrew Scull6d2db332018-10-10 15:28:17 +0100492 struct hf_vcpu_run_return ret = {
493 .code = HF_VCPU_RUN_WAIT_FOR_INTERRUPT,
Andrew Scullb06d1752019-02-04 10:15:48 +0000494 .sleep.ns = HF_SLEEP_INDEFINITE,
Andrew Scull6d2db332018-10-10 15:28:17 +0100495 };
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100496
497 /* Only the primary VM can switch vcpus. */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100498 if (current->vm->id != HF_PRIMARY_VM_ID) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100499 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100500 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100501
Andrew Scull19503262018-09-20 14:48:39 +0100502 /* Only secondary VM vcpus can be run. */
503 if (vm_id == HF_PRIMARY_VM_ID) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100504 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100505 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100506
Andrew Scull19503262018-09-20 14:48:39 +0100507 /* The requested VM must exist. */
Andrew Walbran42347a92019-05-09 13:59:03 +0100508 vm = vm_find(vm_id);
Andrew Scull19503262018-09-20 14:48:39 +0100509 if (vm == NULL) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100510 goto out;
Andrew Scull19503262018-09-20 14:48:39 +0100511 }
512
513 /* The requested vcpu must exist. */
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100514 if (vcpu_idx >= vm->vcpu_count) {
Andrew Scull6d2db332018-10-10 15:28:17 +0100515 goto out;
Andrew Scull7364a8e2018-07-19 15:39:29 +0100516 }
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100517
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000518 /* Update state if allowed. */
Andrew Walbrane1310df2019-04-29 17:28:28 +0100519 vcpu = vm_get_vcpu(vm, vcpu_idx);
Andrew Scullb06d1752019-02-04 10:15:48 +0000520 if (!api_vcpu_prepare_run(current, vcpu, &ret)) {
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000521 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100522 }
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000523
Andrew Walbran508e63c2018-12-20 17:02:37 +0000524 /*
525 * Inject timer interrupt if timer has expired. It's safe to access
526 * vcpu->regs here because api_vcpu_prepare_run already made sure that
527 * regs_available was true (and then set it to false) before returning
528 * true.
529 */
530 if (arch_timer_pending(&vcpu->regs)) {
531 /* Make virtual timer interrupt pending. */
Andrew Walbranfc9d4382019-05-10 18:07:21 +0100532 internal_interrupt_inject(vcpu, HF_VIRTUAL_TIMER_INTID, vcpu,
533 NULL);
Andrew Walbran508e63c2018-12-20 17:02:37 +0000534
535 /*
536 * Set the mask bit so the hardware interrupt doesn't fire
537 * again. Ideally we wouldn't do this because it affects what
538 * the secondary vCPU sees, but if we don't then we end up with
539 * a loop of the interrupt firing each time we try to return to
540 * the secondary vCPU.
541 */
542 arch_timer_mask(&vcpu->regs);
543 }
544
Andrew Scull33fecd32019-01-08 14:48:27 +0000545 /* Switch to the vcpu. */
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000546 *next = vcpu;
Wedson Almeida Filho03306112018-11-26 00:08:03 +0000547
Andrew Scull33fecd32019-01-08 14:48:27 +0000548 /*
549 * Set a placeholder return code to the scheduler. This will be
550 * overwritten when the switch back to the primary occurs.
551 */
552 ret.code = HF_VCPU_RUN_PREEMPTED;
553
Andrew Scull6d2db332018-10-10 15:28:17 +0100554out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100555 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +0100556}
557
558/**
Andrew Scull81e85092018-12-12 12:56:20 +0000559 * Check that the mode indicates memory that is valid, owned and exclusive.
560 */
Andrew Scullcbefbdb2019-01-11 16:36:26 +0000561static bool api_mode_valid_owned_and_exclusive(int mode)
Andrew Scull81e85092018-12-12 12:56:20 +0000562{
563 return (mode & (MM_MODE_INVALID | MM_MODE_UNOWNED | MM_MODE_SHARED)) ==
564 0;
565}
566
567/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000568 * Determines the value to be returned by api_vm_configure and api_mailbox_clear
569 * after they've succeeded. If a secondary VM is running and there are waiters,
570 * it also switches back to the primary VM for it to wake waiters up.
571 */
572static int64_t api_waiter_result(struct vm_locked locked_vm,
573 struct vcpu *current, struct vcpu **next)
574{
575 struct vm *vm = locked_vm.vm;
576 struct hf_vcpu_run_return ret = {
577 .code = HF_VCPU_RUN_NOTIFY_WAITERS,
578 };
579
580 if (list_empty(&vm->mailbox.waiter_list)) {
581 /* No waiters, nothing else to do. */
582 return 0;
583 }
584
585 if (vm->id == HF_PRIMARY_VM_ID) {
586 /* The caller is the primary VM. Tell it to wake up waiters. */
587 return 1;
588 }
589
590 /*
591 * Switch back to the primary VM, informing it that there are waiters
592 * that need to be notified.
593 */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100594 *next = api_switch_to_primary(current, ret, VCPU_STATE_READY);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000595
596 return 0;
597}
598
599/**
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100600 * Configures the VM to send/receive data through the specified pages. The pages
601 * must not be shared.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000602 *
603 * Returns:
604 * - -1 on failure.
605 * - 0 on success if no further action is needed.
606 * - 1 if it was called by the primary VM and the primary VM now needs to wake
607 * up or kick waiters. Waiters should be retrieved by calling
608 * hf_mailbox_waiter_get.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100609 */
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000610int64_t api_vm_configure(ipaddr_t send, ipaddr_t recv, struct vcpu *current,
611 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100612{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100613 struct vm *vm = current->vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000614 struct vm_locked locked;
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100615 struct mm_stage1_locked mm_stage1_locked;
Andrew Scull80871322018-08-06 12:04:09 +0100616 paddr_t pa_send_begin;
617 paddr_t pa_send_end;
618 paddr_t pa_recv_begin;
619 paddr_t pa_recv_end;
Andrew Scull220e6212018-12-21 18:09:00 +0000620 int orig_send_mode;
621 int orig_recv_mode;
622 struct mpool local_page_pool;
Andrew Scullc0e569a2018-10-02 18:05:21 +0100623 int64_t ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100624
625 /* Fail if addresses are not page-aligned. */
Alfredo Mazzinghieb1997c2019-02-07 18:00:01 +0000626 if (!is_aligned(ipa_addr(send), PAGE_SIZE) ||
627 !is_aligned(ipa_addr(recv), PAGE_SIZE)) {
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100628 return -1;
629 }
630
Andrew Scullc2eb6a32018-12-13 16:54:24 +0000631 /* Convert to physical addresses. */
632 pa_send_begin = pa_from_ipa(send);
633 pa_send_end = pa_add(pa_send_begin, PAGE_SIZE);
634
635 pa_recv_begin = pa_from_ipa(recv);
636 pa_recv_end = pa_add(pa_recv_begin, PAGE_SIZE);
637
Andrew Scullc9ccb3f2018-08-13 15:27:12 +0100638 /* Fail if the same page is used for the send and receive pages. */
639 if (pa_addr(pa_send_begin) == pa_addr(pa_recv_begin)) {
Andrew Scull220e6212018-12-21 18:09:00 +0000640 return -1;
641 }
642
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100643 /*
644 * The hypervisor's memory map must be locked for the duration of this
645 * operation to ensure there will be sufficient memory to recover from
646 * any failures.
647 *
648 * TODO: the scope of the can be reduced but will require restructuring
649 * to keep a single unlock point.
650 */
Andrew Walbran7e932bd2019-04-29 16:47:06 +0100651 locked = vm_lock(vm);
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100652 mm_stage1_locked = mm_lock_stage1();
Andrew Scull220e6212018-12-21 18:09:00 +0000653
654 /* We only allow these to be setup once. */
655 if (vm->mailbox.send || vm->mailbox.recv) {
656 goto fail;
657 }
658
659 /*
660 * Ensure the pages are valid, owned and exclusive to the VM and that
661 * the VM has the required access to the memory.
662 */
663 if (!mm_vm_get_mode(&vm->ptable, send, ipa_add(send, PAGE_SIZE),
664 &orig_send_mode) ||
665 !api_mode_valid_owned_and_exclusive(orig_send_mode) ||
666 (orig_send_mode & MM_MODE_R) == 0 ||
667 (orig_send_mode & MM_MODE_W) == 0) {
668 goto fail;
669 }
670
671 if (!mm_vm_get_mode(&vm->ptable, recv, ipa_add(recv, PAGE_SIZE),
672 &orig_recv_mode) ||
673 !api_mode_valid_owned_and_exclusive(orig_recv_mode) ||
674 (orig_recv_mode & MM_MODE_R) == 0) {
675 goto fail;
676 }
677
678 /*
679 * Create a local pool so any freed memory can't be used by another
680 * thread. This is to ensure the original mapping can be restored if any
681 * stage of the process fails.
682 */
683 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
684
685 /* Take memory ownership away from the VM and mark as shared. */
686 if (!mm_vm_identity_map(
687 &vm->ptable, pa_send_begin, pa_send_end,
688 MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R | MM_MODE_W,
689 NULL, &local_page_pool)) {
690 goto fail_free_pool;
691 }
692
693 if (!mm_vm_identity_map(&vm->ptable, pa_recv_begin, pa_recv_end,
694 MM_MODE_UNOWNED | MM_MODE_SHARED | MM_MODE_R,
695 NULL, &local_page_pool)) {
696 /* TODO: partial defrag of failed range. */
697 /* Recover any memory consumed in failed mapping. */
Andrew Scullda3df7f2019-01-05 17:49:27 +0000698 mm_vm_defrag(&vm->ptable, &local_page_pool);
Andrew Scull220e6212018-12-21 18:09:00 +0000699 goto fail_undo_send;
Andrew Scullc9ccb3f2018-08-13 15:27:12 +0100700 }
701
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100702 /* Map the send page as read-only in the hypervisor address space. */
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100703 vm->mailbox.send =
704 mm_identity_map(mm_stage1_locked, pa_send_begin, pa_send_end,
705 MM_MODE_R, &local_page_pool);
Andrew Scullaa039b32018-10-04 15:02:26 +0100706 if (!vm->mailbox.send) {
Andrew Scull220e6212018-12-21 18:09:00 +0000707 /* TODO: partial defrag of failed range. */
708 /* Recover any memory consumed in failed mapping. */
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100709 mm_defrag(mm_stage1_locked, &local_page_pool);
Andrew Scull220e6212018-12-21 18:09:00 +0000710 goto fail_undo_send_and_recv;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100711 }
712
713 /*
714 * Map the receive page as writable in the hypervisor address space. On
715 * failure, unmap the send page before returning.
716 */
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100717 vm->mailbox.recv =
718 mm_identity_map(mm_stage1_locked, pa_recv_begin, pa_recv_end,
719 MM_MODE_W, &local_page_pool);
Andrew Scullaa039b32018-10-04 15:02:26 +0100720 if (!vm->mailbox.recv) {
Andrew Scull220e6212018-12-21 18:09:00 +0000721 /* TODO: partial defrag of failed range. */
722 /* Recover any memory consumed in failed mapping. */
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100723 mm_defrag(mm_stage1_locked, &local_page_pool);
Andrew Scull220e6212018-12-21 18:09:00 +0000724 goto fail_undo_all;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100725 }
726
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000727 /* Tell caller about waiters, if any. */
728 ret = api_waiter_result(locked, current, next);
Andrew Scull220e6212018-12-21 18:09:00 +0000729 goto exit;
730
731 /*
732 * The following mappings will not require more memory than is available
733 * in the local pool.
734 */
735fail_undo_all:
736 vm->mailbox.send = NULL;
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100737 mm_unmap(mm_stage1_locked, pa_send_begin, pa_send_end,
738 &local_page_pool);
Andrew Scull220e6212018-12-21 18:09:00 +0000739
740fail_undo_send_and_recv:
741 mm_vm_identity_map(&vm->ptable, pa_recv_begin, pa_recv_end,
742 orig_recv_mode, NULL, &local_page_pool);
743
744fail_undo_send:
745 mm_vm_identity_map(&vm->ptable, pa_send_begin, pa_send_end,
746 orig_send_mode, NULL, &local_page_pool);
747
748fail_free_pool:
749 mpool_fini(&local_page_pool);
750
751fail:
752 ret = -1;
753
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100754exit:
Andrew Scull3c0a90a2019-07-01 11:55:53 +0100755 mm_unlock_stage1(&mm_stage1_locked);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000756 vm_unlock(&locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100757
758 return ret;
759}
760
761/**
Andrew Scullaa039b32018-10-04 15:02:26 +0100762 * Copies data from the sender's send buffer to the recipient's receive buffer
763 * and notifies the recipient.
Wedson Almeida Filho17c997f2019-01-09 18:50:09 +0000764 *
765 * If the recipient's receive buffer is busy, it can optionally register the
766 * caller to be notified when the recipient's receive buffer becomes available.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100767 */
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000768int32_t api_spci_msg_send(uint32_t attributes, struct vcpu *current,
769 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100770{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100771 struct vm *from = current->vm;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100772 struct vm *to;
Andrew Scullb06d1752019-02-04 10:15:48 +0000773 struct hf_vcpu_run_return primary_ret = {
774 .code = HF_VCPU_RUN_MESSAGE,
775 };
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000776 struct spci_message from_msg_replica;
777 struct spci_message *to_msg;
778 const struct spci_message *from_msg;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100779
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000780 uint32_t size;
Andrew Scull19503262018-09-20 14:48:39 +0100781
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000782 int64_t ret;
783 bool notify = (attributes & SPCI_MSG_SEND_NOTIFY_MASK) ==
784 SPCI_MSG_SEND_NOTIFY;
Andrew Scull19503262018-09-20 14:48:39 +0100785
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000786 /*
787 * Check that the sender has configured its send buffer. Copy the
788 * message header. If the tx mailbox at from_msg is configured (i.e.
789 * from_msg != NULL) then it can be safely accessed after releasing the
790 * lock since the tx mailbox address can only be configured once.
791 */
792 sl_lock(&from->lock);
793 from_msg = from->mailbox.send;
794 sl_unlock(&from->lock);
795
796 if (from_msg == NULL) {
797 return SPCI_INVALID_PARAMETERS;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100798 }
799
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100800 /*
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000801 * Note that the payload is not copied when the message header is.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100802 */
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000803 from_msg_replica = *from_msg;
804
805 /* Ensure source VM id corresponds to the current VM. */
806 if (from_msg_replica.source_vm_id != from->id) {
807 return SPCI_INVALID_PARAMETERS;
808 }
809
810 size = from_msg_replica.length;
811 /* Limit the size of transfer. */
Andrew Scull1262ac22019-04-05 12:44:26 +0100812 if (size > SPCI_MSG_PAYLOAD_MAX) {
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000813 return SPCI_INVALID_PARAMETERS;
814 }
815
816 /* Disallow reflexive requests as this suggests an error in the VM. */
817 if (from_msg_replica.target_vm_id == from->id) {
818 return SPCI_INVALID_PARAMETERS;
819 }
820
821 /* Ensure the target VM exists. */
Andrew Walbran42347a92019-05-09 13:59:03 +0100822 to = vm_find(from_msg_replica.target_vm_id);
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000823 if (to == NULL) {
824 return SPCI_INVALID_PARAMETERS;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100825 }
826
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100827 sl_lock(&to->lock);
828
Andrew Sculld6ee1102019-04-05 22:12:42 +0100829 if (to->mailbox.state != MAILBOX_STATE_EMPTY ||
Andrew Scullaa039b32018-10-04 15:02:26 +0100830 to->mailbox.recv == NULL) {
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000831 /*
832 * Fail if the target isn't currently ready to receive data,
833 * setting up for notification if requested.
834 */
835 if (notify) {
Wedson Almeida Filhob790f652019-01-22 23:41:56 +0000836 struct wait_entry *entry =
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000837 &current->vm->wait_entries
838 [from_msg_replica.target_vm_id];
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000839
840 /* Append waiter only if it's not there yet. */
841 if (list_empty(&entry->wait_links)) {
842 list_append(&to->mailbox.waiter_list,
843 &entry->wait_links);
844 }
845 }
846
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000847 ret = SPCI_BUSY;
Andrew Scullaa039b32018-10-04 15:02:26 +0100848 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100849 }
850
Andrew Scullaa039b32018-10-04 15:02:26 +0100851 /* Copy data. */
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000852 to_msg = to->mailbox.recv;
853 *to_msg = from_msg_replica;
Andrew Sculla1aa2ba2019-04-05 11:49:02 +0100854 memcpy_s(to_msg->payload, SPCI_MSG_PAYLOAD_MAX,
855 from->mailbox.send->payload, size);
Andrew Scullb06d1752019-02-04 10:15:48 +0000856 primary_ret.message.vm_id = to->id;
Jose Marinhoa1dfeda2019-02-27 16:46:03 +0000857 ret = SPCI_SUCCESS;
Andrew Scullaa039b32018-10-04 15:02:26 +0100858
859 /* Messages for the primary VM are delivered directly. */
860 if (to->id == HF_PRIMARY_VM_ID) {
Andrew Sculld6ee1102019-04-05 22:12:42 +0100861 to->mailbox.state = MAILBOX_STATE_READ;
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000862 *next = api_switch_to_primary(current, primary_ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100863 VCPU_STATE_READY);
Andrew Scullaa039b32018-10-04 15:02:26 +0100864 goto out;
865 }
866
Andrew Sculld6ee1102019-04-05 22:12:42 +0100867 to->mailbox.state = MAILBOX_STATE_RECEIVED;
Andrew Scullaa039b32018-10-04 15:02:26 +0100868
869 /* Return to the primary VM directly or with a switch. */
Andrew Scullb06d1752019-02-04 10:15:48 +0000870 if (from->id != HF_PRIMARY_VM_ID) {
Wedson Almeida Filhoba641ef2018-12-03 04:19:44 +0000871 *next = api_switch_to_primary(current, primary_ret,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100872 VCPU_STATE_READY);
Wedson Almeida Filho80eb4a32018-11-30 17:11:15 +0000873 }
Andrew Scullaa039b32018-10-04 15:02:26 +0100874
875out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100876 sl_unlock(&to->lock);
877
Wedson Almeida Filho80eb4a32018-11-30 17:11:15 +0000878 return ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100879}
880
881/**
Andrew Scullaa039b32018-10-04 15:02:26 +0100882 * Receives a message from the mailbox. If one isn't available, this function
883 * can optionally block the caller until one becomes available.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100884 *
Andrew Scullaa039b32018-10-04 15:02:26 +0100885 * No new messages can be received until the mailbox has been cleared.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100886 */
Jose Marinho3e2442f2019-03-12 13:30:37 +0000887int32_t api_spci_msg_recv(uint32_t attributes, struct vcpu *current,
888 struct vcpu **next)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100889{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100890 struct vm *vm = current->vm;
Jose Marinho3e2442f2019-03-12 13:30:37 +0000891 int32_t return_code;
892 bool block =
893 (attributes & SPCI_MSG_RECV_BLOCK_MASK) == SPCI_MSG_RECV_BLOCK;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100894
Andrew Scullaa039b32018-10-04 15:02:26 +0100895 /*
896 * The primary VM will receive messages as a status code from running
897 * vcpus and must not call this function.
898 */
Andrew Scull19503262018-09-20 14:48:39 +0100899 if (vm->id == HF_PRIMARY_VM_ID) {
Jose Marinho3e2442f2019-03-12 13:30:37 +0000900 return SPCI_INTERRUPTED;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100901 }
902
903 sl_lock(&vm->lock);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100904
Andrew Scullaa039b32018-10-04 15:02:26 +0100905 /* Return pending messages without blocking. */
Andrew Sculld6ee1102019-04-05 22:12:42 +0100906 if (vm->mailbox.state == MAILBOX_STATE_RECEIVED) {
907 vm->mailbox.state = MAILBOX_STATE_READ;
Jose Marinho3e2442f2019-03-12 13:30:37 +0000908 return_code = SPCI_SUCCESS;
909 goto out;
910 }
911
912 /* No pending message so fail if not allowed to block. */
913 if (!block) {
914 return_code = SPCI_RETRY;
Andrew Scullaa039b32018-10-04 15:02:26 +0100915 goto out;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100916 }
Andrew Scullaa039b32018-10-04 15:02:26 +0100917
Andrew Walbran9311c9a2019-03-12 16:59:04 +0000918 /*
Jose Marinho3e2442f2019-03-12 13:30:37 +0000919 * From this point onward this call can only be interrupted or a message
920 * received. If a message is received the return value will be set at
921 * that time to SPCI_SUCCESS.
Andrew Walbran9311c9a2019-03-12 16:59:04 +0000922 */
Jose Marinho3e2442f2019-03-12 13:30:37 +0000923 return_code = SPCI_INTERRUPTED;
924
925 /*
926 * Don't block if there are enabled and pending interrupts, to match
927 * behaviour of wait_for_interrupt.
928 */
929 if (current->interrupts.enabled_and_pending_count > 0) {
Andrew Scullaa039b32018-10-04 15:02:26 +0100930 goto out;
931 }
932
Andrew Scullaa039b32018-10-04 15:02:26 +0100933 /* Switch back to primary vm to block. */
Andrew Walbranb4816552018-12-05 17:35:42 +0000934 {
935 struct hf_vcpu_run_return run_return = {
Andrew Scullb06d1752019-02-04 10:15:48 +0000936 .code = HF_VCPU_RUN_WAIT_FOR_MESSAGE,
Andrew Walbranb4816552018-12-05 17:35:42 +0000937 };
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000938
Andrew Walbranb4816552018-12-05 17:35:42 +0000939 *next = api_switch_to_primary(current, run_return,
Andrew Sculld6ee1102019-04-05 22:12:42 +0100940 VCPU_STATE_BLOCKED_MAILBOX);
Andrew Walbranb4816552018-12-05 17:35:42 +0000941 }
Andrew Scullaa039b32018-10-04 15:02:26 +0100942out:
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100943 sl_unlock(&vm->lock);
944
Jose Marinho3e2442f2019-03-12 13:30:37 +0000945 return return_code;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100946}
947
948/**
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000949 * Retrieves the next VM whose mailbox became writable. For a VM to be notified
950 * by this function, the caller must have called api_mailbox_send before with
951 * the notify argument set to true, and this call must have failed because the
952 * mailbox was not available.
953 *
954 * It should be called repeatedly to retrieve a list of VMs.
955 *
956 * Returns -1 if no VM became writable, or the id of the VM whose mailbox
957 * became writable.
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100958 */
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000959int64_t api_mailbox_writable_get(const struct vcpu *current)
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100960{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100961 struct vm *vm = current->vm;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000962 struct wait_entry *entry;
Andrew Scullc0e569a2018-10-02 18:05:21 +0100963 int64_t ret;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +0100964
965 sl_lock(&vm->lock);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000966 if (list_empty(&vm->mailbox.ready_list)) {
967 ret = -1;
968 goto exit;
969 }
970
971 entry = CONTAINER_OF(vm->mailbox.ready_list.next, struct wait_entry,
972 ready_links);
973 list_remove(&entry->ready_links);
Wedson Almeida Filhob790f652019-01-22 23:41:56 +0000974 ret = entry - vm->wait_entries;
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000975
976exit:
977 sl_unlock(&vm->lock);
978 return ret;
979}
980
981/**
982 * Retrieves the next VM waiting to be notified that the mailbox of the
983 * specified VM became writable. Only primary VMs are allowed to call this.
984 *
Wedson Almeida Filhob790f652019-01-22 23:41:56 +0000985 * Returns -1 on failure or if there are no waiters; the VM id of the next
986 * waiter otherwise.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000987 */
Andrew Walbran42347a92019-05-09 13:59:03 +0100988int64_t api_mailbox_waiter_get(spci_vm_id_t vm_id, const struct vcpu *current)
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +0000989{
990 struct vm *vm;
991 struct vm_locked locked;
992 struct wait_entry *entry;
993 struct vm *waiting_vm;
994
995 /* Only primary VMs are allowed to call this function. */
996 if (current->vm->id != HF_PRIMARY_VM_ID) {
997 return -1;
998 }
999
Andrew Walbran42347a92019-05-09 13:59:03 +01001000 vm = vm_find(vm_id);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001001 if (vm == NULL) {
1002 return -1;
1003 }
1004
1005 /* Check if there are outstanding notifications from given vm. */
Andrew Walbran7e932bd2019-04-29 16:47:06 +01001006 locked = vm_lock(vm);
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001007 entry = api_fetch_waiter(locked);
1008 vm_unlock(&locked);
1009
1010 if (entry == NULL) {
1011 return -1;
1012 }
1013
1014 /* Enqueue notification to waiting VM. */
1015 waiting_vm = entry->waiting_vm;
1016
1017 sl_lock(&waiting_vm->lock);
1018 if (list_empty(&entry->ready_links)) {
1019 list_append(&waiting_vm->mailbox.ready_list,
1020 &entry->ready_links);
1021 }
1022 sl_unlock(&waiting_vm->lock);
1023
1024 return waiting_vm->id;
1025}
1026
1027/**
1028 * Clears the caller's mailbox so that a new message can be received. The caller
1029 * must have copied out all data they wish to preserve as new messages will
1030 * overwrite the old and will arrive asynchronously.
1031 *
1032 * Returns:
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001033 * - -1 on failure, if the mailbox hasn't been read.
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001034 * - 0 on success if no further action is needed.
1035 * - 1 if it was called by the primary VM and the primary VM now needs to wake
1036 * up or kick waiters. Waiters should be retrieved by calling
1037 * hf_mailbox_waiter_get.
1038 */
1039int64_t api_mailbox_clear(struct vcpu *current, struct vcpu **next)
1040{
1041 struct vm *vm = current->vm;
1042 struct vm_locked locked;
1043 int64_t ret;
1044
Andrew Walbran7e932bd2019-04-29 16:47:06 +01001045 locked = vm_lock(vm);
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001046 switch (vm->mailbox.state) {
Andrew Sculld6ee1102019-04-05 22:12:42 +01001047 case MAILBOX_STATE_EMPTY:
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001048 ret = 0;
1049 break;
1050
Andrew Sculld6ee1102019-04-05 22:12:42 +01001051 case MAILBOX_STATE_RECEIVED:
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001052 ret = -1;
1053 break;
1054
Andrew Sculld6ee1102019-04-05 22:12:42 +01001055 case MAILBOX_STATE_READ:
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001056 ret = api_waiter_result(locked, current, next);
Andrew Sculld6ee1102019-04-05 22:12:42 +01001057 vm->mailbox.state = MAILBOX_STATE_EMPTY;
Andrew Scullaa7db8e2019-02-01 14:12:19 +00001058 break;
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001059 }
Wedson Almeida Filhoea62e2e2019-01-09 19:14:59 +00001060 vm_unlock(&locked);
Wedson Almeida Filho2f94ec12018-07-26 16:00:48 +01001061
1062 return ret;
Wedson Almeida Filho3fcbcff2018-07-10 23:53:39 +01001063}
Andrew Walbran318f5732018-11-20 16:23:42 +00001064
1065/**
1066 * Enables or disables a given interrupt ID for the calling vCPU.
1067 *
1068 * Returns 0 on success, or -1 if the intid is invalid.
1069 */
Wedson Almeida Filhoc559d132019-01-09 19:33:40 +00001070int64_t api_interrupt_enable(uint32_t intid, bool enable, struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00001071{
1072 uint32_t intid_index = intid / INTERRUPT_REGISTER_BITS;
1073 uint32_t intid_mask = 1u << (intid % INTERRUPT_REGISTER_BITS);
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001074
Andrew Walbran318f5732018-11-20 16:23:42 +00001075 if (intid >= HF_NUM_INTIDS) {
1076 return -1;
1077 }
1078
1079 sl_lock(&current->lock);
1080 if (enable) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001081 /*
1082 * If it is pending and was not enabled before, increment the
1083 * count.
1084 */
1085 if (current->interrupts.interrupt_pending[intid_index] &
1086 ~current->interrupts.interrupt_enabled[intid_index] &
1087 intid_mask) {
1088 current->interrupts.enabled_and_pending_count++;
1089 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001090 current->interrupts.interrupt_enabled[intid_index] |=
1091 intid_mask;
Andrew Walbran318f5732018-11-20 16:23:42 +00001092 } else {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001093 /*
1094 * If it is pending and was enabled before, decrement the count.
1095 */
1096 if (current->interrupts.interrupt_pending[intid_index] &
1097 current->interrupts.interrupt_enabled[intid_index] &
1098 intid_mask) {
1099 current->interrupts.enabled_and_pending_count--;
1100 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001101 current->interrupts.interrupt_enabled[intid_index] &=
1102 ~intid_mask;
1103 }
1104
1105 sl_unlock(&current->lock);
1106 return 0;
1107}
1108
1109/**
1110 * Returns the ID of the next pending interrupt for the calling vCPU, and
1111 * acknowledges it (i.e. marks it as no longer pending). Returns
1112 * HF_INVALID_INTID if there are no pending interrupts.
1113 */
Wedson Almeida Filhoc559d132019-01-09 19:33:40 +00001114uint32_t api_interrupt_get(struct vcpu *current)
Andrew Walbran318f5732018-11-20 16:23:42 +00001115{
1116 uint8_t i;
1117 uint32_t first_interrupt = HF_INVALID_INTID;
Andrew Walbran318f5732018-11-20 16:23:42 +00001118
1119 /*
1120 * Find the first enabled and pending interrupt ID, return it, and
1121 * deactivate it.
1122 */
1123 sl_lock(&current->lock);
1124 for (i = 0; i < HF_NUM_INTIDS / INTERRUPT_REGISTER_BITS; ++i) {
1125 uint32_t enabled_and_pending =
1126 current->interrupts.interrupt_enabled[i] &
1127 current->interrupts.interrupt_pending[i];
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001128
Andrew Walbran318f5732018-11-20 16:23:42 +00001129 if (enabled_and_pending != 0) {
Andrew Walbran3d84a262018-12-13 14:41:19 +00001130 uint8_t bit_index = ctz(enabled_and_pending);
1131 /*
1132 * Mark it as no longer pending and decrement the count.
1133 */
1134 current->interrupts.interrupt_pending[i] &=
1135 ~(1u << bit_index);
1136 current->interrupts.enabled_and_pending_count--;
1137 first_interrupt =
1138 i * INTERRUPT_REGISTER_BITS + bit_index;
Andrew Walbran318f5732018-11-20 16:23:42 +00001139 break;
1140 }
1141 }
Andrew Walbran318f5732018-11-20 16:23:42 +00001142
1143 sl_unlock(&current->lock);
1144 return first_interrupt;
1145}
1146
1147/**
Andrew Walbran4cf217a2018-12-14 15:24:50 +00001148 * Returns whether the current vCPU is allowed to inject an interrupt into the
Andrew Walbran318f5732018-11-20 16:23:42 +00001149 * given VM and vCPU.
1150 */
1151static inline bool is_injection_allowed(uint32_t target_vm_id,
1152 struct vcpu *current)
1153{
1154 uint32_t current_vm_id = current->vm->id;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001155
Andrew Walbran318f5732018-11-20 16:23:42 +00001156 /*
1157 * The primary VM is allowed to inject interrupts into any VM. Secondary
1158 * VMs are only allowed to inject interrupts into their own vCPUs.
1159 */
1160 return current_vm_id == HF_PRIMARY_VM_ID ||
1161 current_vm_id == target_vm_id;
1162}
1163
1164/**
1165 * Injects a virtual interrupt of the given ID into the given target vCPU.
1166 * This doesn't cause the vCPU to actually be run immediately; it will be taken
1167 * when the vCPU is next run, which is up to the scheduler.
1168 *
Andrew Walbran3d84a262018-12-13 14:41:19 +00001169 * Returns:
1170 * - -1 on failure because the target VM or vCPU doesn't exist, the interrupt
1171 * ID is invalid, or the current VM is not allowed to inject interrupts to
1172 * the target VM.
1173 * - 0 on success if no further action is needed.
1174 * - 1 if it was called by the primary VM and the primary VM now needs to wake
1175 * up or kick the target vCPU.
Andrew Walbran318f5732018-11-20 16:23:42 +00001176 */
Andrew Walbran42347a92019-05-09 13:59:03 +01001177int64_t api_interrupt_inject(spci_vm_id_t target_vm_id,
Andrew Walbranb037d5b2019-06-25 17:19:41 +01001178 spci_vcpu_index_t target_vcpu_idx, uint32_t intid,
Andrew Walbran42347a92019-05-09 13:59:03 +01001179 struct vcpu *current, struct vcpu **next)
Andrew Walbran318f5732018-11-20 16:23:42 +00001180{
Andrew Walbran318f5732018-11-20 16:23:42 +00001181 struct vcpu *target_vcpu;
Andrew Walbran42347a92019-05-09 13:59:03 +01001182 struct vm *target_vm = vm_find(target_vm_id);
Andrew Walbran318f5732018-11-20 16:23:42 +00001183
1184 if (intid >= HF_NUM_INTIDS) {
1185 return -1;
1186 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001187
Andrew Walbran318f5732018-11-20 16:23:42 +00001188 if (target_vm == NULL) {
1189 return -1;
1190 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001191
Andrew Walbran318f5732018-11-20 16:23:42 +00001192 if (target_vcpu_idx >= target_vm->vcpu_count) {
1193 /* The requested vcpu must exist. */
1194 return -1;
1195 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001196
Andrew Walbran318f5732018-11-20 16:23:42 +00001197 if (!is_injection_allowed(target_vm_id, current)) {
1198 return -1;
1199 }
Wedson Almeida Filho81568c42019-01-04 13:33:02 +00001200
Andrew Walbrane1310df2019-04-29 17:28:28 +01001201 target_vcpu = vm_get_vcpu(target_vm, target_vcpu_idx);
Andrew Walbran318f5732018-11-20 16:23:42 +00001202
1203 dlog("Injecting IRQ %d for VM %d VCPU %d from VM %d VCPU %d\n", intid,
1204 target_vm_id, target_vcpu_idx, current->vm->id, current->cpu->id);
Andrew Walbranfc9d4382019-05-10 18:07:21 +01001205 return internal_interrupt_inject(target_vcpu, intid, current, next);
Andrew Walbran318f5732018-11-20 16:23:42 +00001206}
Andrew Scull6386f252018-12-06 13:29:10 +00001207
1208/**
1209 * Clears a region of physical memory by overwriting it with zeros. The data is
1210 * flushed from the cache so the memory has been cleared across the system.
1211 */
1212static bool api_clear_memory(paddr_t begin, paddr_t end, struct mpool *ppool)
1213{
1214 /*
1215 * TODO: change this to a cpu local single page window rather than a
1216 * global mapping of the whole range. Such an approach will limit
1217 * the changes to stage-1 tables and will allow only local
1218 * invalidation.
1219 */
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001220 bool ret;
1221 struct mm_stage1_locked stage1_locked = mm_lock_stage1();
1222 void *ptr =
1223 mm_identity_map(stage1_locked, begin, end, MM_MODE_W, ppool);
Andrew Walbran2cb43392019-04-17 12:52:45 +01001224 size_t size = pa_difference(begin, end);
Andrew Scull6386f252018-12-06 13:29:10 +00001225
1226 if (!ptr) {
1227 /* TODO: partial defrag of failed range. */
1228 /* Recover any memory consumed in failed mapping. */
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001229 mm_defrag(stage1_locked, ppool);
1230 goto fail;
Andrew Scull6386f252018-12-06 13:29:10 +00001231 }
1232
Andrew Scull2b5fbad2019-04-05 13:55:56 +01001233 memset_s(ptr, size, 0, size);
Andrew Scull6386f252018-12-06 13:29:10 +00001234 arch_mm_write_back_dcache(ptr, size);
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001235 mm_unmap(stage1_locked, begin, end, ppool);
Andrew Scull6386f252018-12-06 13:29:10 +00001236
Andrew Scull3c0a90a2019-07-01 11:55:53 +01001237 ret = true;
1238 goto out;
1239
1240fail:
1241 ret = false;
1242
1243out:
1244 mm_unlock_stage1(&stage1_locked);
1245
1246 return ret;
Andrew Scull6386f252018-12-06 13:29:10 +00001247}
1248
1249/**
1250 * Shares memory from the calling VM with another. The memory can be shared in
1251 * different modes.
1252 *
1253 * TODO: the interface for sharing memory will need to be enhanced to allow
1254 * sharing with different modes e.g. read-only, informing the recipient
1255 * of the memory they have been given, opting to not wipe the memory and
1256 * possibly allowing multiple blocks to be transferred. What this will
1257 * look like is TBD.
1258 */
Andrew Walbran42347a92019-05-09 13:59:03 +01001259int64_t api_share_memory(spci_vm_id_t vm_id, ipaddr_t addr, size_t size,
Andrew Scull6386f252018-12-06 13:29:10 +00001260 enum hf_share share, struct vcpu *current)
1261{
1262 struct vm *from = current->vm;
1263 struct vm *to;
1264 int orig_from_mode;
1265 int from_mode;
1266 int to_mode;
1267 ipaddr_t begin;
1268 ipaddr_t end;
1269 paddr_t pa_begin;
1270 paddr_t pa_end;
1271 struct mpool local_page_pool;
1272 int64_t ret;
1273
1274 /* Disallow reflexive shares as this suggests an error in the VM. */
1275 if (vm_id == from->id) {
1276 return -1;
1277 }
1278
1279 /* Ensure the target VM exists. */
Andrew Walbran42347a92019-05-09 13:59:03 +01001280 to = vm_find(vm_id);
Andrew Scull6386f252018-12-06 13:29:10 +00001281 if (to == NULL) {
1282 return -1;
1283 }
1284
1285 begin = addr;
1286 end = ipa_add(addr, size);
1287
1288 /* Fail if addresses are not page-aligned. */
Alfredo Mazzinghieb1997c2019-02-07 18:00:01 +00001289 if (!is_aligned(ipa_addr(begin), PAGE_SIZE) ||
1290 !is_aligned(ipa_addr(end), PAGE_SIZE)) {
Andrew Scull6386f252018-12-06 13:29:10 +00001291 return -1;
1292 }
1293
1294 /* Convert the sharing request to memory management modes. */
1295 switch (share) {
1296 case HF_MEMORY_GIVE:
1297 from_mode = MM_MODE_INVALID | MM_MODE_UNOWNED;
1298 to_mode = MM_MODE_R | MM_MODE_W | MM_MODE_X;
1299 break;
1300
1301 case HF_MEMORY_LEND:
1302 from_mode = MM_MODE_INVALID;
1303 to_mode = MM_MODE_R | MM_MODE_W | MM_MODE_X | MM_MODE_UNOWNED;
1304 break;
1305
1306 case HF_MEMORY_SHARE:
1307 from_mode = MM_MODE_R | MM_MODE_W | MM_MODE_X | MM_MODE_SHARED;
1308 to_mode = MM_MODE_R | MM_MODE_W | MM_MODE_X | MM_MODE_UNOWNED |
1309 MM_MODE_SHARED;
1310 break;
1311
1312 default:
1313 /* The input is untrusted so might not be a valid value. */
1314 return -1;
1315 }
1316
1317 /*
1318 * Create a local pool so any freed memory can't be used by another
1319 * thread. This is to ensure the original mapping can be restored if any
1320 * stage of the process fails.
1321 */
1322 mpool_init_with_fallback(&local_page_pool, &api_page_pool);
1323
1324 sl_lock_both(&from->lock, &to->lock);
1325
1326 /*
1327 * Ensure that the memory range is mapped with the same mode so that
1328 * changes can be reverted if the process fails.
1329 */
1330 if (!mm_vm_get_mode(&from->ptable, begin, end, &orig_from_mode)) {
1331 goto fail;
1332 }
1333
1334 /*
1335 * Ensure the memory range is valid for the sender. If it isn't, the
1336 * sender has either shared it with another VM already or has no claim
1337 * to the memory.
1338 */
1339 if (orig_from_mode & MM_MODE_INVALID) {
1340 goto fail;
1341 }
1342
1343 /*
1344 * The sender must own the memory and have exclusive access to it in
1345 * order to share it. Alternatively, it is giving memory back to the
1346 * owning VM.
1347 */
1348 if (orig_from_mode & MM_MODE_UNOWNED) {
1349 int orig_to_mode;
1350
1351 if (share != HF_MEMORY_GIVE ||
1352 !mm_vm_get_mode(&to->ptable, begin, end, &orig_to_mode) ||
1353 orig_to_mode & MM_MODE_UNOWNED) {
1354 goto fail;
1355 }
1356 } else if (orig_from_mode & MM_MODE_SHARED) {
1357 goto fail;
1358 }
1359
1360 pa_begin = pa_from_ipa(begin);
1361 pa_end = pa_from_ipa(end);
1362
1363 /*
1364 * First update the mapping for the sender so there is not overlap with
1365 * the recipient.
1366 */
1367 if (!mm_vm_identity_map(&from->ptable, pa_begin, pa_end, from_mode,
1368 NULL, &local_page_pool)) {
1369 goto fail;
1370 }
1371
1372 /* Clear the memory so no VM or device can see the previous contents. */
1373 if (!api_clear_memory(pa_begin, pa_end, &local_page_pool)) {
1374 goto fail_return_to_sender;
1375 }
1376
1377 /* Complete the transfer by mapping the memory into the recipient. */
1378 if (!mm_vm_identity_map(&to->ptable, pa_begin, pa_end, to_mode, NULL,
1379 &local_page_pool)) {
1380 /* TODO: partial defrag of failed range. */
1381 /* Recover any memory consumed in failed mapping. */
1382 mm_vm_defrag(&from->ptable, &local_page_pool);
1383 goto fail_return_to_sender;
1384 }
1385
1386 ret = 0;
1387 goto out;
1388
1389fail_return_to_sender:
1390 mm_vm_identity_map(&from->ptable, pa_begin, pa_end, orig_from_mode,
1391 NULL, &local_page_pool);
1392
1393fail:
1394 ret = -1;
1395
1396out:
1397 sl_unlock(&from->lock);
1398 sl_unlock(&to->lock);
1399
1400 mpool_fini(&local_page_pool);
1401
1402 return ret;
1403}
Jose Marinhofc0b2b62019-06-06 11:18:45 +01001404
1405/** Returns the version of the implemented SPCI specification. */
1406int32_t api_spci_version(void)
1407{
1408 /*
1409 * Ensure that both major and minor revision representation occupies at
1410 * most 15 bits.
1411 */
1412 static_assert(0x8000 > SPCI_VERSION_MAJOR,
1413 "Major revision representation take more than 15 bits.");
1414 static_assert(0x10000 > SPCI_VERSION_MINOR,
1415 "Minor revision representation take more than 16 bits.");
1416
1417 return (SPCI_VERSION_MAJOR << SPCI_VERSION_MAJOR_OFFSET) |
1418 SPCI_VERSION_MINOR;
1419}