blob: d31b67a0c49156e3040b33310b3d39d5a24c4f0b [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 *
Andrew Walbrane959ec12020-06-17 15:01:09 +01004 * Use of this source code is governed by a BSD-style
5 * license that can be found in the LICENSE file or at
6 * https://opensource.org/licenses/BSD-3-Clause.
Andrew Scull18834872018-10-12 11:48:09 +01007 */
8
Andrew Scull18c78fc2018-08-20 12:57:41 +01009#include "hf/load.h"
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010010
11#include <stdbool.h>
12
Olivier Deprez112d2b52020-09-30 07:39:23 +020013#include "hf/arch/other_world.h"
Fuad Tabba77a4b012019-11-15 12:13:08 +000014#include "hf/arch/vm.h"
15
Andrew Scull18c78fc2018-08-20 12:57:41 +010016#include "hf/api.h"
Andrew Walbran34ce72e2018-09-13 16:47:44 +010017#include "hf/boot_params.h"
Andrew Scull72b43c02019-09-18 13:53:45 +010018#include "hf/check.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010019#include "hf/dlog.h"
Fuad Tabba50469e02020-06-30 15:14:28 +010020#include "hf/fdt_patch.h"
Andrew Scull5991ec92018-10-08 14:55:02 +010021#include "hf/layout.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010022#include "hf/memiter.h"
23#include "hf/mm.h"
Andrew Walbran48699362019-05-20 14:38:00 +010024#include "hf/plat/console.h"
Andrew Scullb1a6d0d2020-01-29 11:25:12 +000025#include "hf/plat/iommu.h"
Andrew Scull877ae4b2019-07-02 12:52:33 +010026#include "hf/static_assert.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"
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010029
Andrew Scull19503262018-09-20 14:48:39 +010030#include "vmapi/hf/call.h"
Manish Pandeyd34f8892020-06-19 17:41:07 +010031#include "vmapi/hf/ffa.h"
Andrew Scull19503262018-09-20 14:48:39 +010032
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010033/**
34 * Copies data to an unmapped location by mapping it for write, copying the
35 * data, then unmapping it.
Andrew Sculld9225b32018-11-19 16:12:41 +000036 *
37 * The data is written so that it is available to all cores with the cache
38 * disabled. When switching to the partitions, the caching is initially disabled
39 * so the data must be available without the cache.
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010040 */
Andrew Scull3c0a90a2019-07-01 11:55:53 +010041static bool copy_to_unmapped(struct mm_stage1_locked stage1_locked, paddr_t to,
David Brazdil7a462ec2019-08-15 12:27:47 +010042 struct memiter *from_it, struct mpool *ppool)
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010043{
David Brazdil7a462ec2019-08-15 12:27:47 +010044 const void *from = memiter_base(from_it);
45 size_t size = memiter_size(from_it);
Andrew Scull80871322018-08-06 12:04:09 +010046 paddr_t to_end = pa_add(to, size);
47 void *ptr;
Andrew Scull265ada92018-07-30 15:19:01 +010048
Andrew Scull3c0a90a2019-07-01 11:55:53 +010049 ptr = mm_identity_map(stage1_locked, to, to_end, MM_MODE_W, ppool);
Andrew Scull80871322018-08-06 12:04:09 +010050 if (!ptr) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010051 return false;
52 }
53
Andrew Sculla1aa2ba2019-04-05 11:49:02 +010054 memcpy_s(ptr, size, from, size);
Andrew Scullc059fbe2019-09-12 12:58:40 +010055 arch_mm_flush_dcache(ptr, size);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010056
Andrew Scull72b43c02019-09-18 13:53:45 +010057 CHECK(mm_unmap(stage1_locked, to, to_end, ppool));
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010058
59 return true;
60}
61
Fuad Tabba50469e02020-06-30 15:14:28 +010062/**
63 * Loads the secondary VM's kernel.
64 * Stores the kernel size in kernel_size (if kernel_size is not NULL).
65 * Returns false if it cannot load the kernel.
66 */
Andrew Scull72b43c02019-09-18 13:53:45 +010067static bool load_kernel(struct mm_stage1_locked stage1_locked, paddr_t begin,
68 paddr_t end, const struct manifest_vm *manifest_vm,
Fuad Tabba50469e02020-06-30 15:14:28 +010069 const struct memiter *cpio, struct mpool *ppool,
70 size_t *kernel_size)
Andrew Scull72b43c02019-09-18 13:53:45 +010071{
Andrew Scull72b43c02019-09-18 13:53:45 +010072 struct memiter kernel;
Fuad Tabba50469e02020-06-30 15:14:28 +010073 size_t size;
Andrew Scull72b43c02019-09-18 13:53:45 +010074
David Brazdil136f2942019-09-23 14:11:03 +010075 if (!cpio_get_file(cpio, &manifest_vm->kernel_filename, &kernel)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +000076 dlog_error("Could not find kernel file \"%s\".\n",
77 string_data(&manifest_vm->kernel_filename));
Andrew Scull72b43c02019-09-18 13:53:45 +010078 return false;
79 }
80
Fuad Tabba50469e02020-06-30 15:14:28 +010081 size = memiter_size(&kernel);
82 if (pa_difference(begin, end) < size) {
Andrew Walbran17eebf92020-02-05 16:35:49 +000083 dlog_error("Kernel is larger than available memory.\n");
Andrew Scull72b43c02019-09-18 13:53:45 +010084 return false;
85 }
86
87 if (!copy_to_unmapped(stage1_locked, begin, &kernel, ppool)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +000088 dlog_error("Unable to copy kernel.\n");
Andrew Scull72b43c02019-09-18 13:53:45 +010089 return false;
90 }
91
Fuad Tabba50469e02020-06-30 15:14:28 +010092 if (kernel_size) {
93 *kernel_size = size;
94 }
95
Andrew Scull72b43c02019-09-18 13:53:45 +010096 return true;
97}
98
Manish Pandeyd34f8892020-06-19 17:41:07 +010099/*
100 * Link RX/TX buffers provided in partition manifest to mailbox
101 */
102static bool link_rxtx_to_mailbox(struct mm_stage1_locked stage1_locked,
103 struct vm_locked vm_locked, struct rx_tx rxtx,
104 struct mpool *ppool)
105{
106 struct ffa_value ret;
107 ipaddr_t send;
108 ipaddr_t recv;
109 uint32_t page_count;
110
111 send = ipa_init(rxtx.tx_buffer->base_address);
112 recv = ipa_init(rxtx.rx_buffer->base_address);
113 page_count = rxtx.tx_buffer->page_count;
114
115 ret = api_vm_configure_pages(stage1_locked, vm_locked, send, recv,
116 page_count, ppool);
117 if (ret.func != FFA_SUCCESS_32) {
118 return false;
119 }
120
121 dlog_verbose(" mailbox: send = %#x, recv = %#x\n",
122 vm_locked.vm->mailbox.send, vm_locked.vm->mailbox.recv);
123
124 return true;
125}
126
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100127/**
Andrew Scullae9962e2019-10-03 16:51:16 +0100128 * Performs VM loading activities that are common between the primary and
129 * secondaries.
130 */
Manish Pandeyd34f8892020-06-19 17:41:07 +0100131static bool load_common(struct mm_stage1_locked stage1_locked,
132 struct vm_locked vm_locked,
133 const struct manifest_vm *manifest_vm,
134 struct mpool *ppool)
Andrew Scullae9962e2019-10-03 16:51:16 +0100135{
Manish Pandeyd34f8892020-06-19 17:41:07 +0100136 vm_locked.vm->smc_whitelist = manifest_vm->smc_whitelist;
137 vm_locked.vm->uuid = manifest_vm->sp.uuid;
Andrew Scullae9962e2019-10-03 16:51:16 +0100138
Manish Pandeyd34f8892020-06-19 17:41:07 +0100139 if (manifest_vm->is_ffa_partition) {
140 /* Link rxtx buffers to mailbox */
141 if (manifest_vm->sp.rxtx.available) {
142 if (!link_rxtx_to_mailbox(stage1_locked, vm_locked,
143 manifest_vm->sp.rxtx,
144 ppool)) {
145 dlog_error(
146 "Unable to Link RX/TX buffer with "
147 "mailbox.\n");
148 return false;
149 }
150 }
J-Alvesb37fd082020-10-22 12:29:21 +0100151
152 vm_locked.vm->boot_order = manifest_vm->sp.boot_order;
153 /* Updating boot list according to boot_order */
154 vm_update_boot(vm_locked.vm);
Manish Pandeyd34f8892020-06-19 17:41:07 +0100155 }
J-Alvesb37fd082020-10-22 12:29:21 +0100156
Fuad Tabba56970712020-01-10 11:20:09 +0000157 /* Initialize architecture-specific features. */
Manish Pandeyd34f8892020-06-19 17:41:07 +0100158 arch_vm_features_set(vm_locked.vm);
Fuad Tabba77a4b012019-11-15 12:13:08 +0000159
Andrew Scullae9962e2019-10-03 16:51:16 +0100160 return true;
161}
162
163/**
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100164 * Loads the primary VM.
165 */
Andrew Scull72b43c02019-09-18 13:53:45 +0100166static bool load_primary(struct mm_stage1_locked stage1_locked,
Andrew Scullae9962e2019-10-03 16:51:16 +0100167 const struct manifest_vm *manifest_vm,
Andrew Scullb5f49e02019-10-02 13:20:47 +0100168 const struct memiter *cpio,
169 const struct boot_params *params, struct mpool *ppool)
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100170{
Olivier Deprez62d99e32020-01-09 15:58:07 +0100171 paddr_t primary_begin;
172 ipaddr_t primary_entry;
David Brazdile6f83222019-09-23 14:47:37 +0100173 struct vm *vm;
Andrew Scull3c257452019-11-26 13:32:50 +0000174 struct vm_locked vm_locked;
David Brazdile6f83222019-09-23 14:47:37 +0100175 struct vcpu_locked vcpu_locked;
Andrew Scullb5f49e02019-10-02 13:20:47 +0100176 size_t i;
Andrew Scull3c257452019-11-26 13:32:50 +0000177 bool ret;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100178
Olivier Deprez62d99e32020-01-09 15:58:07 +0100179 if (manifest_vm->is_ffa_partition) {
180 primary_begin = pa_init(manifest_vm->sp.load_addr);
181 primary_entry = ipa_add(ipa_from_pa(primary_begin),
182 manifest_vm->sp.ep_offset);
183 } else {
184 primary_begin =
185 (manifest_vm->primary.boot_address ==
186 MANIFEST_INVALID_ADDRESS)
187 ? layout_primary_begin()
188 : pa_init(manifest_vm->primary.boot_address);
189 primary_entry = ipa_from_pa(primary_begin);
190 }
191
David Brazdil080ee312020-02-25 15:30:30 -0800192 paddr_t primary_end = pa_add(primary_begin, RSIZE_MAX);
Andrew Scull72b43c02019-09-18 13:53:45 +0100193
Olivier Deprez62d99e32020-01-09 15:58:07 +0100194 /*
195 * Load the kernel if a filename is specified in the VM manifest.
196 * For an FF-A partition, kernel_filename is undefined indicating
197 * the partition package has already been loaded prior to Hafnium
198 * booting.
199 */
200 if (!string_is_empty(&manifest_vm->kernel_filename)) {
201 if (!load_kernel(stage1_locked, primary_begin, primary_end,
Fuad Tabba50469e02020-06-30 15:14:28 +0100202 manifest_vm, cpio, ppool, NULL)) {
Olivier Deprez62d99e32020-01-09 15:58:07 +0100203 dlog_error("Unable to load primary kernel.\n");
204 return false;
205 }
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100206 }
207
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100208 if (!vm_init_next(MAX_CPUS, ppool, &vm)) {
Andrew Walbran7586e042020-02-18 18:19:26 +0000209 dlog_error("Unable to initialise primary VM.\n");
David Brazdile6f83222019-09-23 14:47:37 +0100210 return false;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100211 }
212
David Brazdile6f83222019-09-23 14:47:37 +0100213 if (vm->id != HF_PRIMARY_VM_ID) {
Andrew Walbran7586e042020-02-18 18:19:26 +0000214 dlog_error("Primary VM was not given correct ID.\n");
David Brazdile6f83222019-09-23 14:47:37 +0100215 return false;
216 }
217
Andrew Scull3c257452019-11-26 13:32:50 +0000218 vm_locked = vm_lock(vm);
219
Andrew Scull48929fd2020-01-28 10:39:10 +0000220 if (params->device_mem_ranges_count == 0) {
221 /*
222 * Map 1TB of address space as device memory to, most likely,
223 * make all devices available to the primary VM.
224 *
225 * TODO: remove this once all targets provide valid ranges.
226 */
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800227 dlog_warning(
228 "Device memory not provided, defaulting to 1 TB.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000229
230 if (!vm_identity_map(
231 vm_locked, pa_init(0),
232 pa_init(UINT64_C(1024) * 1024 * 1024 * 1024),
233 MM_MODE_R | MM_MODE_W | MM_MODE_D, ppool, NULL)) {
234 dlog_error(
235 "Unable to initialise address space for "
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800236 "primary VM.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000237 ret = false;
238 goto out;
239 }
David Brazdile6f83222019-09-23 14:47:37 +0100240 }
241
Andrew Scullb5f49e02019-10-02 13:20:47 +0100242 /* Map normal memory as such to permit caching, execution, etc. */
243 for (i = 0; i < params->mem_ranges_count; ++i) {
Andrew Scull3c257452019-11-26 13:32:50 +0000244 if (!vm_identity_map(vm_locked, params->mem_ranges[i].begin,
245 params->mem_ranges[i].end,
246 MM_MODE_R | MM_MODE_W | MM_MODE_X, ppool,
247 NULL)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000248 dlog_error(
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800249 "Unable to initialise memory for primary "
250 "VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000251 ret = false;
252 goto out;
Andrew Scullb5f49e02019-10-02 13:20:47 +0100253 }
254 }
255
Andrew Scull48929fd2020-01-28 10:39:10 +0000256 /* Map device memory as such to prevent execution, speculation etc. */
257 for (i = 0; i < params->device_mem_ranges_count; ++i) {
258 if (!vm_identity_map(
259 vm_locked, params->device_mem_ranges[i].begin,
260 params->device_mem_ranges[i].end,
261 MM_MODE_R | MM_MODE_W | MM_MODE_D, ppool, NULL)) {
262 dlog("Unable to initialise device memory for primary "
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800263 "VM.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000264 ret = false;
265 goto out;
266 }
267 }
268
Manish Pandeyd34f8892020-06-19 17:41:07 +0100269 if (!load_common(stage1_locked, vm_locked, manifest_vm, ppool)) {
270 ret = false;
271 goto out;
272 }
273
Andrew Scull3c257452019-11-26 13:32:50 +0000274 if (!vm_unmap_hypervisor(vm_locked, ppool)) {
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800275 dlog_error("Unable to unmap hypervisor from primary VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000276 ret = false;
277 goto out;
David Brazdile6f83222019-09-23 14:47:37 +0100278 }
279
Andrew Scullb1a6d0d2020-01-29 11:25:12 +0000280 if (!plat_iommu_unmap_iommus(vm_locked, ppool)) {
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800281 dlog_error("Unable to unmap IOMMUs from primary VM.\n");
Andrew Scullb1a6d0d2020-01-29 11:25:12 +0000282 ret = false;
283 goto out;
284 }
285
Andrew Walbran7586e042020-02-18 18:19:26 +0000286 dlog_info("Loaded primary VM with %u vCPUs, entry at %#x.\n",
287 vm->vcpu_count, pa_addr(primary_begin));
288
Olivier Deprezb9adff42021-02-01 12:14:05 +0100289 /* Mark the primary to be the first booted VM */
290 vm_update_boot(vm);
291
David Brazdile6f83222019-09-23 14:47:37 +0100292 vcpu_locked = vcpu_lock(vm_get_vcpu(vm, 0));
Olivier Deprez62d99e32020-01-09 15:58:07 +0100293 vcpu_on(vcpu_locked, primary_entry, params->kernel_arg);
David Brazdile6f83222019-09-23 14:47:37 +0100294 vcpu_unlock(&vcpu_locked);
Andrew Scull3c257452019-11-26 13:32:50 +0000295 ret = true;
David Brazdile6f83222019-09-23 14:47:37 +0100296
Andrew Scull3c257452019-11-26 13:32:50 +0000297out:
298 vm_unlock(&vm_locked);
299
300 return ret;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100301}
302
Fuad Tabba50469e02020-06-30 15:14:28 +0100303/**
304 * Loads the secondary VM's FDT.
305 * Stores the total allocated size for the FDT in fdt_allocated_size (if
306 * fdt_allocated_size is not NULL). The allocated size includes additional space
307 * for potential patching.
308 */
309static bool load_secondary_fdt(struct mm_stage1_locked stage1_locked,
310 paddr_t end, size_t fdt_max_size,
311 const struct manifest_vm *manifest_vm,
312 const struct memiter *cpio, struct mpool *ppool,
313 paddr_t *fdt_addr, size_t *fdt_allocated_size)
314{
315 struct memiter fdt;
316 size_t allocated_size;
317
318 CHECK(!string_is_empty(&manifest_vm->secondary.fdt_filename));
319
320 if (!cpio_get_file(cpio, &manifest_vm->secondary.fdt_filename, &fdt)) {
321 dlog_error("Cannot open the secondary VM's FDT.\n");
322 return false;
323 }
324
325 /*
326 * Ensure the FDT has one additional page at the end for patching, and
327 * and align it to the page boundary.
328 */
329 allocated_size = align_up(memiter_size(&fdt), PAGE_SIZE) + PAGE_SIZE;
330
331 if (allocated_size > fdt_max_size) {
332 dlog_error(
333 "FDT allocated space (%u) is more than the specified "
334 "maximum to use (%u).\n",
335 allocated_size, fdt_max_size);
336 return false;
337 }
338
339 /* Load the FDT to the end of the VM's allocated memory space. */
340 *fdt_addr = pa_init(pa_addr(pa_sub(end, allocated_size)));
341
342 dlog_info("Loading secondary FDT of allocated size %u at 0x%x.\n",
343 allocated_size, pa_addr(*fdt_addr));
344
345 if (!copy_to_unmapped(stage1_locked, *fdt_addr, &fdt, ppool)) {
346 dlog_error("Unable to copy FDT.\n");
347 return false;
348 }
349
350 if (fdt_allocated_size) {
351 *fdt_allocated_size = allocated_size;
352 }
353
354 return true;
355}
356
Andrew Scull72b43c02019-09-18 13:53:45 +0100357/*
358 * Loads a secondary VM.
359 */
360static bool load_secondary(struct mm_stage1_locked stage1_locked,
Manish Pandey2145c212020-05-01 16:04:22 +0100361 struct vm_locked primary_vm_locked,
Andrew Scull72b43c02019-09-18 13:53:45 +0100362 paddr_t mem_begin, paddr_t mem_end,
363 const struct manifest_vm *manifest_vm,
364 const struct memiter *cpio, struct mpool *ppool)
365{
366 struct vm *vm;
Andrew Scull3c257452019-11-26 13:32:50 +0000367 struct vm_locked vm_locked;
Max Shvetsov40108e72020-08-27 12:39:50 +0100368 struct vcpu_locked vcpu_locked;
Andrew Scull72b43c02019-09-18 13:53:45 +0100369 struct vcpu *vcpu;
370 ipaddr_t secondary_entry;
Andrew Scull3c257452019-11-26 13:32:50 +0000371 bool ret;
Fuad Tabba50469e02020-06-30 15:14:28 +0100372 paddr_t fdt_addr;
373 bool has_fdt;
374 size_t kernel_size = 0;
375 const size_t mem_size = pa_difference(mem_begin, mem_end);
Andrew Scull72b43c02019-09-18 13:53:45 +0100376
Olivier Deprez62d99e32020-01-09 15:58:07 +0100377 /*
378 * Load the kernel if a filename is specified in the VM manifest.
379 * For an FF-A partition, kernel_filename is undefined indicating
380 * the partition package has already been loaded prior to Hafnium
381 * booting.
382 */
383 if (!string_is_empty(&manifest_vm->kernel_filename)) {
384 if (!load_kernel(stage1_locked, mem_begin, mem_end, manifest_vm,
Fuad Tabba50469e02020-06-30 15:14:28 +0100385 cpio, ppool, &kernel_size)) {
Olivier Deprez62d99e32020-01-09 15:58:07 +0100386 dlog_error("Unable to load kernel.\n");
387 return false;
388 }
Andrew Scull72b43c02019-09-18 13:53:45 +0100389 }
390
Fuad Tabba50469e02020-06-30 15:14:28 +0100391 has_fdt = !string_is_empty(&manifest_vm->secondary.fdt_filename);
392 if (has_fdt) {
393 /*
394 * Ensure that the FDT does not overwrite the kernel or overlap
395 * its page, for the FDT to start at a page boundary.
396 */
397 const size_t fdt_max_size =
398 mem_size - align_up(kernel_size, PAGE_SIZE);
399
400 size_t fdt_allocated_size;
401
402 if (!load_secondary_fdt(stage1_locked, mem_end, fdt_max_size,
403 manifest_vm, cpio, ppool, &fdt_addr,
404 &fdt_allocated_size)) {
405 dlog_error("Unable to load FDT.\n");
406 return false;
407 }
408
409 if (!fdt_patch_mem(stage1_locked, fdt_addr, fdt_allocated_size,
410 mem_begin, mem_end, ppool)) {
411 dlog_error("Unable to patch FDT.\n");
412 return false;
413 }
414 }
415
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100416 if (!vm_init_next(manifest_vm->secondary.vcpu_count, ppool, &vm)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000417 dlog_error("Unable to initialise VM.\n");
Andrew Scull72b43c02019-09-18 13:53:45 +0100418 return false;
419 }
420
Andrew Scull3c257452019-11-26 13:32:50 +0000421 vm_locked = vm_lock(vm);
422
Andrew Scull72b43c02019-09-18 13:53:45 +0100423 /* Grant the VM access to the memory. */
Andrew Scull3c257452019-11-26 13:32:50 +0000424 if (!vm_identity_map(vm_locked, mem_begin, mem_end,
425 MM_MODE_R | MM_MODE_W | MM_MODE_X, ppool,
426 &secondary_entry)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000427 dlog_error("Unable to initialise memory.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000428 ret = false;
429 goto out;
Andrew Scull72b43c02019-09-18 13:53:45 +0100430 }
431
Olivier Deprez62d99e32020-01-09 15:58:07 +0100432 if (manifest_vm->is_ffa_partition) {
Manish Pandey2145c212020-05-01 16:04:22 +0100433 int j = 0;
434 paddr_t region_begin;
435 paddr_t region_end;
436 paddr_t alloc_base = mem_end;
437 size_t size;
438 size_t total_alloc = 0;
439
440 /* Map memory-regions */
441 while (j < manifest_vm->sp.mem_region_count) {
442 size = manifest_vm->sp.mem_regions[j].page_count *
443 PAGE_SIZE;
444 /*
445 * For memory-regions without base-address, memory
446 * should be allocated inside partition's page table.
447 * Start allocating memory regions in partition's
448 * page table, starting from the end.
449 * TODO: Add mechanism to let partition know of these
450 * memory regions
451 */
452 if (manifest_vm->sp.mem_regions[j].base_address ==
453 MANIFEST_INVALID_ADDRESS) {
454 total_alloc += size;
455 /* Don't go beyond half the VM's memory space */
456 if (total_alloc >
457 (manifest_vm->secondary.mem_size / 2)) {
458 dlog_error(
459 "Not enough space for memory-"
460 "region allocation");
461 ret = false;
462 goto out;
463 }
464
465 region_end = alloc_base;
466 region_begin = pa_subtract(alloc_base, size);
467 alloc_base = region_begin;
468
469 if (!vm_identity_map(
470 vm_locked, region_begin, region_end,
471 manifest_vm->sp.mem_regions[j]
472 .attributes,
473 ppool, NULL)) {
474 dlog_error(
475 "Unable to map secondary VM "
476 "memory-region.\n");
477 ret = false;
478 goto out;
479 }
480
481 dlog_info(
482 " Memory region %#x - %#x allocated\n",
483 region_begin, region_end);
484 } else {
485 /*
486 * Identity map memory region for both case,
487 * VA(S-EL0) or IPA(S-EL1).
488 */
489 region_begin =
490 pa_init(manifest_vm->sp.mem_regions[j]
491 .base_address);
492 region_end = pa_add(region_begin, size);
493
494 if (!vm_identity_map(
495 vm_locked, region_begin, region_end,
496 manifest_vm->sp.mem_regions[j]
497 .attributes,
498 ppool, NULL)) {
499 dlog_error(
500 "Unable to map secondary VM "
501 "memory-region.\n");
502 ret = false;
503 goto out;
504 }
505 }
506
507 /* Deny the primary VM access to this memory */
508 if (!vm_unmap(primary_vm_locked, region_begin,
509 region_end, ppool)) {
510 dlog_error(
511 "Unable to unmap secondary VM memory-"
512 "region from primary VM.\n");
513 ret = false;
514 goto out;
515 }
516
517 j++;
518 }
519
520 /* Map device-regions */
521 j = 0;
522 while (j < manifest_vm->sp.dev_region_count) {
523 region_begin = pa_init(
524 manifest_vm->sp.dev_regions[j].base_address);
525 size = manifest_vm->sp.dev_regions[j].page_count *
526 PAGE_SIZE;
527 region_end = pa_add(region_begin, size);
528
529 if (!vm_identity_map(
530 vm_locked, region_begin, region_end,
531 manifest_vm->sp.dev_regions[j].attributes,
532 ppool, NULL)) {
533 dlog_error(
534 "Unable to map secondary VM "
535 "device-region.\n");
536 ret = false;
537 goto out;
538 }
539 /* Deny primary VM access to this region */
540 if (!vm_unmap(primary_vm_locked, region_begin,
541 region_end, ppool)) {
542 dlog_error(
543 "Unable to unmap secondary VM device-"
544 "region from primary VM.\n");
545 ret = false;
546 goto out;
547 }
548 j++;
549 }
550
Olivier Deprez62d99e32020-01-09 15:58:07 +0100551 secondary_entry =
552 ipa_add(secondary_entry, manifest_vm->sp.ep_offset);
553 }
554
Manish Pandeyd34f8892020-06-19 17:41:07 +0100555 if (!load_common(stage1_locked, vm_locked, manifest_vm, ppool)) {
556 ret = false;
557 goto out;
558 }
559
Manish Pandey2145c212020-05-01 16:04:22 +0100560 dlog_info("Loaded with %u vCPUs, entry at %#x.\n",
561 manifest_vm->secondary.vcpu_count, pa_addr(mem_begin));
562
Andrew Scull72b43c02019-09-18 13:53:45 +0100563 vcpu = vm_get_vcpu(vm, 0);
Fuad Tabba50469e02020-06-30 15:14:28 +0100564
Max Shvetsov40108e72020-08-27 12:39:50 +0100565 vcpu_locked = vcpu_lock(vcpu);
Fuad Tabba50469e02020-06-30 15:14:28 +0100566 if (has_fdt) {
Max Shvetsov40108e72020-08-27 12:39:50 +0100567 vcpu_secondary_reset_and_start(vcpu_locked, secondary_entry,
Fuad Tabba50469e02020-06-30 15:14:28 +0100568 pa_addr(fdt_addr));
569 } else {
570 /*
571 * Without an FDT, secondary VMs expect the memory size to be
572 * passed in register x0, which is what
573 * vcpu_secondary_reset_and_start does in this case.
574 */
Max Shvetsov40108e72020-08-27 12:39:50 +0100575 vcpu_secondary_reset_and_start(vcpu_locked, secondary_entry,
576 mem_size);
Fuad Tabba50469e02020-06-30 15:14:28 +0100577 }
578
Max Shvetsov40108e72020-08-27 12:39:50 +0100579 vcpu_unlock(&vcpu_locked);
580
Andrew Scull3c257452019-11-26 13:32:50 +0000581 ret = true;
Andrew Scull72b43c02019-09-18 13:53:45 +0100582
Andrew Scull3c257452019-11-26 13:32:50 +0000583out:
584 vm_unlock(&vm_locked);
585
586 return ret;
Andrew Scull72b43c02019-09-18 13:53:45 +0100587}
588
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100589/**
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100590 * Try to find a memory range of the given size within the given ranges, and
591 * remove it from them. Return true on success, or false if no large enough
592 * contiguous range is found.
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100593 */
Hong-Seok Kim09648362019-05-23 15:47:11 +0900594static bool carve_out_mem_range(struct mem_range *mem_ranges,
595 size_t mem_ranges_count, uint64_t size_to_find,
596 paddr_t *found_begin, paddr_t *found_end)
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100597{
598 size_t i;
599
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000600 /*
601 * TODO(b/116191358): Consider being cleverer about how we pack VMs
602 * together, with a non-greedy algorithm.
603 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100604 for (i = 0; i < mem_ranges_count; ++i) {
605 if (size_to_find <=
Andrew Walbran2cb43392019-04-17 12:52:45 +0100606 pa_difference(mem_ranges[i].begin, mem_ranges[i].end)) {
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100607 /*
608 * This range is big enough, take some of it from the
609 * end and reduce its size accordingly.
610 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100611 *found_end = mem_ranges[i].end;
612 *found_begin = pa_init(pa_addr(mem_ranges[i].end) -
613 size_to_find);
614 mem_ranges[i].end = *found_begin;
615 return true;
616 }
617 }
618 return false;
619}
620
621/**
622 * Given arrays of memory ranges before and after memory was removed for
623 * secondary VMs, add the difference to the reserved ranges of the given update.
624 * Return true on success, or false if there would be more than MAX_MEM_RANGES
625 * reserved ranges after adding the new ones.
626 * `before` and `after` must be arrays of exactly `mem_ranges_count` elements.
627 */
Hong-Seok Kim09648362019-05-23 15:47:11 +0900628static bool update_reserved_ranges(struct boot_params_update *update,
629 const struct mem_range *before,
630 const struct mem_range *after,
631 size_t mem_ranges_count)
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100632{
633 size_t i;
634
635 for (i = 0; i < mem_ranges_count; ++i) {
636 if (pa_addr(after[i].begin) > pa_addr(before[i].begin)) {
637 if (update->reserved_ranges_count >= MAX_MEM_RANGES) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000638 dlog_error(
639 "Too many reserved ranges after "
640 "loading secondary VMs.\n");
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100641 return false;
642 }
643 update->reserved_ranges[update->reserved_ranges_count]
644 .begin = before[i].begin;
645 update->reserved_ranges[update->reserved_ranges_count]
646 .end = after[i].begin;
647 update->reserved_ranges_count++;
648 }
649 if (pa_addr(after[i].end) < pa_addr(before[i].end)) {
650 if (update->reserved_ranges_count >= MAX_MEM_RANGES) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000651 dlog_error(
652 "Too many reserved ranges after "
653 "loading secondary VMs.\n");
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100654 return false;
655 }
656 update->reserved_ranges[update->reserved_ranges_count]
657 .begin = after[i].end;
658 update->reserved_ranges[update->reserved_ranges_count]
659 .end = before[i].end;
660 update->reserved_ranges_count++;
661 }
662 }
663
664 return true;
665}
666
Olivier Deprez112d2b52020-09-30 07:39:23 +0200667static bool init_other_world_vm(struct mpool *ppool)
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100668{
Olivier Deprez96a2a262020-06-11 17:21:38 +0200669 struct vm *other_world_vm;
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100670 size_t i;
Andrew Scull72b43c02019-09-18 13:53:45 +0100671
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100672 /*
Olivier Deprez96a2a262020-06-11 17:21:38 +0200673 * Initialise the dummy VM which represents the opposite world:
674 * -TrustZone (or the SPMC) when running the Hypervisor
675 * -the Hypervisor when running TZ/SPMC
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100676 */
Olivier Deprez96a2a262020-06-11 17:21:38 +0200677 other_world_vm = vm_init(HF_OTHER_WORLD_ID, MAX_CPUS, ppool);
678 CHECK(other_world_vm != NULL);
679
680 for (i = 0; i < MAX_CPUS; i++) {
681 struct vcpu *vcpu = vm_get_vcpu(other_world_vm, i);
682 struct cpu *cpu = cpu_find_index(i);
683
684 vcpu->cpu = cpu;
685 }
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100686
Olivier Deprez112d2b52020-09-30 07:39:23 +0200687 return arch_other_world_vm_init(other_world_vm, ppool);
688}
689
690/*
691 * Loads alls VMs from the manifest.
692 */
693bool load_vms(struct mm_stage1_locked stage1_locked,
694 const struct manifest *manifest, const struct memiter *cpio,
695 const struct boot_params *params,
696 struct boot_params_update *update, struct mpool *ppool)
697{
698 struct vm *primary;
699 struct mem_range mem_ranges_available[MAX_MEM_RANGES];
700 struct vm_locked primary_vm_locked;
701 size_t i;
702 bool success = true;
703
Andrew Walbranf8716782020-10-29 17:07:07 +0000704 /**
705 * Only try to load the primary VM if it is supposed to be in this
706 * world.
707 */
708 if (vm_id_is_current_world(HF_PRIMARY_VM_ID)) {
709 if (!load_primary(stage1_locked,
710 &manifest->vm[HF_PRIMARY_VM_INDEX], cpio,
711 params, ppool)) {
712 dlog_error("Unable to load primary VM.\n");
713 return false;
714 }
Olivier Deprez112d2b52020-09-30 07:39:23 +0200715 }
716
717 if (!init_other_world_vm(ppool)) {
718 return false;
719 }
720
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100721 static_assert(
722 sizeof(mem_ranges_available) == sizeof(params->mem_ranges),
723 "mem_range arrays must be the same size for memcpy.");
724 static_assert(sizeof(mem_ranges_available) < 500,
725 "This will use too much stack, either make "
726 "MAX_MEM_RANGES smaller or change this.");
Andrew Sculla1aa2ba2019-04-05 11:49:02 +0100727 memcpy_s(mem_ranges_available, sizeof(mem_ranges_available),
728 params->mem_ranges, sizeof(params->mem_ranges));
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100729
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100730 /* Round the last addresses down to the page size. */
731 for (i = 0; i < params->mem_ranges_count; ++i) {
Alfredo Mazzinghieb1997c2019-02-07 18:00:01 +0000732 mem_ranges_available[i].end = pa_init(align_down(
733 pa_addr(mem_ranges_available[i].end), PAGE_SIZE));
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100734 }
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100735
Andrew Scull3c257452019-11-26 13:32:50 +0000736 primary = vm_find(HF_PRIMARY_VM_ID);
737 primary_vm_locked = vm_lock(primary);
738
David Brazdil0251b942019-09-10 15:59:50 +0100739 for (i = 0; i < manifest->vm_count; ++i) {
David Brazdil0dbb41f2019-09-09 18:03:35 +0100740 const struct manifest_vm *manifest_vm = &manifest->vm[i];
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100741 ffa_vm_id_t vm_id = HF_VM_ID_OFFSET + i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100742 uint64_t mem_size;
Andrew Scull80871322018-08-06 12:04:09 +0100743 paddr_t secondary_mem_begin;
744 paddr_t secondary_mem_end;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100745
David Brazdil7a462ec2019-08-15 12:27:47 +0100746 if (vm_id == HF_PRIMARY_VM_ID) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100747 continue;
748 }
749
Olivier Deprez2a8ee342020-08-03 15:10:44 +0200750 dlog_info("Loading VM id %#x: %s.\n", vm_id,
Andrew Walbran17eebf92020-02-05 16:35:49 +0000751 manifest_vm->debug_name);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100752
David Brazdil7a462ec2019-08-15 12:27:47 +0100753 mem_size = align_up(manifest_vm->secondary.mem_size, PAGE_SIZE);
Olivier Deprez62d99e32020-01-09 15:58:07 +0100754
755 if (manifest_vm->is_ffa_partition) {
756 secondary_mem_begin =
757 pa_init(manifest_vm->sp.load_addr);
758 secondary_mem_end =
759 pa_init(manifest_vm->sp.load_addr + mem_size);
760 } else if (!carve_out_mem_range(mem_ranges_available,
761 params->mem_ranges_count,
762 mem_size, &secondary_mem_begin,
763 &secondary_mem_end)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000764 dlog_error("Not enough memory (%u bytes).\n", mem_size);
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100765 continue;
766 }
Andrew Scull80871322018-08-06 12:04:09 +0100767
Manish Pandey2145c212020-05-01 16:04:22 +0100768 if (!load_secondary(stage1_locked, primary_vm_locked,
769 secondary_mem_begin, secondary_mem_end,
770 manifest_vm, cpio, ppool)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000771 dlog_error("Unable to load VM.\n");
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100772 continue;
773 }
774
775 /* Deny the primary VM access to this memory. */
Andrew Scull3c257452019-11-26 13:32:50 +0000776 if (!vm_unmap(primary_vm_locked, secondary_mem_begin,
777 secondary_mem_end, ppool)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000778 dlog_error(
779 "Unable to unmap secondary VM from primary "
780 "VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000781 success = false;
782 break;
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100783 }
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100784 }
785
Andrew Scull3c257452019-11-26 13:32:50 +0000786 vm_unlock(&primary_vm_locked);
787
788 if (!success) {
789 return false;
790 }
791
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100792 /*
793 * Add newly reserved areas to update params by looking at the
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100794 * difference between the available ranges from the original params and
795 * the updated mem_ranges_available. We assume that the number and order
796 * of available ranges is the same, i.e. we don't remove any ranges
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100797 * above only make them smaller.
798 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100799 return update_reserved_ranges(update, params->mem_ranges,
800 mem_ranges_available,
801 params->mem_ranges_count);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100802}