blob: 9c98b5f60f7b98647f10c1322f039e362ecf7617 [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(
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100308 struct fdt_node *mem_node, struct memory_region *mem_regions,
309 struct rx_tx *rxtx)
Manish Pandey6542f5c2020-04-27 14:37:46 +0100310{
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100311 uint32_t phandle;
Manish Pandey6542f5c2020-04-27 14:37:46 +0100312 unsigned int i = 0;
313
314 dlog_verbose(" Partition memory regions\n");
315
316 if (!fdt_is_compatible(mem_node, "arm,ffa-manifest-memory-regions")) {
317 return MANIFEST_ERROR_NOT_COMPATIBLE;
318 }
319
320 if (!fdt_first_child(mem_node)) {
321 return MANIFEST_ERROR_MEMORY_REGION_NODE_EMPTY;
322 }
323
324 do {
325 dlog_verbose(" Memory Region[%u]\n", i);
326
327 TRY(read_optional_string(mem_node, "description",
328 &mem_regions[i].name));
329 dlog_verbose(" Name: %s\n",
330 string_data(&mem_regions[i].name));
331
332 TRY(read_optional_uint64(mem_node, "base-address",
333 MANIFEST_INVALID_ADDRESS,
334 &mem_regions[i].base_address));
335 dlog_verbose(" Base address: %#x\n",
336 mem_regions[i].base_address);
337
338 TRY(read_uint32(mem_node, "pages-count",
339 &mem_regions[i].page_count));
340 dlog_verbose(" Pages_count: %u\n",
341 mem_regions[i].page_count);
342
343 TRY(read_uint32(mem_node, "attributes",
344 &mem_regions[i].attributes));
345 mem_regions[i].attributes &= MM_PERM_MASK;
346 dlog_verbose(" Attributes: %u\n",
347 mem_regions[i].attributes);
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100348
349 TRY(read_optional_uint32(mem_node, "phandle",
350 (uint32_t)MANIFEST_INVALID_ADDRESS,
351 &phandle));
352 if (phandle == rxtx->rx_phandle) {
353 dlog_verbose(" Assigned as RX buffer\n");
354 rxtx->rx_buffer = &mem_regions[i];
355 } else if (phandle == rxtx->tx_phandle) {
356 dlog_verbose(" Assigned as TX buffer\n");
357 rxtx->tx_buffer = &mem_regions[i];
358 }
359
Manish Pandey6542f5c2020-04-27 14:37:46 +0100360 i++;
361 } while (fdt_next_sibling(mem_node) && (i < SP_MAX_MEMORY_REGIONS));
362
363 dlog_verbose(" Total %u memory regions found\n", i);
364
365 return MANIFEST_SUCCESS;
366}
367
Manish Pandeye68e7932020-04-23 15:29:28 +0100368static enum manifest_return_code parse_ffa_device_region_node(
369 struct fdt_node *dev_node, struct device_region *dev_regions)
370{
371 struct uint32list_iter list;
372 unsigned int i = 0;
373 unsigned int j = 0;
374
375 dlog_verbose(" Partition Device Regions\n");
376
377 if (!fdt_is_compatible(dev_node, "arm,ffa-manifest-device-regions")) {
378 return MANIFEST_ERROR_NOT_COMPATIBLE;
379 }
380
381 if (!fdt_first_child(dev_node)) {
382 return MANIFEST_ERROR_DEVICE_REGION_NODE_EMPTY;
383 }
384
385 do {
386 dlog_verbose(" Device Region[%u]\n", i);
387
388 TRY(read_optional_string(dev_node, "description",
389 &dev_regions[i].name));
390 dlog_verbose(" Name: %s\n",
391 string_data(&dev_regions[i].name));
392
393 TRY(read_uint64(dev_node, "base-address",
394 &dev_regions[i].base_address));
395 dlog_verbose(" Base address: %#x\n",
396 dev_regions[i].base_address);
397
398 TRY(read_uint32(dev_node, "pages-count",
399 &dev_regions[i].page_count));
400 dlog_verbose(" Pages_count: %u\n",
401 dev_regions[i].page_count);
402
403 TRY(read_uint32(dev_node, "attributes",
404 &dev_regions[i].attributes));
405 dev_regions[i].attributes =
406 (dev_regions[i].attributes & MM_PERM_MASK) | MM_MODE_D;
407 dlog_verbose(" Attributes: %u\n",
408 dev_regions[i].attributes);
409
410 TRY(read_optional_uint32list(dev_node, "interrupts", &list));
411 dlog_verbose(" Interrupt List:\n");
412 j = 0;
413 while (uint32list_has_next(&list) &&
414 j < SP_MAX_INTERRUPTS_PER_DEVICE) {
415 TRY(uint32list_get_next(
416 &list, &dev_regions[i].interrupts[j].id));
417 if (uint32list_has_next(&list)) {
418 TRY(uint32list_get_next(&list,
419 &dev_regions[i]
420 .interrupts[j]
421 .attributes));
422 } else {
423 return MANIFEST_ERROR_MALFORMED_INTEGER_LIST;
424 }
425
426 dlog_verbose(" ID = %u, attributes = %u\n",
427 dev_regions[i].interrupts[j].id,
428 dev_regions[i].interrupts[j].attributes);
429 j++;
430 }
431 if (j == 0) {
432 dlog_verbose(" Empty\n");
433 }
434
435 TRY(read_optional_uint32(dev_node, "smmu-id",
436 (uint32_t)MANIFEST_INVALID_ADDRESS,
437 &dev_regions[i].smmu_id));
438 dlog_verbose(" smmu-id: %u\n", dev_regions[i].smmu_id);
439
440 TRY(read_optional_uint32list(dev_node, "stream-ids", &list));
441 dlog_verbose(" Stream IDs assigned:\n");
442
443 j = 0;
444 while (uint32list_has_next(&list) &&
445 j < SP_MAX_STREAMS_PER_DEVICE) {
446 TRY(uint32list_get_next(&list,
447 &dev_regions[i].stream_ids[j]));
448 dlog_verbose(" %u\n",
449 dev_regions[i].stream_ids[j]);
450 j++;
451 }
452 if (j == 0) {
453 dlog_verbose(" None\n");
454 }
455
456 TRY(read_bool(dev_node, "exclusive-access",
457 &dev_regions[i].exclusive_access));
458 dlog_verbose(" Exclusive_access: %d\n",
459 dev_regions[i].exclusive_access);
460
461 i++;
462 } while (fdt_next_sibling(dev_node) && (i < SP_MAX_DEVICE_REGIONS));
463
464 dlog_verbose(" Total %u device regions found\n", i);
465
466 return MANIFEST_SUCCESS;
467}
468
Olivier Deprez62d99e32020-01-09 15:58:07 +0100469static enum manifest_return_code parse_ffa_manifest(struct fdt *fdt,
470 struct manifest_vm *vm)
471{
472 unsigned int i = 0;
473 struct uint32list_iter uuid;
474 uint32_t uuid_word;
475 struct fdt_node root;
476 struct fdt_node ffa_node;
477 struct string rxtx_node_name = STRING_INIT("rx_tx-info");
Manish Pandey6542f5c2020-04-27 14:37:46 +0100478 struct string mem_region_node_name = STRING_INIT("memory-regions");
Manish Pandeye68e7932020-04-23 15:29:28 +0100479 struct string dev_region_node_name = STRING_INIT("device-regions");
Olivier Deprez62d99e32020-01-09 15:58:07 +0100480
481 if (!fdt_find_node(fdt, "/", &root)) {
482 return MANIFEST_ERROR_NO_ROOT_NODE;
483 }
484
485 /* Check "compatible" property. */
486 if (!fdt_is_compatible(&root, "arm,ffa-manifest-1.0")) {
487 return MANIFEST_ERROR_NOT_COMPATIBLE;
488 }
489
490 TRY(read_uint32(&root, "ffa-version", &vm->sp.ffa_version));
491 dlog_verbose(" SP expected FF-A version %d.%d\n",
492 vm->sp.ffa_version >> 16, vm->sp.ffa_version & 0xffff);
493
494 TRY(read_optional_uint32list(&root, "uuid", &uuid));
495
496 while (uint32list_has_next(&uuid) && i < 4) {
497 TRY(uint32list_get_next(&uuid, &uuid_word));
Fuad Tabbae4efcc32020-07-16 15:37:27 +0100498 vm->sp.uuid.uuid[i] = uuid_word;
Olivier Deprez62d99e32020-01-09 15:58:07 +0100499 i++;
500 }
Fuad Tabba952401e2020-07-24 10:43:40 +0100501 dlog_verbose(" SP UUID %#x-%x-%x_%x\n", vm->sp.uuid.uuid[0],
502 vm->sp.uuid.uuid[1], vm->sp.uuid.uuid[2],
503 vm->sp.uuid.uuid[3]);
Olivier Deprez62d99e32020-01-09 15:58:07 +0100504
505 TRY(read_uint16(&root, "execution-ctx-count",
506 &vm->sp.execution_ctx_count));
507 dlog_verbose(" SP number of execution context %d\n",
508 vm->sp.execution_ctx_count);
509
510 TRY(read_uint8(&root, "exception-level",
511 (uint8_t *)&vm->sp.run_time_el));
512 dlog_verbose(" SP run-time EL %d\n", vm->sp.run_time_el);
513
514 TRY(read_uint8(&root, "execution-state",
515 (uint8_t *)&vm->sp.execution_state));
516 dlog_verbose(" SP execution state %d\n", vm->sp.execution_state);
517
518 TRY(read_uint64(&root, "load-address", &vm->sp.load_addr));
519 dlog_verbose(" SP load address %#x\n", vm->sp.load_addr);
520
521 TRY(read_uint64(&root, "entrypoint-offset", &vm->sp.ep_offset));
522 dlog_verbose(" SP entry point offset %#x\n", vm->sp.ep_offset);
523
524 TRY(read_uint8(&root, "xlat-granule", (uint8_t *)&vm->sp.xlat_granule));
525 dlog_verbose(" SP translation granule %d\n", vm->sp.xlat_granule);
526
527 ffa_node = root;
528 if (fdt_find_child(&ffa_node, &rxtx_node_name)) {
529 if (!fdt_is_compatible(&ffa_node,
530 "arm,ffa-manifest-rx_tx-buffer")) {
531 return MANIFEST_ERROR_NOT_COMPATIBLE;
532 }
533
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100534 /*
535 * Read only phandles for now, it will be used to update buffers
536 * while parsing memory regions.
537 */
538 TRY(read_uint32(&ffa_node, "rx-buffer",
539 &vm->sp.rxtx.rx_phandle));
Olivier Deprez62d99e32020-01-09 15:58:07 +0100540
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100541 TRY(read_uint32(&ffa_node, "tx-buffer",
542 &vm->sp.rxtx.tx_phandle));
Olivier Deprez62d99e32020-01-09 15:58:07 +0100543
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100544 vm->sp.rxtx.available = true;
Olivier Deprez62d99e32020-01-09 15:58:07 +0100545 }
546
547 TRY(read_uint8(&root, "messaging-method",
548 (uint8_t *)&vm->sp.messaging_method));
549 dlog_verbose(" SP messaging method %d\n", vm->sp.messaging_method);
550
Manish Pandey6542f5c2020-04-27 14:37:46 +0100551 /* Parse memory-regions */
552 ffa_node = root;
553 if (fdt_find_child(&ffa_node, &mem_region_node_name)) {
Manish Pandeyfa1f2912020-05-05 12:57:01 +0100554 TRY(parse_ffa_memory_region_node(&ffa_node, vm->sp.mem_regions,
555 &vm->sp.rxtx));
Manish Pandey6542f5c2020-04-27 14:37:46 +0100556 }
557
Manish Pandeye68e7932020-04-23 15:29:28 +0100558 /* Parse Device-regions */
559 ffa_node = root;
560 if (fdt_find_child(&ffa_node, &dev_region_node_name)) {
561 TRY(parse_ffa_device_region_node(&ffa_node,
562 vm->sp.dev_regions));
563 }
564
Olivier Deprez62d99e32020-01-09 15:58:07 +0100565 return MANIFEST_SUCCESS;
566}
567
568static enum manifest_return_code sanity_check_ffa_manifest(
569 struct manifest_vm *vm)
570{
571 uint16_t ffa_version_major;
572 uint16_t ffa_version_minor;
573 enum manifest_return_code ret_code = MANIFEST_SUCCESS;
574 const char *error_string = "specified in manifest is unsupported";
575
576 /* ensure that the SPM version is compatible */
577 ffa_version_major =
578 (vm->sp.ffa_version & 0xffff0000) >> FFA_VERSION_MAJOR_OFFSET;
579 ffa_version_minor = vm->sp.ffa_version & 0xffff;
580
581 if (ffa_version_major != FFA_VERSION_MAJOR ||
582 ffa_version_minor > FFA_VERSION_MINOR) {
583 dlog_error("FF-A partition manifest version %s: %d.%d\n",
584 error_string, ffa_version_major, ffa_version_minor);
585 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
586 }
587
588 if (vm->sp.xlat_granule != PAGE_4KB) {
589 dlog_error("Translation granule %s: %d\n", error_string,
590 vm->sp.xlat_granule);
591 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
592 }
593
594 if (vm->sp.execution_state != AARCH64) {
595 dlog_error("Execution state %s: %d\n", error_string,
596 vm->sp.execution_state);
597 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
598 }
599
600 if (vm->sp.run_time_el != EL1 && vm->sp.run_time_el != S_EL1) {
601 dlog_error("Exception level %s: %d\n", error_string,
602 vm->sp.run_time_el);
603 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
604 }
605
606 if (vm->sp.messaging_method != INDIRECT_MESSAGING) {
607 dlog_error("Messaging method %s: %x\n", error_string,
608 vm->sp.messaging_method);
609 ret_code = MANIFEST_ERROR_NOT_COMPATIBLE;
610 }
611
612 return ret_code;
613}
614
615static enum manifest_return_code parse_ffa_partition_package(
616 struct mm_stage1_locked stage1_locked, struct fdt_node *node,
617 struct manifest_vm *vm, ffa_vm_id_t vm_id, struct mpool *ppool)
618{
619 enum manifest_return_code ret = MANIFEST_ERROR_NOT_COMPATIBLE;
620 uintpaddr_t sp_pkg_addr;
621 paddr_t sp_pkg_start;
622 paddr_t sp_pkg_end;
623 struct sp_pkg_header *sp_pkg;
624 size_t sp_header_dtb_size;
625 paddr_t sp_dtb_addr;
626 struct fdt sp_fdt;
627
628 /*
629 * This must have been hinted as being an FF-A partition,
630 * return straight with failure if this is not the case.
631 */
632 if (!vm->is_ffa_partition) {
633 return MANIFEST_ERROR_NOT_COMPATIBLE;
634 }
635
636 TRY(read_uint64(node, "load_address", &sp_pkg_addr));
637 if (!is_aligned(sp_pkg_addr, PAGE_SIZE)) {
638 return MANIFEST_ERROR_NOT_COMPATIBLE;
639 }
640
641 /* Map top of SP package as a single page to extract the header */
642 sp_pkg_start = pa_init(sp_pkg_addr);
643 sp_pkg_end = pa_add(sp_pkg_start, PAGE_SIZE);
644 sp_pkg = mm_identity_map(stage1_locked, sp_pkg_start,
645 pa_add(sp_pkg_start, PAGE_SIZE), MM_MODE_R,
646 ppool);
647 CHECK(sp_pkg != NULL);
648
649 dlog_verbose("SP package load address %#x\n", sp_pkg_addr);
650
651 if (sp_pkg->magic != SP_PKG_HEADER_MAGIC) {
652 dlog_error("Invalid SP package magic.\n");
653 goto exit_unmap;
654 }
655
656 if (sp_pkg->version != SP_PKG_HEADER_VERSION) {
657 dlog_error("Invalid SP package version.\n");
658 goto exit_unmap;
659 }
660
661 /* Expect SP DTB to immediately follow header */
662 if (sp_pkg->pm_offset != sizeof(struct sp_pkg_header)) {
663 dlog_error("Invalid SP package manifest offset.\n");
664 goto exit_unmap;
665 }
666
667 sp_header_dtb_size = align_up(
668 sp_pkg->pm_size + sizeof(struct sp_pkg_header), PAGE_SIZE);
669 if ((vm_id != HF_PRIMARY_VM_ID) &&
670 (sp_header_dtb_size >= vm->secondary.mem_size)) {
671 dlog_error("Invalid SP package header or DT size.\n");
672 goto exit_unmap;
673 }
674
675 if (sp_header_dtb_size > PAGE_SIZE) {
676 /* Map remainder of header + DTB */
677 sp_pkg_end = pa_add(sp_pkg_start, sp_header_dtb_size);
678
679 sp_pkg = mm_identity_map(stage1_locked, sp_pkg_start,
680 sp_pkg_end, MM_MODE_R, ppool);
681 CHECK(sp_pkg != NULL);
682 }
683
684 sp_dtb_addr = pa_add(sp_pkg_start, sp_pkg->pm_offset);
685 if (!fdt_init_from_ptr(&sp_fdt, (void *)sp_dtb_addr.pa,
686 sp_pkg->pm_size)) {
687 dlog_error("FDT failed validation.\n");
688 goto exit_unmap;
689 }
690
691 ret = parse_ffa_manifest(&sp_fdt, vm);
692 if (ret != MANIFEST_SUCCESS) {
693 goto exit_unmap;
694 }
695
696 ret = sanity_check_ffa_manifest(vm);
697
698exit_unmap:
699 CHECK(mm_unmap(stage1_locked, sp_pkg_start, sp_pkg_end, ppool));
700
701 return ret;
702}
703
David Brazdil7a462ec2019-08-15 12:27:47 +0100704/**
705 * Parse manifest from FDT.
706 */
Olivier Deprez62d99e32020-01-09 15:58:07 +0100707enum manifest_return_code manifest_init(struct mm_stage1_locked stage1_locked,
708 struct manifest *manifest,
709 struct memiter *manifest_fdt,
710 struct mpool *ppool)
David Brazdil7a462ec2019-08-15 12:27:47 +0100711{
David Brazdilb856be62020-03-25 10:14:55 +0000712 struct string vm_name;
713 struct fdt fdt;
David Brazdil7a462ec2019-08-15 12:27:47 +0100714 struct fdt_node hyp_node;
715 size_t i = 0;
716 bool found_primary_vm = false;
717
718 memset_s(manifest, sizeof(*manifest), 0, sizeof(*manifest));
719
David Brazdilb856be62020-03-25 10:14:55 +0000720 if (!fdt_init_from_memiter(&fdt, manifest_fdt)) {
721 return MANIFEST_ERROR_FILE_SIZE; /* TODO */
David Brazdila2358d42020-01-27 18:51:38 +0000722 }
723
David Brazdil7a462ec2019-08-15 12:27:47 +0100724 /* Find hypervisor node. */
David Brazdilb856be62020-03-25 10:14:55 +0000725 if (!fdt_find_node(&fdt, "/hypervisor", &hyp_node)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100726 return MANIFEST_ERROR_NO_HYPERVISOR_FDT_NODE;
727 }
728
David Brazdil74e9c3b2019-08-28 11:09:08 +0100729 /* Check "compatible" property. */
David Brazdilf4925382020-03-25 13:33:51 +0000730 if (!fdt_is_compatible(&hyp_node, "hafnium,hafnium")) {
David Brazdil74e9c3b2019-08-28 11:09:08 +0100731 return MANIFEST_ERROR_NOT_COMPATIBLE;
732 }
733
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100734 TRY(read_bool(&hyp_node, "ffa_tee", &manifest->ffa_tee_enabled));
Andrew Walbran41a49d82020-01-10 17:46:38 +0000735
David Brazdil7a462ec2019-08-15 12:27:47 +0100736 /* Iterate over reserved VM IDs and check no such nodes exist. */
737 for (i = 0; i < HF_VM_ID_OFFSET; i++) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100738 ffa_vm_id_t vm_id = (ffa_vm_id_t)i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100739 struct fdt_node vm_node = hyp_node;
David Brazdil7a462ec2019-08-15 12:27:47 +0100740
David Brazdilb856be62020-03-25 10:14:55 +0000741 generate_vm_node_name(&vm_name, vm_id);
742 if (fdt_find_child(&vm_node, &vm_name)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100743 return MANIFEST_ERROR_RESERVED_VM_ID;
744 }
745 }
746
747 /* Iterate over VM nodes until we find one that does not exist. */
748 for (i = 0; i <= MAX_VMS; ++i) {
Andrew Walbranb5ab43c2020-04-30 11:32:54 +0100749 ffa_vm_id_t vm_id = HF_VM_ID_OFFSET + i;
David Brazdil7a462ec2019-08-15 12:27:47 +0100750 struct fdt_node vm_node = hyp_node;
David Brazdil7a462ec2019-08-15 12:27:47 +0100751
David Brazdilb856be62020-03-25 10:14:55 +0000752 generate_vm_node_name(&vm_name, vm_id);
753 if (!fdt_find_child(&vm_node, &vm_name)) {
David Brazdil7a462ec2019-08-15 12:27:47 +0100754 break;
755 }
756
757 if (i == MAX_VMS) {
758 return MANIFEST_ERROR_TOO_MANY_VMS;
759 }
760
761 if (vm_id == HF_PRIMARY_VM_ID) {
762 CHECK(found_primary_vm == false); /* sanity check */
763 found_primary_vm = true;
764 }
765
David Brazdil0251b942019-09-10 15:59:50 +0100766 manifest->vm_count = i + 1;
Olivier Deprez62d99e32020-01-09 15:58:07 +0100767
768 TRY(parse_vm_common(&vm_node, &manifest->vm[i], vm_id));
769
770 if (manifest->vm[i].is_ffa_partition) {
771 TRY(parse_ffa_partition_package(stage1_locked, &vm_node,
772 &manifest->vm[i], vm_id,
773 ppool));
774 } else {
775 TRY(parse_vm(&vm_node, &manifest->vm[i], vm_id));
776 }
David Brazdil7a462ec2019-08-15 12:27:47 +0100777 }
778
779 if (!found_primary_vm) {
780 return MANIFEST_ERROR_NO_PRIMARY_VM;
781 }
782
783 return MANIFEST_SUCCESS;
784}
785
786const char *manifest_strerror(enum manifest_return_code ret_code)
787{
788 switch (ret_code) {
789 case MANIFEST_SUCCESS:
790 return "Success";
David Brazdila2358d42020-01-27 18:51:38 +0000791 case MANIFEST_ERROR_FILE_SIZE:
792 return "Total size in header does not match file size";
Olivier Deprez62d99e32020-01-09 15:58:07 +0100793 case MANIFEST_ERROR_MALFORMED_DTB:
794 return "Malformed device tree blob";
David Brazdila2358d42020-01-27 18:51:38 +0000795 case MANIFEST_ERROR_NO_ROOT_NODE:
796 return "Could not find root node in manifest";
David Brazdil7a462ec2019-08-15 12:27:47 +0100797 case MANIFEST_ERROR_NO_HYPERVISOR_FDT_NODE:
798 return "Could not find \"hypervisor\" node in manifest";
David Brazdil74e9c3b2019-08-28 11:09:08 +0100799 case MANIFEST_ERROR_NOT_COMPATIBLE:
800 return "Hypervisor manifest entry not compatible with Hafnium";
David Brazdil7a462ec2019-08-15 12:27:47 +0100801 case MANIFEST_ERROR_RESERVED_VM_ID:
802 return "Manifest defines a VM with a reserved ID";
803 case MANIFEST_ERROR_NO_PRIMARY_VM:
804 return "Manifest does not contain a primary VM entry";
805 case MANIFEST_ERROR_TOO_MANY_VMS:
806 return "Manifest specifies more VMs than Hafnium has "
807 "statically allocated space for";
808 case MANIFEST_ERROR_PROPERTY_NOT_FOUND:
809 return "Property not found";
810 case MANIFEST_ERROR_MALFORMED_STRING:
811 return "Malformed string property";
David Brazdil0dbb41f2019-09-09 18:03:35 +0100812 case MANIFEST_ERROR_STRING_TOO_LONG:
813 return "String too long";
David Brazdil7a462ec2019-08-15 12:27:47 +0100814 case MANIFEST_ERROR_MALFORMED_INTEGER:
815 return "Malformed integer property";
816 case MANIFEST_ERROR_INTEGER_OVERFLOW:
817 return "Integer overflow";
Andrew Scullae9962e2019-10-03 16:51:16 +0100818 case MANIFEST_ERROR_MALFORMED_INTEGER_LIST:
819 return "Malformed integer list property";
Andrew Scullb2c3a242019-11-04 13:52:36 +0000820 case MANIFEST_ERROR_MALFORMED_BOOLEAN:
821 return "Malformed boolean property";
Manish Pandey6542f5c2020-04-27 14:37:46 +0100822 case MANIFEST_ERROR_MEMORY_REGION_NODE_EMPTY:
823 return "Memory-region node should have at least one entry";
Manish Pandeye68e7932020-04-23 15:29:28 +0100824 case MANIFEST_ERROR_DEVICE_REGION_NODE_EMPTY:
825 return "Device-region node should have at least one entry";
David Brazdil7a462ec2019-08-15 12:27:47 +0100826 }
827
828 panic("Unexpected manifest return code.");
829}