blob: b071babb935cb2c466b79b63e35d4c8dc7172c70 [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
Manish Pandeyf3be6392020-09-24 17:26:09 +0100152 if (manifest_vm->sp.messaging_method ==
153 DIRECT_MESSAGING_MANAGED_EXIT ||
154 manifest_vm->sp.messaging_method ==
155 BOTH_MESSAGING_MANAGED_EXIT) {
156 vm_locked.vm->supports_managed_exit = true;
157 }
158
J-Alvesb37fd082020-10-22 12:29:21 +0100159 vm_locked.vm->boot_order = manifest_vm->sp.boot_order;
160 /* Updating boot list according to boot_order */
161 vm_update_boot(vm_locked.vm);
Manish Pandeyd34f8892020-06-19 17:41:07 +0100162 }
J-Alvesb37fd082020-10-22 12:29:21 +0100163
Fuad Tabba56970712020-01-10 11:20:09 +0000164 /* Initialize architecture-specific features. */
Manish Pandeyd34f8892020-06-19 17:41:07 +0100165 arch_vm_features_set(vm_locked.vm);
Fuad Tabba77a4b012019-11-15 12:13:08 +0000166
Madhukar Pappireddy54680c72020-10-23 15:02:38 -0500167 if (!plat_iommu_attach_peripheral(stage1_locked, vm_locked, manifest_vm,
168 ppool)) {
169 dlog_error("Unable to attach upstream peripheral device\n");
170 return false;
171 }
172
Andrew Scullae9962e2019-10-03 16:51:16 +0100173 return true;
174}
175
176/**
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100177 * Loads the primary VM.
178 */
Andrew Scull72b43c02019-09-18 13:53:45 +0100179static bool load_primary(struct mm_stage1_locked stage1_locked,
Andrew Scullae9962e2019-10-03 16:51:16 +0100180 const struct manifest_vm *manifest_vm,
Andrew Scullb5f49e02019-10-02 13:20:47 +0100181 const struct memiter *cpio,
182 const struct boot_params *params, struct mpool *ppool)
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100183{
Olivier Deprez62d99e32020-01-09 15:58:07 +0100184 paddr_t primary_begin;
185 ipaddr_t primary_entry;
David Brazdile6f83222019-09-23 14:47:37 +0100186 struct vm *vm;
Andrew Scull3c257452019-11-26 13:32:50 +0000187 struct vm_locked vm_locked;
David Brazdile6f83222019-09-23 14:47:37 +0100188 struct vcpu_locked vcpu_locked;
Andrew Scullb5f49e02019-10-02 13:20:47 +0100189 size_t i;
Andrew Scull3c257452019-11-26 13:32:50 +0000190 bool ret;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100191
Olivier Deprez62d99e32020-01-09 15:58:07 +0100192 if (manifest_vm->is_ffa_partition) {
193 primary_begin = pa_init(manifest_vm->sp.load_addr);
194 primary_entry = ipa_add(ipa_from_pa(primary_begin),
195 manifest_vm->sp.ep_offset);
196 } else {
197 primary_begin =
198 (manifest_vm->primary.boot_address ==
199 MANIFEST_INVALID_ADDRESS)
200 ? layout_primary_begin()
201 : pa_init(manifest_vm->primary.boot_address);
202 primary_entry = ipa_from_pa(primary_begin);
203 }
204
David Brazdil080ee312020-02-25 15:30:30 -0800205 paddr_t primary_end = pa_add(primary_begin, RSIZE_MAX);
Andrew Scull72b43c02019-09-18 13:53:45 +0100206
Olivier Deprez62d99e32020-01-09 15:58:07 +0100207 /*
208 * Load the kernel if a filename is specified in the VM manifest.
209 * For an FF-A partition, kernel_filename is undefined indicating
210 * the partition package has already been loaded prior to Hafnium
211 * booting.
212 */
213 if (!string_is_empty(&manifest_vm->kernel_filename)) {
214 if (!load_kernel(stage1_locked, primary_begin, primary_end,
Fuad Tabba50469e02020-06-30 15:14:28 +0100215 manifest_vm, cpio, ppool, NULL)) {
Olivier Deprez62d99e32020-01-09 15:58:07 +0100216 dlog_error("Unable to load primary kernel.\n");
217 return false;
218 }
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100219 }
220
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100221 if (!vm_init_next(MAX_CPUS, ppool, &vm)) {
Andrew Walbran7586e042020-02-18 18:19:26 +0000222 dlog_error("Unable to initialise primary VM.\n");
David Brazdile6f83222019-09-23 14:47:37 +0100223 return false;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100224 }
225
David Brazdile6f83222019-09-23 14:47:37 +0100226 if (vm->id != HF_PRIMARY_VM_ID) {
Andrew Walbran7586e042020-02-18 18:19:26 +0000227 dlog_error("Primary VM was not given correct ID.\n");
David Brazdile6f83222019-09-23 14:47:37 +0100228 return false;
229 }
230
Andrew Scull3c257452019-11-26 13:32:50 +0000231 vm_locked = vm_lock(vm);
232
Andrew Scull48929fd2020-01-28 10:39:10 +0000233 if (params->device_mem_ranges_count == 0) {
234 /*
235 * Map 1TB of address space as device memory to, most likely,
236 * make all devices available to the primary VM.
237 *
238 * TODO: remove this once all targets provide valid ranges.
239 */
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800240 dlog_warning(
241 "Device memory not provided, defaulting to 1 TB.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000242
243 if (!vm_identity_map(
244 vm_locked, pa_init(0),
245 pa_init(UINT64_C(1024) * 1024 * 1024 * 1024),
246 MM_MODE_R | MM_MODE_W | MM_MODE_D, ppool, NULL)) {
247 dlog_error(
248 "Unable to initialise address space for "
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800249 "primary VM.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000250 ret = false;
251 goto out;
252 }
David Brazdile6f83222019-09-23 14:47:37 +0100253 }
254
Andrew Scullb5f49e02019-10-02 13:20:47 +0100255 /* Map normal memory as such to permit caching, execution, etc. */
256 for (i = 0; i < params->mem_ranges_count; ++i) {
Andrew Scull3c257452019-11-26 13:32:50 +0000257 if (!vm_identity_map(vm_locked, params->mem_ranges[i].begin,
258 params->mem_ranges[i].end,
259 MM_MODE_R | MM_MODE_W | MM_MODE_X, ppool,
260 NULL)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000261 dlog_error(
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800262 "Unable to initialise memory for primary "
263 "VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000264 ret = false;
265 goto out;
Andrew Scullb5f49e02019-10-02 13:20:47 +0100266 }
267 }
268
Andrew Scull48929fd2020-01-28 10:39:10 +0000269 /* Map device memory as such to prevent execution, speculation etc. */
270 for (i = 0; i < params->device_mem_ranges_count; ++i) {
271 if (!vm_identity_map(
272 vm_locked, params->device_mem_ranges[i].begin,
273 params->device_mem_ranges[i].end,
274 MM_MODE_R | MM_MODE_W | MM_MODE_D, ppool, NULL)) {
275 dlog("Unable to initialise device memory for primary "
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800276 "VM.\n");
Andrew Scull48929fd2020-01-28 10:39:10 +0000277 ret = false;
278 goto out;
279 }
280 }
281
Manish Pandeyd34f8892020-06-19 17:41:07 +0100282 if (!load_common(stage1_locked, vm_locked, manifest_vm, ppool)) {
283 ret = false;
284 goto out;
285 }
286
Andrew Scull3c257452019-11-26 13:32:50 +0000287 if (!vm_unmap_hypervisor(vm_locked, ppool)) {
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800288 dlog_error("Unable to unmap hypervisor from primary VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000289 ret = false;
290 goto out;
David Brazdile6f83222019-09-23 14:47:37 +0100291 }
292
Andrew Scullb1a6d0d2020-01-29 11:25:12 +0000293 if (!plat_iommu_unmap_iommus(vm_locked, ppool)) {
Andrew Scullf6ab9bc2020-02-26 12:56:37 -0800294 dlog_error("Unable to unmap IOMMUs from primary VM.\n");
Andrew Scullb1a6d0d2020-01-29 11:25:12 +0000295 ret = false;
296 goto out;
297 }
298
Andrew Walbran7586e042020-02-18 18:19:26 +0000299 dlog_info("Loaded primary VM with %u vCPUs, entry at %#x.\n",
300 vm->vcpu_count, pa_addr(primary_begin));
301
Olivier Deprezb9adff42021-02-01 12:14:05 +0100302 /* Mark the primary to be the first booted VM */
303 vm_update_boot(vm);
304
David Brazdile6f83222019-09-23 14:47:37 +0100305 vcpu_locked = vcpu_lock(vm_get_vcpu(vm, 0));
Olivier Deprez62d99e32020-01-09 15:58:07 +0100306 vcpu_on(vcpu_locked, primary_entry, params->kernel_arg);
David Brazdile6f83222019-09-23 14:47:37 +0100307 vcpu_unlock(&vcpu_locked);
Andrew Scull3c257452019-11-26 13:32:50 +0000308 ret = true;
David Brazdile6f83222019-09-23 14:47:37 +0100309
Andrew Scull3c257452019-11-26 13:32:50 +0000310out:
311 vm_unlock(&vm_locked);
312
313 return ret;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100314}
315
Fuad Tabba50469e02020-06-30 15:14:28 +0100316/**
317 * Loads the secondary VM's FDT.
318 * Stores the total allocated size for the FDT in fdt_allocated_size (if
319 * fdt_allocated_size is not NULL). The allocated size includes additional space
320 * for potential patching.
321 */
322static bool load_secondary_fdt(struct mm_stage1_locked stage1_locked,
323 paddr_t end, size_t fdt_max_size,
324 const struct manifest_vm *manifest_vm,
325 const struct memiter *cpio, struct mpool *ppool,
326 paddr_t *fdt_addr, size_t *fdt_allocated_size)
327{
328 struct memiter fdt;
329 size_t allocated_size;
330
331 CHECK(!string_is_empty(&manifest_vm->secondary.fdt_filename));
332
333 if (!cpio_get_file(cpio, &manifest_vm->secondary.fdt_filename, &fdt)) {
334 dlog_error("Cannot open the secondary VM's FDT.\n");
335 return false;
336 }
337
338 /*
339 * Ensure the FDT has one additional page at the end for patching, and
340 * and align it to the page boundary.
341 */
342 allocated_size = align_up(memiter_size(&fdt), PAGE_SIZE) + PAGE_SIZE;
343
344 if (allocated_size > fdt_max_size) {
345 dlog_error(
346 "FDT allocated space (%u) is more than the specified "
347 "maximum to use (%u).\n",
348 allocated_size, fdt_max_size);
349 return false;
350 }
351
352 /* Load the FDT to the end of the VM's allocated memory space. */
353 *fdt_addr = pa_init(pa_addr(pa_sub(end, allocated_size)));
354
355 dlog_info("Loading secondary FDT of allocated size %u at 0x%x.\n",
356 allocated_size, pa_addr(*fdt_addr));
357
358 if (!copy_to_unmapped(stage1_locked, *fdt_addr, &fdt, ppool)) {
359 dlog_error("Unable to copy FDT.\n");
360 return false;
361 }
362
363 if (fdt_allocated_size) {
364 *fdt_allocated_size = allocated_size;
365 }
366
367 return true;
368}
369
Andrew Scull72b43c02019-09-18 13:53:45 +0100370/*
371 * Loads a secondary VM.
372 */
373static bool load_secondary(struct mm_stage1_locked stage1_locked,
Manish Pandey2145c212020-05-01 16:04:22 +0100374 struct vm_locked primary_vm_locked,
Andrew Scull72b43c02019-09-18 13:53:45 +0100375 paddr_t mem_begin, paddr_t mem_end,
376 const struct manifest_vm *manifest_vm,
377 const struct memiter *cpio, struct mpool *ppool)
378{
379 struct vm *vm;
Andrew Scull3c257452019-11-26 13:32:50 +0000380 struct vm_locked vm_locked;
Max Shvetsov40108e72020-08-27 12:39:50 +0100381 struct vcpu_locked vcpu_locked;
Andrew Scull72b43c02019-09-18 13:53:45 +0100382 struct vcpu *vcpu;
383 ipaddr_t secondary_entry;
Andrew Scull3c257452019-11-26 13:32:50 +0000384 bool ret;
Fuad Tabba50469e02020-06-30 15:14:28 +0100385 paddr_t fdt_addr;
386 bool has_fdt;
387 size_t kernel_size = 0;
388 const size_t mem_size = pa_difference(mem_begin, mem_end);
Andrew Scull72b43c02019-09-18 13:53:45 +0100389
Olivier Deprez62d99e32020-01-09 15:58:07 +0100390 /*
391 * Load the kernel if a filename is specified in the VM manifest.
392 * For an FF-A partition, kernel_filename is undefined indicating
393 * the partition package has already been loaded prior to Hafnium
394 * booting.
395 */
396 if (!string_is_empty(&manifest_vm->kernel_filename)) {
397 if (!load_kernel(stage1_locked, mem_begin, mem_end, manifest_vm,
Fuad Tabba50469e02020-06-30 15:14:28 +0100398 cpio, ppool, &kernel_size)) {
Olivier Deprez62d99e32020-01-09 15:58:07 +0100399 dlog_error("Unable to load kernel.\n");
400 return false;
401 }
Andrew Scull72b43c02019-09-18 13:53:45 +0100402 }
403
Fuad Tabba50469e02020-06-30 15:14:28 +0100404 has_fdt = !string_is_empty(&manifest_vm->secondary.fdt_filename);
405 if (has_fdt) {
406 /*
407 * Ensure that the FDT does not overwrite the kernel or overlap
408 * its page, for the FDT to start at a page boundary.
409 */
410 const size_t fdt_max_size =
411 mem_size - align_up(kernel_size, PAGE_SIZE);
412
413 size_t fdt_allocated_size;
414
415 if (!load_secondary_fdt(stage1_locked, mem_end, fdt_max_size,
416 manifest_vm, cpio, ppool, &fdt_addr,
417 &fdt_allocated_size)) {
418 dlog_error("Unable to load FDT.\n");
419 return false;
420 }
421
422 if (!fdt_patch_mem(stage1_locked, fdt_addr, fdt_allocated_size,
423 mem_begin, mem_end, ppool)) {
424 dlog_error("Unable to patch FDT.\n");
425 return false;
426 }
427 }
428
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100429 if (!vm_init_next(manifest_vm->secondary.vcpu_count, ppool, &vm)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000430 dlog_error("Unable to initialise VM.\n");
Andrew Scull72b43c02019-09-18 13:53:45 +0100431 return false;
432 }
433
Andrew Scull3c257452019-11-26 13:32:50 +0000434 vm_locked = vm_lock(vm);
435
Andrew Scull72b43c02019-09-18 13:53:45 +0100436 /* Grant the VM access to the memory. */
Andrew Scull3c257452019-11-26 13:32:50 +0000437 if (!vm_identity_map(vm_locked, mem_begin, mem_end,
438 MM_MODE_R | MM_MODE_W | MM_MODE_X, ppool,
439 &secondary_entry)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000440 dlog_error("Unable to initialise memory.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000441 ret = false;
442 goto out;
Andrew Scull72b43c02019-09-18 13:53:45 +0100443 }
444
Olivier Deprez62d99e32020-01-09 15:58:07 +0100445 if (manifest_vm->is_ffa_partition) {
Manish Pandey2145c212020-05-01 16:04:22 +0100446 int j = 0;
447 paddr_t region_begin;
448 paddr_t region_end;
449 paddr_t alloc_base = mem_end;
450 size_t size;
451 size_t total_alloc = 0;
452
453 /* Map memory-regions */
454 while (j < manifest_vm->sp.mem_region_count) {
455 size = manifest_vm->sp.mem_regions[j].page_count *
456 PAGE_SIZE;
457 /*
458 * For memory-regions without base-address, memory
459 * should be allocated inside partition's page table.
460 * Start allocating memory regions in partition's
461 * page table, starting from the end.
462 * TODO: Add mechanism to let partition know of these
463 * memory regions
464 */
465 if (manifest_vm->sp.mem_regions[j].base_address ==
466 MANIFEST_INVALID_ADDRESS) {
467 total_alloc += size;
468 /* Don't go beyond half the VM's memory space */
469 if (total_alloc >
470 (manifest_vm->secondary.mem_size / 2)) {
471 dlog_error(
472 "Not enough space for memory-"
473 "region allocation");
474 ret = false;
475 goto out;
476 }
477
478 region_end = alloc_base;
479 region_begin = pa_subtract(alloc_base, size);
480 alloc_base = region_begin;
481
482 if (!vm_identity_map(
483 vm_locked, region_begin, region_end,
484 manifest_vm->sp.mem_regions[j]
485 .attributes,
486 ppool, NULL)) {
487 dlog_error(
488 "Unable to map secondary VM "
489 "memory-region.\n");
490 ret = false;
491 goto out;
492 }
493
494 dlog_info(
495 " Memory region %#x - %#x allocated\n",
496 region_begin, region_end);
497 } else {
498 /*
499 * Identity map memory region for both case,
500 * VA(S-EL0) or IPA(S-EL1).
501 */
502 region_begin =
503 pa_init(manifest_vm->sp.mem_regions[j]
504 .base_address);
505 region_end = pa_add(region_begin, size);
506
507 if (!vm_identity_map(
508 vm_locked, region_begin, region_end,
509 manifest_vm->sp.mem_regions[j]
510 .attributes,
511 ppool, NULL)) {
512 dlog_error(
513 "Unable to map secondary VM "
514 "memory-region.\n");
515 ret = false;
516 goto out;
517 }
518 }
519
520 /* Deny the primary VM access to this memory */
521 if (!vm_unmap(primary_vm_locked, region_begin,
522 region_end, ppool)) {
523 dlog_error(
524 "Unable to unmap secondary VM memory-"
525 "region from primary VM.\n");
526 ret = false;
527 goto out;
528 }
529
530 j++;
531 }
532
533 /* Map device-regions */
534 j = 0;
535 while (j < manifest_vm->sp.dev_region_count) {
536 region_begin = pa_init(
537 manifest_vm->sp.dev_regions[j].base_address);
538 size = manifest_vm->sp.dev_regions[j].page_count *
539 PAGE_SIZE;
540 region_end = pa_add(region_begin, size);
541
542 if (!vm_identity_map(
543 vm_locked, region_begin, region_end,
544 manifest_vm->sp.dev_regions[j].attributes,
545 ppool, NULL)) {
546 dlog_error(
547 "Unable to map secondary VM "
548 "device-region.\n");
549 ret = false;
550 goto out;
551 }
552 /* Deny primary VM access to this region */
553 if (!vm_unmap(primary_vm_locked, region_begin,
554 region_end, ppool)) {
555 dlog_error(
556 "Unable to unmap secondary VM device-"
557 "region from primary VM.\n");
558 ret = false;
559 goto out;
560 }
561 j++;
562 }
563
Olivier Deprez62d99e32020-01-09 15:58:07 +0100564 secondary_entry =
565 ipa_add(secondary_entry, manifest_vm->sp.ep_offset);
566 }
567
Manish Pandeyd34f8892020-06-19 17:41:07 +0100568 if (!load_common(stage1_locked, vm_locked, manifest_vm, ppool)) {
569 ret = false;
570 goto out;
571 }
572
Manish Pandey2145c212020-05-01 16:04:22 +0100573 dlog_info("Loaded with %u vCPUs, entry at %#x.\n",
574 manifest_vm->secondary.vcpu_count, pa_addr(mem_begin));
575
Andrew Scull72b43c02019-09-18 13:53:45 +0100576 vcpu = vm_get_vcpu(vm, 0);
Fuad Tabba50469e02020-06-30 15:14:28 +0100577
Max Shvetsov40108e72020-08-27 12:39:50 +0100578 vcpu_locked = vcpu_lock(vcpu);
Fuad Tabba50469e02020-06-30 15:14:28 +0100579 if (has_fdt) {
Max Shvetsov40108e72020-08-27 12:39:50 +0100580 vcpu_secondary_reset_and_start(vcpu_locked, secondary_entry,
Fuad Tabba50469e02020-06-30 15:14:28 +0100581 pa_addr(fdt_addr));
582 } else {
583 /*
584 * Without an FDT, secondary VMs expect the memory size to be
585 * passed in register x0, which is what
586 * vcpu_secondary_reset_and_start does in this case.
587 */
Max Shvetsov40108e72020-08-27 12:39:50 +0100588 vcpu_secondary_reset_and_start(vcpu_locked, secondary_entry,
589 mem_size);
Fuad Tabba50469e02020-06-30 15:14:28 +0100590 }
591
Max Shvetsov40108e72020-08-27 12:39:50 +0100592 vcpu_unlock(&vcpu_locked);
593
Andrew Scull3c257452019-11-26 13:32:50 +0000594 ret = true;
Andrew Scull72b43c02019-09-18 13:53:45 +0100595
Andrew Scull3c257452019-11-26 13:32:50 +0000596out:
597 vm_unlock(&vm_locked);
598
599 return ret;
Andrew Scull72b43c02019-09-18 13:53:45 +0100600}
601
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100602/**
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100603 * Try to find a memory range of the given size within the given ranges, and
604 * remove it from them. Return true on success, or false if no large enough
605 * contiguous range is found.
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100606 */
Hong-Seok Kim09648362019-05-23 15:47:11 +0900607static bool carve_out_mem_range(struct mem_range *mem_ranges,
608 size_t mem_ranges_count, uint64_t size_to_find,
609 paddr_t *found_begin, paddr_t *found_end)
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100610{
611 size_t i;
612
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000613 /*
614 * TODO(b/116191358): Consider being cleverer about how we pack VMs
615 * together, with a non-greedy algorithm.
616 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100617 for (i = 0; i < mem_ranges_count; ++i) {
618 if (size_to_find <=
Andrew Walbran2cb43392019-04-17 12:52:45 +0100619 pa_difference(mem_ranges[i].begin, mem_ranges[i].end)) {
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100620 /*
621 * This range is big enough, take some of it from the
622 * end and reduce its size accordingly.
623 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100624 *found_end = mem_ranges[i].end;
625 *found_begin = pa_init(pa_addr(mem_ranges[i].end) -
626 size_to_find);
627 mem_ranges[i].end = *found_begin;
628 return true;
629 }
630 }
631 return false;
632}
633
634/**
635 * Given arrays of memory ranges before and after memory was removed for
636 * secondary VMs, add the difference to the reserved ranges of the given update.
637 * Return true on success, or false if there would be more than MAX_MEM_RANGES
638 * reserved ranges after adding the new ones.
639 * `before` and `after` must be arrays of exactly `mem_ranges_count` elements.
640 */
Hong-Seok Kim09648362019-05-23 15:47:11 +0900641static bool update_reserved_ranges(struct boot_params_update *update,
642 const struct mem_range *before,
643 const struct mem_range *after,
644 size_t mem_ranges_count)
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100645{
646 size_t i;
647
648 for (i = 0; i < mem_ranges_count; ++i) {
649 if (pa_addr(after[i].begin) > pa_addr(before[i].begin)) {
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 = before[i].begin;
658 update->reserved_ranges[update->reserved_ranges_count]
659 .end = after[i].begin;
660 update->reserved_ranges_count++;
661 }
662 if (pa_addr(after[i].end) < pa_addr(before[i].end)) {
663 if (update->reserved_ranges_count >= MAX_MEM_RANGES) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000664 dlog_error(
665 "Too many reserved ranges after "
666 "loading secondary VMs.\n");
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100667 return false;
668 }
669 update->reserved_ranges[update->reserved_ranges_count]
670 .begin = after[i].end;
671 update->reserved_ranges[update->reserved_ranges_count]
672 .end = before[i].end;
673 update->reserved_ranges_count++;
674 }
675 }
676
677 return true;
678}
679
Olivier Deprez112d2b52020-09-30 07:39:23 +0200680static bool init_other_world_vm(struct mpool *ppool)
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100681{
Olivier Deprez96a2a262020-06-11 17:21:38 +0200682 struct vm *other_world_vm;
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100683 size_t i;
Andrew Scull72b43c02019-09-18 13:53:45 +0100684
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100685 /*
Olivier Deprez96a2a262020-06-11 17:21:38 +0200686 * Initialise the dummy VM which represents the opposite world:
687 * -TrustZone (or the SPMC) when running the Hypervisor
688 * -the Hypervisor when running TZ/SPMC
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100689 */
Olivier Deprez96a2a262020-06-11 17:21:38 +0200690 other_world_vm = vm_init(HF_OTHER_WORLD_ID, MAX_CPUS, ppool);
691 CHECK(other_world_vm != NULL);
692
693 for (i = 0; i < MAX_CPUS; i++) {
694 struct vcpu *vcpu = vm_get_vcpu(other_world_vm, i);
695 struct cpu *cpu = cpu_find_index(i);
696
697 vcpu->cpu = cpu;
698 }
Andrew Walbran9daa57e2019-09-27 13:33:20 +0100699
Olivier Deprez112d2b52020-09-30 07:39:23 +0200700 return arch_other_world_vm_init(other_world_vm, ppool);
701}
702
703/*
704 * Loads alls VMs from the manifest.
705 */
706bool load_vms(struct mm_stage1_locked stage1_locked,
707 const struct manifest *manifest, const struct memiter *cpio,
708 const struct boot_params *params,
709 struct boot_params_update *update, struct mpool *ppool)
710{
711 struct vm *primary;
712 struct mem_range mem_ranges_available[MAX_MEM_RANGES];
713 struct vm_locked primary_vm_locked;
714 size_t i;
715 bool success = true;
716
Andrew Walbranf8716782020-10-29 17:07:07 +0000717 /**
718 * Only try to load the primary VM if it is supposed to be in this
719 * world.
720 */
721 if (vm_id_is_current_world(HF_PRIMARY_VM_ID)) {
722 if (!load_primary(stage1_locked,
723 &manifest->vm[HF_PRIMARY_VM_INDEX], cpio,
724 params, ppool)) {
725 dlog_error("Unable to load primary VM.\n");
726 return false;
727 }
Olivier Deprez112d2b52020-09-30 07:39:23 +0200728 }
729
730 if (!init_other_world_vm(ppool)) {
731 return false;
732 }
733
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100734 static_assert(
735 sizeof(mem_ranges_available) == sizeof(params->mem_ranges),
736 "mem_range arrays must be the same size for memcpy.");
737 static_assert(sizeof(mem_ranges_available) < 500,
738 "This will use too much stack, either make "
739 "MAX_MEM_RANGES smaller or change this.");
Andrew Sculla1aa2ba2019-04-05 11:49:02 +0100740 memcpy_s(mem_ranges_available, sizeof(mem_ranges_available),
741 params->mem_ranges, sizeof(params->mem_ranges));
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100742
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100743 /* Round the last addresses down to the page size. */
744 for (i = 0; i < params->mem_ranges_count; ++i) {
Alfredo Mazzinghieb1997c2019-02-07 18:00:01 +0000745 mem_ranges_available[i].end = pa_init(align_down(
746 pa_addr(mem_ranges_available[i].end), PAGE_SIZE));
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100747 }
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100748
Andrew Scull3c257452019-11-26 13:32:50 +0000749 primary = vm_find(HF_PRIMARY_VM_ID);
750 primary_vm_locked = vm_lock(primary);
751
David Brazdil0251b942019-09-10 15:59:50 +0100752 for (i = 0; i < manifest->vm_count; ++i) {
David Brazdil0dbb41f2019-09-09 18:03:35 +0100753 const struct manifest_vm *manifest_vm = &manifest->vm[i];
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100754 ffa_vm_id_t vm_id = HF_VM_ID_OFFSET + i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100755 uint64_t mem_size;
Andrew Scull80871322018-08-06 12:04:09 +0100756 paddr_t secondary_mem_begin;
757 paddr_t secondary_mem_end;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100758
David Brazdil7a462ec2019-08-15 12:27:47 +0100759 if (vm_id == HF_PRIMARY_VM_ID) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100760 continue;
761 }
762
Olivier Deprez2a8ee342020-08-03 15:10:44 +0200763 dlog_info("Loading VM id %#x: %s.\n", vm_id,
Andrew Walbran17eebf92020-02-05 16:35:49 +0000764 manifest_vm->debug_name);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100765
David Brazdil7a462ec2019-08-15 12:27:47 +0100766 mem_size = align_up(manifest_vm->secondary.mem_size, PAGE_SIZE);
Olivier Deprez62d99e32020-01-09 15:58:07 +0100767
768 if (manifest_vm->is_ffa_partition) {
769 secondary_mem_begin =
770 pa_init(manifest_vm->sp.load_addr);
771 secondary_mem_end =
772 pa_init(manifest_vm->sp.load_addr + mem_size);
773 } else if (!carve_out_mem_range(mem_ranges_available,
774 params->mem_ranges_count,
775 mem_size, &secondary_mem_begin,
776 &secondary_mem_end)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000777 dlog_error("Not enough memory (%u bytes).\n", mem_size);
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100778 continue;
779 }
Andrew Scull80871322018-08-06 12:04:09 +0100780
Manish Pandey2145c212020-05-01 16:04:22 +0100781 if (!load_secondary(stage1_locked, primary_vm_locked,
782 secondary_mem_begin, secondary_mem_end,
783 manifest_vm, cpio, ppool)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000784 dlog_error("Unable to load VM.\n");
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100785 continue;
786 }
787
788 /* Deny the primary VM access to this memory. */
Andrew Scull3c257452019-11-26 13:32:50 +0000789 if (!vm_unmap(primary_vm_locked, secondary_mem_begin,
790 secondary_mem_end, ppool)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000791 dlog_error(
792 "Unable to unmap secondary VM from primary "
793 "VM.\n");
Andrew Scull3c257452019-11-26 13:32:50 +0000794 success = false;
795 break;
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100796 }
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100797 }
798
Andrew Scull3c257452019-11-26 13:32:50 +0000799 vm_unlock(&primary_vm_locked);
800
801 if (!success) {
802 return false;
803 }
804
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100805 /*
806 * Add newly reserved areas to update params by looking at the
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100807 * difference between the available ranges from the original params and
808 * the updated mem_ranges_available. We assume that the number and order
809 * of available ranges is the same, i.e. we don't remove any ranges
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100810 * above only make them smaller.
811 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100812 return update_reserved_ranges(update, params->mem_ranges,
813 mem_ranges_available,
814 params->mem_ranges_count);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100815}