blob: e5076b676ba499418d5050cca6c2877bd2e8f36e [file] [log] [blame]
David Brazdil7a462ec2019-08-15 12:27:47 +01001/*
2 * Copyright 2019 The Hafnium Authors.
3 *
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.
David Brazdil7a462ec2019-08-15 12:27:47 +01007 */
8
9#include "hf/manifest.h"
10
11#include "hf/addr.h"
12#include "hf/check.h"
Andrew Scullae9962e2019-10-03 16:51:16 +010013#include "hf/dlog.h"
David Brazdil7a462ec2019-08-15 12:27:47 +010014#include "hf/fdt.h"
15#include "hf/static_assert.h"
16#include "hf/std.h"
17
18#define TRY(expr) \
19 do { \
20 enum manifest_return_code ret_code = (expr); \
21 if (ret_code != MANIFEST_SUCCESS) { \
22 return ret_code; \
23 } \
24 } while (0)
25
David Brazdilb856be62020-03-25 10:14:55 +000026#define VM_ID_MAX (HF_VM_ID_OFFSET + MAX_VMS - 1)
27#define VM_ID_MAX_DIGITS (5)
28#define VM_NAME_EXTRA_CHARS (3) /* "vm" + number + '\0' */
29#define VM_NAME_MAX_SIZE (VM_ID_MAX_DIGITS + VM_NAME_EXTRA_CHARS)
30static_assert(VM_NAME_MAX_SIZE <= STRING_MAX_SIZE,
31 "VM name does not fit into a struct string.");
32static_assert(VM_ID_MAX <= 99999, "Insufficient VM_NAME_BUF_SIZE");
33static_assert(HF_TEE_VM_ID > VM_ID_MAX,
Andrew Walbran9daa57e2019-09-27 13:33:20 +010034 "TrustZone VM ID clashes with normal VM range.");
David Brazdil7a462ec2019-08-15 12:27:47 +010035
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010036static inline size_t count_digits(ffa_vm_id_t vm_id)
David Brazdilb856be62020-03-25 10:14:55 +000037{
38 size_t digits = 0;
39
40 do {
41 digits++;
42 vm_id /= 10;
43 } while (vm_id);
44 return digits;
45}
46
David Brazdil7a462ec2019-08-15 12:27:47 +010047/**
48 * Generates a string with the two letters "vm" followed by an integer.
49 * Assumes `buf` is of size VM_NAME_BUF_SIZE.
50 */
Andrew Walbranb5ab43c2020-04-30 11:32:54 +010051static void generate_vm_node_name(struct string *str, ffa_vm_id_t vm_id)
David Brazdil7a462ec2019-08-15 12:27:47 +010052{
53 static const char *digits = "0123456789";
David Brazdilb856be62020-03-25 10:14:55 +000054 size_t vm_id_digits = count_digits(vm_id);
55 char *base = str->data;
56 char *ptr = base + (VM_NAME_EXTRA_CHARS + vm_id_digits);
David Brazdil7a462ec2019-08-15 12:27:47 +010057
David Brazdilb856be62020-03-25 10:14:55 +000058 CHECK(vm_id_digits <= VM_ID_MAX_DIGITS);
David Brazdil7a462ec2019-08-15 12:27:47 +010059 *(--ptr) = '\0';
60 do {
61 *(--ptr) = digits[vm_id % 10];
62 vm_id /= 10;
63 } while (vm_id);
64 *(--ptr) = 'm';
65 *(--ptr) = 'v';
David Brazdilb856be62020-03-25 10:14:55 +000066 CHECK(ptr == base);
David Brazdil7a462ec2019-08-15 12:27:47 +010067}
68
Andrew Scullae9962e2019-10-03 16:51:16 +010069/**
Andrew Scullb2c3a242019-11-04 13:52:36 +000070 * Read a boolean property: true if present; false if not. If present, the value
71 * of the property must be empty else it is considered malformed.
Andrew Scullae9962e2019-10-03 16:51:16 +010072 */
Andrew Scullb2c3a242019-11-04 13:52:36 +000073static enum manifest_return_code read_bool(const struct fdt_node *node,
74 const char *property, bool *out)
Andrew Scullae9962e2019-10-03 16:51:16 +010075{
David Brazdilb856be62020-03-25 10:14:55 +000076 struct memiter data;
77 bool present = fdt_read_property(node, property, &data);
Andrew Scullae9962e2019-10-03 16:51:16 +010078
David Brazdilb856be62020-03-25 10:14:55 +000079 if (present && memiter_size(&data) != 0) {
Andrew Scullb2c3a242019-11-04 13:52:36 +000080 return MANIFEST_ERROR_MALFORMED_BOOLEAN;
81 }
82
83 *out = present;
84 return MANIFEST_SUCCESS;
Andrew Scullae9962e2019-10-03 16:51:16 +010085}
86
Andrew Scull72b43c02019-09-18 13:53:45 +010087static enum manifest_return_code read_string(const struct fdt_node *node,
David Brazdil136f2942019-09-23 14:11:03 +010088 const char *property,
89 struct string *out)
Andrew Scull72b43c02019-09-18 13:53:45 +010090{
David Brazdilb856be62020-03-25 10:14:55 +000091 struct memiter data;
Andrew Scull72b43c02019-09-18 13:53:45 +010092
David Brazdilb856be62020-03-25 10:14:55 +000093 if (!fdt_read_property(node, property, &data)) {
Andrew Scull72b43c02019-09-18 13:53:45 +010094 return MANIFEST_ERROR_PROPERTY_NOT_FOUND;
95 }
96
David Brazdilb856be62020-03-25 10:14:55 +000097 switch (string_init(out, &data)) {
David Brazdil136f2942019-09-23 14:11:03 +010098 case STRING_SUCCESS:
99 return MANIFEST_SUCCESS;
100 case STRING_ERROR_INVALID_INPUT:
101 return MANIFEST_ERROR_MALFORMED_STRING;
102 case STRING_ERROR_TOO_LONG:
103 return MANIFEST_ERROR_STRING_TOO_LONG;
104 }
Andrew Scull72b43c02019-09-18 13:53:45 +0100105}
106
107static enum manifest_return_code read_optional_string(
David Brazdil136f2942019-09-23 14:11:03 +0100108 const struct fdt_node *node, const char *property, struct string *out)
Andrew Scull72b43c02019-09-18 13:53:45 +0100109{
David Brazdil136f2942019-09-23 14:11:03 +0100110 enum manifest_return_code ret;
Andrew Scull72b43c02019-09-18 13:53:45 +0100111
David Brazdil136f2942019-09-23 14:11:03 +0100112 ret = read_string(node, property, out);
113 if (ret == MANIFEST_ERROR_PROPERTY_NOT_FOUND) {
114 string_init_empty(out);
115 ret = MANIFEST_SUCCESS;
Andrew Scull72b43c02019-09-18 13:53:45 +0100116 }
David Brazdil136f2942019-09-23 14:11:03 +0100117 return ret;
Andrew Scull72b43c02019-09-18 13:53:45 +0100118}
119
David Brazdil7a462ec2019-08-15 12:27:47 +0100120static enum manifest_return_code read_uint64(const struct fdt_node *node,
121 const char *property,
122 uint64_t *out)
123{
David Brazdilb856be62020-03-25 10:14:55 +0000124 struct memiter data;
David Brazdil7a462ec2019-08-15 12:27:47 +0100125
David Brazdilb856be62020-03-25 10:14:55 +0000126 if (!fdt_read_property(node, property, &data)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100127 return MANIFEST_ERROR_PROPERTY_NOT_FOUND;
128 }
129
David Brazdilb856be62020-03-25 10:14:55 +0000130 if (!fdt_parse_number(&data, memiter_size(&data), out)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100131 return MANIFEST_ERROR_MALFORMED_INTEGER;
132 }
133
134 return MANIFEST_SUCCESS;
135}
136
David Brazdil080ee312020-02-25 15:30:30 -0800137static enum manifest_return_code read_optional_uint64(
138 const struct fdt_node *node, const char *property,
139 uint64_t default_value, uint64_t *out)
140{
141 enum manifest_return_code ret;
142
143 ret = read_uint64(node, property, out);
144 if (ret == MANIFEST_ERROR_PROPERTY_NOT_FOUND) {
145 *out = default_value;
146 return MANIFEST_SUCCESS;
147 }
148 return ret;
149}
150
Olivier Deprez62d99e32020-01-09 15:58:07 +0100151static enum manifest_return_code read_uint32(const struct fdt_node *node,
152 const char *property,
153 uint32_t *out)
154{
155 uint64_t value;
156
157 TRY(read_uint64(node, property, &value));
158
159 if (value > UINT32_MAX) {
160 return MANIFEST_ERROR_INTEGER_OVERFLOW;
161 }
162
163 *out = (uint32_t)value;
164 return MANIFEST_SUCCESS;
165}
166
Manish Pandeye68e7932020-04-23 15:29:28 +0100167static enum manifest_return_code read_optional_uint32(
168 const struct fdt_node *node, const char *property,
169 uint32_t default_value, uint32_t *out)
170{
171 enum manifest_return_code ret;
172
173 ret = read_uint32(node, property, out);
174 if (ret == MANIFEST_ERROR_PROPERTY_NOT_FOUND) {
175 *out = default_value;
176 return MANIFEST_SUCCESS;
177 }
178 return ret;
179}
180
David Brazdil7a462ec2019-08-15 12:27:47 +0100181static enum manifest_return_code read_uint16(const struct fdt_node *node,
182 const char *property,
183 uint16_t *out)
184{
185 uint64_t value;
186
187 TRY(read_uint64(node, property, &value));
188
189 if (value > UINT16_MAX) {
190 return MANIFEST_ERROR_INTEGER_OVERFLOW;
191 }
192
193 *out = (uint16_t)value;
194 return MANIFEST_SUCCESS;
195}
196
Olivier Deprez62d99e32020-01-09 15:58:07 +0100197static enum manifest_return_code read_uint8(const struct fdt_node *node,
198 const char *property, uint8_t *out)
199{
200 uint64_t value;
201
202 TRY(read_uint64(node, property, &value));
203
204 if (value > UINT8_MAX) {
205 return MANIFEST_ERROR_INTEGER_OVERFLOW;
206 }
207
208 *out = (uint8_t)value;
209 return MANIFEST_SUCCESS;
210}
211
Andrew Scullae9962e2019-10-03 16:51:16 +0100212struct uint32list_iter {
213 struct memiter mem_it;
214};
215
216static enum manifest_return_code read_optional_uint32list(
217 const struct fdt_node *node, const char *property,
218 struct uint32list_iter *out)
219{
David Brazdilb856be62020-03-25 10:14:55 +0000220 struct memiter data;
Andrew Scullae9962e2019-10-03 16:51:16 +0100221
David Brazdilb856be62020-03-25 10:14:55 +0000222 if (!fdt_read_property(node, property, &data)) {
Andrew Scullae9962e2019-10-03 16:51:16 +0100223 memiter_init(&out->mem_it, NULL, 0);
224 return MANIFEST_SUCCESS;
225 }
226
David Brazdilb856be62020-03-25 10:14:55 +0000227 if ((memiter_size(&data) % sizeof(uint32_t)) != 0) {
Andrew Scullae9962e2019-10-03 16:51:16 +0100228 return MANIFEST_ERROR_MALFORMED_INTEGER_LIST;
229 }
230
David Brazdilb856be62020-03-25 10:14:55 +0000231 out->mem_it = data;
Andrew Scullae9962e2019-10-03 16:51:16 +0100232 return MANIFEST_SUCCESS;
233}
234
Andrew Scullae9962e2019-10-03 16:51:16 +0100235static bool uint32list_has_next(const struct uint32list_iter *list)
236{
237 return memiter_size(&list->mem_it) > 0;
238}
239
David Brazdil5ea99462020-03-25 13:01:47 +0000240static enum manifest_return_code uint32list_get_next(
241 struct uint32list_iter *list, uint32_t *out)
Andrew Scullae9962e2019-10-03 16:51:16 +0100242{
Andrew Scullae9962e2019-10-03 16:51:16 +0100243 uint64_t num;
244
245 CHECK(uint32list_has_next(list));
David Brazdilb856be62020-03-25 10:14:55 +0000246 if (!fdt_parse_number(&list->mem_it, sizeof(uint32_t), &num)) {
Andrew Scullae9962e2019-10-03 16:51:16 +0100247 return MANIFEST_ERROR_MALFORMED_INTEGER;
248 }
249
David Brazdil5ea99462020-03-25 13:01:47 +0000250 *out = (uint32_t)num;
251 return MANIFEST_SUCCESS;
Andrew Scullae9962e2019-10-03 16:51:16 +0100252}
253
Olivier Deprez62d99e32020-01-09 15:58:07 +0100254static enum manifest_return_code parse_vm_common(const struct fdt_node *node,
255 struct manifest_vm *vm,
256 ffa_vm_id_t vm_id)
David Brazdil7a462ec2019-08-15 12:27:47 +0100257{
Andrew Scullae9962e2019-10-03 16:51:16 +0100258 struct uint32list_iter smcs;
David Brazdil5ea99462020-03-25 13:01:47 +0000259 size_t idx;
Andrew Scullae9962e2019-10-03 16:51:16 +0100260
Olivier Deprez62d99e32020-01-09 15:58:07 +0100261 TRY(read_bool(node, "is_ffa_partition", &vm->is_ffa_partition));
262
David Brazdil136f2942019-09-23 14:11:03 +0100263 TRY(read_string(node, "debug_name", &vm->debug_name));
Andrew Scullae9962e2019-10-03 16:51:16 +0100264
265 TRY(read_optional_uint32list(node, "smc_whitelist", &smcs));
266 while (uint32list_has_next(&smcs) &&
267 vm->smc_whitelist.smc_count < MAX_SMCS) {
David Brazdil5ea99462020-03-25 13:01:47 +0000268 idx = vm->smc_whitelist.smc_count++;
269 TRY(uint32list_get_next(&smcs, &vm->smc_whitelist.smcs[idx]));
Andrew Scullae9962e2019-10-03 16:51:16 +0100270 }
271
272 if (uint32list_has_next(&smcs)) {
Andrew Walbran17eebf92020-02-05 16:35:49 +0000273 dlog_warning("%s SMC whitelist too long.\n", vm->debug_name);
Andrew Scullae9962e2019-10-03 16:51:16 +0100274 }
275
Andrew Scullb2c3a242019-11-04 13:52:36 +0000276 TRY(read_bool(node, "smc_whitelist_permissive",
277 &vm->smc_whitelist.permissive));
Andrew Scullae9962e2019-10-03 16:51:16 +0100278
Olivier Deprez62d99e32020-01-09 15:58:07 +0100279 if (vm_id != HF_PRIMARY_VM_ID) {
280 TRY(read_uint64(node, "mem_size", &vm->secondary.mem_size));
281 TRY(read_uint16(node, "vcpu_count", &vm->secondary.vcpu_count));
Fuad Tabba50469e02020-06-30 15:14:28 +0100282 TRY(read_optional_string(node, "fdt_filename",
283 &vm->secondary.fdt_filename));
Olivier Deprez62d99e32020-01-09 15:58:07 +0100284 }
285
286 return MANIFEST_SUCCESS;
287}
288
289static enum manifest_return_code parse_vm(struct fdt_node *node,
290 struct manifest_vm *vm,
291 ffa_vm_id_t vm_id)
292{
293 TRY(read_optional_string(node, "kernel_filename",
294 &vm->kernel_filename));
295
David Brazdile6f83222019-09-23 14:47:37 +0100296 if (vm_id == HF_PRIMARY_VM_ID) {
297 TRY(read_optional_string(node, "ramdisk_filename",
298 &vm->primary.ramdisk_filename));
David Brazdil080ee312020-02-25 15:30:30 -0800299 TRY(read_optional_uint64(node, "boot_address",
300 MANIFEST_INVALID_ADDRESS,
301 &vm->primary.boot_address));
David Brazdil7a462ec2019-08-15 12:27:47 +0100302 }
Olivier Deprez62d99e32020-01-09 15:58:07 +0100303
David Brazdil7a462ec2019-08-15 12:27:47 +0100304 return MANIFEST_SUCCESS;
305}
306
Manish Pandey6542f5c2020-04-27 14:37:46 +0100307static enum manifest_return_code parse_ffa_memory_region_node(
308 struct fdt_node *mem_node, struct memory_region *mem_regions)
309{
310 unsigned int i = 0;
311
312 dlog_verbose(" Partition memory regions\n");
313
314 if (!fdt_is_compatible(mem_node, "arm,ffa-manifest-memory-regions")) {
315 return MANIFEST_ERROR_NOT_COMPATIBLE;
316 }
317
318 if (!fdt_first_child(mem_node)) {
319 return MANIFEST_ERROR_MEMORY_REGION_NODE_EMPTY;
320 }
321
322 do {
323 dlog_verbose(" Memory Region[%u]\n", i);
324
325 TRY(read_optional_string(mem_node, "description",
326 &mem_regions[i].name));
327 dlog_verbose(" Name: %s\n",
328 string_data(&mem_regions[i].name));
329
330 TRY(read_optional_uint64(mem_node, "base-address",
331 MANIFEST_INVALID_ADDRESS,
332 &mem_regions[i].base_address));
333 dlog_verbose(" Base address: %#x\n",
334 mem_regions[i].base_address);
335
336 TRY(read_uint32(mem_node, "pages-count",
337 &mem_regions[i].page_count));
338 dlog_verbose(" Pages_count: %u\n",
339 mem_regions[i].page_count);
340
341 TRY(read_uint32(mem_node, "attributes",
342 &mem_regions[i].attributes));
343 mem_regions[i].attributes &= MM_PERM_MASK;
344 dlog_verbose(" Attributes: %u\n",
345 mem_regions[i].attributes);
346 i++;
347 } while (fdt_next_sibling(mem_node) && (i < SP_MAX_MEMORY_REGIONS));
348
349 dlog_verbose(" Total %u memory regions found\n", i);
350
351 return MANIFEST_SUCCESS;
352}
353
Manish Pandeye68e7932020-04-23 15:29:28 +0100354static enum manifest_return_code parse_ffa_device_region_node(
355 struct fdt_node *dev_node, struct device_region *dev_regions)
356{
357 struct uint32list_iter list;
358 unsigned int i = 0;
359 unsigned int j = 0;
360
361 dlog_verbose(" Partition Device Regions\n");
362
363 if (!fdt_is_compatible(dev_node, "arm,ffa-manifest-device-regions")) {
364 return MANIFEST_ERROR_NOT_COMPATIBLE;
365 }
366
367 if (!fdt_first_child(dev_node)) {
368 return MANIFEST_ERROR_DEVICE_REGION_NODE_EMPTY;
369 }
370
371 do {
372 dlog_verbose(" Device Region[%u]\n", i);
373
374 TRY(read_optional_string(dev_node, "description",
375 &dev_regions[i].name));
376 dlog_verbose(" Name: %s\n",
377 string_data(&dev_regions[i].name));
378
379 TRY(read_uint64(dev_node, "base-address",
380 &dev_regions[i].base_address));
381 dlog_verbose(" Base address: %#x\n",
382 dev_regions[i].base_address);
383
384 TRY(read_uint32(dev_node, "pages-count",
385 &dev_regions[i].page_count));
386 dlog_verbose(" Pages_count: %u\n",
387 dev_regions[i].page_count);
388
389 TRY(read_uint32(dev_node, "attributes",
390 &dev_regions[i].attributes));
391 dev_regions[i].attributes =
392 (dev_regions[i].attributes & MM_PERM_MASK) | MM_MODE_D;
393 dlog_verbose(" Attributes: %u\n",
394 dev_regions[i].attributes);
395
396 TRY(read_optional_uint32list(dev_node, "interrupts", &list));
397 dlog_verbose(" Interrupt List:\n");
398 j = 0;
399 while (uint32list_has_next(&list) &&
400 j < SP_MAX_INTERRUPTS_PER_DEVICE) {
401 TRY(uint32list_get_next(
402 &list, &dev_regions[i].interrupts[j].id));
403 if (uint32list_has_next(&list)) {
404 TRY(uint32list_get_next(&list,
405 &dev_regions[i]
406 .interrupts[j]
407 .attributes));
408 } else {
409 return MANIFEST_ERROR_MALFORMED_INTEGER_LIST;
410 }
411
412 dlog_verbose(" ID = %u, attributes = %u\n",
413 dev_regions[i].interrupts[j].id,
414 dev_regions[i].interrupts[j].attributes);
415 j++;
416 }
417 if (j == 0) {
418 dlog_verbose(" Empty\n");
419 }
420
421 TRY(read_optional_uint32(dev_node, "smmu-id",
422 (uint32_t)MANIFEST_INVALID_ADDRESS,
423 &dev_regions[i].smmu_id));
424 dlog_verbose(" smmu-id: %u\n", dev_regions[i].smmu_id);
425
426 TRY(read_optional_uint32list(dev_node, "stream-ids", &list));
427 dlog_verbose(" Stream IDs assigned:\n");
428
429 j = 0;
430 while (uint32list_has_next(&list) &&
431 j < SP_MAX_STREAMS_PER_DEVICE) {
432 TRY(uint32list_get_next(&list,
433 &dev_regions[i].stream_ids[j]));
434 dlog_verbose(" %u\n",
435 dev_regions[i].stream_ids[j]);
436 j++;
437 }
438 if (j == 0) {
439 dlog_verbose(" None\n");
440 }
441
442 TRY(read_bool(dev_node, "exclusive-access",
443 &dev_regions[i].exclusive_access));
444 dlog_verbose(" Exclusive_access: %d\n",
445 dev_regions[i].exclusive_access);
446
447 i++;
448 } while (fdt_next_sibling(dev_node) && (i < SP_MAX_DEVICE_REGIONS));
449
450 dlog_verbose(" Total %u device regions found\n", i);
451
452 return MANIFEST_SUCCESS;
453}
454
Olivier Deprez62d99e32020-01-09 15:58:07 +0100455static enum manifest_return_code parse_ffa_manifest(struct fdt *fdt,
456 struct manifest_vm *vm)
457{
458 unsigned int i = 0;
459 struct uint32list_iter uuid;
460 uint32_t uuid_word;
461 struct fdt_node root;
462 struct fdt_node ffa_node;
463 struct string rxtx_node_name = STRING_INIT("rx_tx-info");
Manish Pandey6542f5c2020-04-27 14:37:46 +0100464 struct string mem_region_node_name = STRING_INIT("memory-regions");
Manish Pandeye68e7932020-04-23 15:29:28 +0100465 struct string dev_region_node_name = STRING_INIT("device-regions");
Olivier Deprez62d99e32020-01-09 15:58:07 +0100466
467 if (!fdt_find_node(fdt, "/", &root)) {
468 return MANIFEST_ERROR_NO_ROOT_NODE;
469 }
470
471 /* Check "compatible" property. */
472 if (!fdt_is_compatible(&root, "arm,ffa-manifest-1.0")) {
473 return MANIFEST_ERROR_NOT_COMPATIBLE;
474 }
475
476 TRY(read_uint32(&root, "ffa-version", &vm->sp.ffa_version));
477 dlog_verbose(" SP expected FF-A version %d.%d\n",
478 vm->sp.ffa_version >> 16, vm->sp.ffa_version & 0xffff);
479
480 TRY(read_optional_uint32list(&root, "uuid", &uuid));
481
482 while (uint32list_has_next(&uuid) && i < 4) {
483 TRY(uint32list_get_next(&uuid, &uuid_word));
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100484 vm->sp.uuid.uuid[i] = uuid_word;
Olivier Deprez62d99e32020-01-09 15:58:07 +0100485 i++;
486 }
Fuad Tabba952401e2020-07-24 10:43:40 +0100487 dlog_verbose(" SP UUID %#x-%x-%x_%x\n", vm->sp.uuid.uuid[0],
488 vm->sp.uuid.uuid[1], vm->sp.uuid.uuid[2],
489 vm->sp.uuid.uuid[3]);
Olivier Deprez62d99e32020-01-09 15:58:07 +0100490
491 TRY(read_uint16(&root, "execution-ctx-count",
492 &vm->sp.execution_ctx_count));
493 dlog_verbose(" SP number of execution context %d\n",
494 vm->sp.execution_ctx_count);
495
496 TRY(read_uint8(&root, "exception-level",
497 (uint8_t *)&vm->sp.run_time_el));
498 dlog_verbose(" SP run-time EL %d\n", vm->sp.run_time_el);
499
500 TRY(read_uint8(&root, "execution-state",
501 (uint8_t *)&vm->sp.execution_state));
502 dlog_verbose(" SP execution state %d\n", vm->sp.execution_state);
503
504 TRY(read_uint64(&root, "load-address", &vm->sp.load_addr));
505 dlog_verbose(" SP load address %#x\n", vm->sp.load_addr);
506
507 TRY(read_uint64(&root, "entrypoint-offset", &vm->sp.ep_offset));
508 dlog_verbose(" SP entry point offset %#x\n", vm->sp.ep_offset);
509
510 TRY(read_uint8(&root, "xlat-granule", (uint8_t *)&vm->sp.xlat_granule));
511 dlog_verbose(" SP translation granule %d\n", vm->sp.xlat_granule);
512
513 ffa_node = root;
514 if (fdt_find_child(&ffa_node, &rxtx_node_name)) {
515 if (!fdt_is_compatible(&ffa_node,
516 "arm,ffa-manifest-rx_tx-buffer")) {
517 return MANIFEST_ERROR_NOT_COMPATIBLE;
518 }
519
520 TRY(read_uint64(&ffa_node, "base-address",
521 &vm->sp.rxtx.base_address));
522
523 TRY(read_uint16(&ffa_node, "pages-count",
524 &vm->sp.rxtx.pages_count));
525
526 TRY(read_uint16(&ffa_node, "attributes",
527 &vm->sp.rxtx.attributes));
528
529 vm->sp.rxtx.rxtx_found = true;
530 }
531
532 TRY(read_uint8(&root, "messaging-method",
533 (uint8_t *)&vm->sp.messaging_method));
534 dlog_verbose(" SP messaging method %d\n", vm->sp.messaging_method);
535
Manish Pandey6542f5c2020-04-27 14:37:46 +0100536 /* Parse memory-regions */
537 ffa_node = root;
538 if (fdt_find_child(&ffa_node, &mem_region_node_name)) {
539 TRY(parse_ffa_memory_region_node(&ffa_node,
540 vm->sp.mem_regions));
541 }
542
Manish Pandeye68e7932020-04-23 15:29:28 +0100543 /* Parse Device-regions */
544 ffa_node = root;
545 if (fdt_find_child(&ffa_node, &dev_region_node_name)) {
546 TRY(parse_ffa_device_region_node(&ffa_node,
547 vm->sp.dev_regions));
548 }
549
Olivier Deprez62d99e32020-01-09 15:58:07 +0100550 return MANIFEST_SUCCESS;
551}
552
553static enum manifest_return_code sanity_check_ffa_manifest(
554 struct manifest_vm *vm)
555{
556 uint16_t ffa_version_major;
557 uint16_t ffa_version_minor;
558 enum manifest_return_code ret_code = MANIFEST_SUCCESS;
559 const char *error_string = "specified in manifest is unsupported";
560
561 /* ensure that the SPM version is compatible */
562 ffa_version_major =
563 (vm->sp.ffa_version & 0xffff0000) >> FFA_VERSION_MAJOR_OFFSET;
564 ffa_version_minor = vm->sp.ffa_version & 0xffff;
565
566 if (ffa_version_major != FFA_VERSION_MAJOR ||
567 ffa_version_minor > FFA_VERSION_MINOR) {
568 dlog_error("FF-A partition manifest version %s: %d.%d\n",
569 error_string, ffa_version_major, ffa_version_minor);
570 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
571 }
572
573 if (vm->sp.xlat_granule != PAGE_4KB) {
574 dlog_error("Translation granule %s: %d\n", error_string,
575 vm->sp.xlat_granule);
576 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
577 }
578
579 if (vm->sp.execution_state != AARCH64) {
580 dlog_error("Execution state %s: %d\n", error_string,
581 vm->sp.execution_state);
582 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
583 }
584
585 if (vm->sp.run_time_el != EL1 && vm->sp.run_time_el != S_EL1) {
586 dlog_error("Exception level %s: %d\n", error_string,
587 vm->sp.run_time_el);
588 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
589 }
590
591 if (vm->sp.messaging_method != INDIRECT_MESSAGING) {
592 dlog_error("Messaging method %s: %x\n", error_string,
593 vm->sp.messaging_method);
594 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
595 }
596
597 return ret_code;
598}
599
600static enum manifest_return_code parse_ffa_partition_package(
601 struct mm_stage1_locked stage1_locked, struct fdt_node *node,
602 struct manifest_vm *vm, ffa_vm_id_t vm_id, struct mpool *ppool)
603{
604 enum manifest_return_code ret = MANIFEST_ERROR_NOT_COMPATIBLE;
605 uintpaddr_t sp_pkg_addr;
606 paddr_t sp_pkg_start;
607 paddr_t sp_pkg_end;
608 struct sp_pkg_header *sp_pkg;
609 size_t sp_header_dtb_size;
610 paddr_t sp_dtb_addr;
611 struct fdt sp_fdt;
612
613 /*
614 * This must have been hinted as being an FF-A partition,
615 * return straight with failure if this is not the case.
616 */
617 if (!vm->is_ffa_partition) {
618 return MANIFEST_ERROR_NOT_COMPATIBLE;
619 }
620
621 TRY(read_uint64(node, "load_address", &sp_pkg_addr));
622 if (!is_aligned(sp_pkg_addr, PAGE_SIZE)) {
623 return MANIFEST_ERROR_NOT_COMPATIBLE;
624 }
625
626 /* Map top of SP package as a single page to extract the header */
627 sp_pkg_start = pa_init(sp_pkg_addr);
628 sp_pkg_end = pa_add(sp_pkg_start, PAGE_SIZE);
629 sp_pkg = mm_identity_map(stage1_locked, sp_pkg_start,
630 pa_add(sp_pkg_start, PAGE_SIZE), MM_MODE_R,
631 ppool);
632 CHECK(sp_pkg != NULL);
633
634 dlog_verbose("SP package load address %#x\n", sp_pkg_addr);
635
636 if (sp_pkg->magic != SP_PKG_HEADER_MAGIC) {
637 dlog_error("Invalid SP package magic.\n");
638 goto exit_unmap;
639 }
640
641 if (sp_pkg->version != SP_PKG_HEADER_VERSION) {
642 dlog_error("Invalid SP package version.\n");
643 goto exit_unmap;
644 }
645
646 /* Expect SP DTB to immediately follow header */
647 if (sp_pkg->pm_offset != sizeof(struct sp_pkg_header)) {
648 dlog_error("Invalid SP package manifest offset.\n");
649 goto exit_unmap;
650 }
651
652 sp_header_dtb_size = align_up(
653 sp_pkg->pm_size + sizeof(struct sp_pkg_header), PAGE_SIZE);
654 if ((vm_id != HF_PRIMARY_VM_ID) &&
655 (sp_header_dtb_size >= vm->secondary.mem_size)) {
656 dlog_error("Invalid SP package header or DT size.\n");
657 goto exit_unmap;
658 }
659
660 if (sp_header_dtb_size > PAGE_SIZE) {
661 /* Map remainder of header + DTB */
662 sp_pkg_end = pa_add(sp_pkg_start, sp_header_dtb_size);
663
664 sp_pkg = mm_identity_map(stage1_locked, sp_pkg_start,
665 sp_pkg_end, MM_MODE_R, ppool);
666 CHECK(sp_pkg != NULL);
667 }
668
669 sp_dtb_addr = pa_add(sp_pkg_start, sp_pkg->pm_offset);
670 if (!fdt_init_from_ptr(&sp_fdt, (void *)sp_dtb_addr.pa,
671 sp_pkg->pm_size)) {
672 dlog_error("FDT failed validation.\n");
673 goto exit_unmap;
674 }
675
676 ret = parse_ffa_manifest(&sp_fdt, vm);
677 if (ret != MANIFEST_SUCCESS) {
678 goto exit_unmap;
679 }
680
681 ret = sanity_check_ffa_manifest(vm);
682
683exit_unmap:
684 CHECK(mm_unmap(stage1_locked, sp_pkg_start, sp_pkg_end, ppool));
685
686 return ret;
687}
688
David Brazdil7a462ec2019-08-15 12:27:47 +0100689/**
690 * Parse manifest from FDT.
691 */
Olivier Deprez62d99e32020-01-09 15:58:07 +0100692enum manifest_return_code manifest_init(struct mm_stage1_locked stage1_locked,
693 struct manifest *manifest,
694 struct memiter *manifest_fdt,
695 struct mpool *ppool)
David Brazdil7a462ec2019-08-15 12:27:47 +0100696{
David Brazdilb856be62020-03-25 10:14:55 +0000697 struct string vm_name;
698 struct fdt fdt;
David Brazdil7a462ec2019-08-15 12:27:47 +0100699 struct fdt_node hyp_node;
700 size_t i = 0;
701 bool found_primary_vm = false;
702
703 memset_s(manifest, sizeof(*manifest), 0, sizeof(*manifest));
704
David Brazdilb856be62020-03-25 10:14:55 +0000705 if (!fdt_init_from_memiter(&fdt, manifest_fdt)) {
706 return MANIFEST_ERROR_FILE_SIZE; /* TODO */
David Brazdila2358d42020-01-27 18:51:38 +0000707 }
708
David Brazdil7a462ec2019-08-15 12:27:47 +0100709 /* Find hypervisor node. */
David Brazdilb856be62020-03-25 10:14:55 +0000710 if (!fdt_find_node(&fdt, "/hypervisor", &hyp_node)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100711 return MANIFEST_ERROR_NO_HYPERVISOR_FDT_NODE;
712 }
713
David Brazdil74e9c3b2019-08-28 11:09:08 +0100714 /* Check "compatible" property. */
David Brazdilf4925382020-03-25 13:33:51 +0000715 if (!fdt_is_compatible(&hyp_node, "hafnium,hafnium")) {
David Brazdil74e9c3b2019-08-28 11:09:08 +0100716 return MANIFEST_ERROR_NOT_COMPATIBLE;
717 }
718
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100719 TRY(read_bool(&hyp_node, "ffa_tee", &manifest->ffa_tee_enabled));
Andrew Walbran41a49d82020-01-10 17:46:38 +0000720
David Brazdil7a462ec2019-08-15 12:27:47 +0100721 /* Iterate over reserved VM IDs and check no such nodes exist. */
722 for (i = 0; i < HF_VM_ID_OFFSET; i++) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100723 ffa_vm_id_t vm_id = (ffa_vm_id_t)i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100724 struct fdt_node vm_node = hyp_node;
David Brazdil7a462ec2019-08-15 12:27:47 +0100725
David Brazdilb856be62020-03-25 10:14:55 +0000726 generate_vm_node_name(&vm_name, vm_id);
727 if (fdt_find_child(&vm_node, &vm_name)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100728 return MANIFEST_ERROR_RESERVED_VM_ID;
729 }
730 }
731
732 /* Iterate over VM nodes until we find one that does not exist. */
733 for (i = 0; i <= MAX_VMS; ++i) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100734 ffa_vm_id_t vm_id = HF_VM_ID_OFFSET + i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100735 struct fdt_node vm_node = hyp_node;
David Brazdil7a462ec2019-08-15 12:27:47 +0100736
David Brazdilb856be62020-03-25 10:14:55 +0000737 generate_vm_node_name(&vm_name, vm_id);
738 if (!fdt_find_child(&vm_node, &vm_name)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100739 break;
740 }
741
742 if (i == MAX_VMS) {
743 return MANIFEST_ERROR_TOO_MANY_VMS;
744 }
745
746 if (vm_id == HF_PRIMARY_VM_ID) {
747 CHECK(found_primary_vm == false); /* sanity check */
748 found_primary_vm = true;
749 }
750
David Brazdil0251b942019-09-10 15:59:50 +0100751 manifest->vm_count = i + 1;
Olivier Deprez62d99e32020-01-09 15:58:07 +0100752
753 TRY(parse_vm_common(&vm_node, &manifest->vm[i], vm_id));
754
755 if (manifest->vm[i].is_ffa_partition) {
756 TRY(parse_ffa_partition_package(stage1_locked, &vm_node,
757 &manifest->vm[i], vm_id,
758 ppool));
759 } else {
760 TRY(parse_vm(&vm_node, &manifest->vm[i], vm_id));
761 }
David Brazdil7a462ec2019-08-15 12:27:47 +0100762 }
763
764 if (!found_primary_vm) {
765 return MANIFEST_ERROR_NO_PRIMARY_VM;
766 }
767
768 return MANIFEST_SUCCESS;
769}
770
771const char *manifest_strerror(enum manifest_return_code ret_code)
772{
773 switch (ret_code) {
774 case MANIFEST_SUCCESS:
775 return "Success";
David Brazdila2358d42020-01-27 18:51:38 +0000776 case MANIFEST_ERROR_FILE_SIZE:
777 return "Total size in header does not match file size";
Olivier Deprez62d99e32020-01-09 15:58:07 +0100778 case MANIFEST_ERROR_MALFORMED_DTB:
779 return "Malformed device tree blob";
David Brazdila2358d42020-01-27 18:51:38 +0000780 case MANIFEST_ERROR_NO_ROOT_NODE:
781 return "Could not find root node in manifest";
David Brazdil7a462ec2019-08-15 12:27:47 +0100782 case MANIFEST_ERROR_NO_HYPERVISOR_FDT_NODE:
783 return "Could not find \"hypervisor\" node in manifest";
David Brazdil74e9c3b2019-08-28 11:09:08 +0100784 case MANIFEST_ERROR_NOT_COMPATIBLE:
785 return "Hypervisor manifest entry not compatible with Hafnium";
David Brazdil7a462ec2019-08-15 12:27:47 +0100786 case MANIFEST_ERROR_RESERVED_VM_ID:
787 return "Manifest defines a VM with a reserved ID";
788 case MANIFEST_ERROR_NO_PRIMARY_VM:
789 return "Manifest does not contain a primary VM entry";
790 case MANIFEST_ERROR_TOO_MANY_VMS:
791 return "Manifest specifies more VMs than Hafnium has "
792 "statically allocated space for";
793 case MANIFEST_ERROR_PROPERTY_NOT_FOUND:
794 return "Property not found";
795 case MANIFEST_ERROR_MALFORMED_STRING:
796 return "Malformed string property";
David Brazdil0dbb41f2019-09-09 18:03:35 +0100797 case MANIFEST_ERROR_STRING_TOO_LONG:
798 return "String too long";
David Brazdil7a462ec2019-08-15 12:27:47 +0100799 case MANIFEST_ERROR_MALFORMED_INTEGER:
800 return "Malformed integer property";
801 case MANIFEST_ERROR_INTEGER_OVERFLOW:
802 return "Integer overflow";
Andrew Scullae9962e2019-10-03 16:51:16 +0100803 case MANIFEST_ERROR_MALFORMED_INTEGER_LIST:
804 return "Malformed integer list property";
Andrew Scullb2c3a242019-11-04 13:52:36 +0000805 case MANIFEST_ERROR_MALFORMED_BOOLEAN:
806 return "Malformed boolean property";
Manish Pandey6542f5c2020-04-27 14:37:46 +0100807 case MANIFEST_ERROR_MEMORY_REGION_NODE_EMPTY:
808 return "Memory-region node should have at least one entry";
Manish Pandeye68e7932020-04-23 15:29:28 +0100809 case MANIFEST_ERROR_DEVICE_REGION_NODE_EMPTY:
810 return "Device-region node should have at least one entry";
David Brazdil7a462ec2019-08-15 12:27:47 +0100811 }
812
813 panic("Unexpected manifest return code.");
814}