Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 1 | #include <stdalign.h> |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 2 | #include <stddef.h> |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 3 | #include <stdnoreturn.h> |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 4 | |
Andrew Scull | 18c78fc | 2018-08-20 12:57:41 +0100 | [diff] [blame] | 5 | #include "hf/alloc.h" |
| 6 | #include "hf/api.h" |
| 7 | #include "hf/boot_params.h" |
| 8 | #include "hf/cpio.h" |
| 9 | #include "hf/cpu.h" |
| 10 | #include "hf/dlog.h" |
| 11 | #include "hf/load.h" |
| 12 | #include "hf/mm.h" |
| 13 | #include "hf/std.h" |
| 14 | #include "hf/vm.h" |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 15 | |
Andrew Scull | 1950326 | 2018-09-20 14:48:39 +0100 | [diff] [blame^] | 16 | #include "vmapi/hf/call.h" |
| 17 | |
Wedson Almeida Filho | 84a30a0 | 2018-07-23 20:05:05 +0100 | [diff] [blame] | 18 | char ptable_buf[PAGE_SIZE * 40]; |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 19 | |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 20 | /** |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 21 | * Blocks the hypervisor. |
| 22 | * |
| 23 | * TODO: Determine if we want to omit strings on non-debug builds. |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 24 | */ |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 25 | noreturn void panic(const char *fmt, ...) |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 26 | { |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 27 | va_list args; |
| 28 | |
| 29 | /* TODO: Block all CPUs. */ |
| 30 | |
| 31 | dlog("Panic: "); |
| 32 | |
| 33 | va_start(args, fmt); |
| 34 | vdlog(fmt, args); |
| 35 | va_end(args); |
| 36 | |
| 37 | dlog("\n"); |
| 38 | |
| 39 | for (;;) { |
Andrew Scull | 7364a8e | 2018-07-19 15:39:29 +0100 | [diff] [blame] | 40 | } |
Wedson Almeida Filho | 8700964 | 2018-07-02 10:20:07 +0100 | [diff] [blame] | 41 | } |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 42 | |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 43 | /** |
| 44 | * Performs one-time initialisation of the hypervisor. |
| 45 | */ |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 46 | static void one_time_init(void) |
| 47 | { |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 48 | struct boot_params params; |
| 49 | struct boot_params_update update; |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 50 | struct memiter primary_initrd; |
Wedson Almeida Filho | 9ee60e9 | 2018-07-23 18:56:56 +0100 | [diff] [blame] | 51 | struct memiter cpio; |
Andrew Scull | 8087132 | 2018-08-06 12:04:09 +0100 | [diff] [blame] | 52 | void *initrd; |
Andrew Walbran | 34ce72e | 2018-09-13 16:47:44 +0100 | [diff] [blame] | 53 | size_t i; |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 54 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 55 | dlog("Initialising hafnium\n"); |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 56 | |
Wedson Almeida Filho | 3fcbcff | 2018-07-10 23:53:39 +0100 | [diff] [blame] | 57 | cpu_module_init(); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 58 | halloc_init((size_t)ptable_buf, sizeof(ptable_buf)); |
| 59 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 60 | if (!mm_init()) { |
| 61 | panic("mm_init failed"); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 62 | } |
| 63 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 64 | if (!plat_get_boot_params(¶ms)) { |
| 65 | panic("unable to retrieve boot params"); |
| 66 | } |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 67 | |
Andrew Walbran | 34ce72e | 2018-09-13 16:47:44 +0100 | [diff] [blame] | 68 | for (i = 0; i < params.mem_ranges_count; ++i) { |
| 69 | dlog("Memory range: 0x%x - 0x%x\n", |
| 70 | pa_addr(params.mem_ranges[i].begin), |
| 71 | pa_addr(params.mem_ranges[i].end) - 1); |
| 72 | } |
| 73 | |
Andrew Scull | 265ada9 | 2018-07-30 15:19:01 +0100 | [diff] [blame] | 74 | dlog("Ramdisk range: 0x%x - 0x%x\n", pa_addr(params.initrd_begin), |
| 75 | pa_addr(params.initrd_end) - 1); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 76 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 77 | /* Map initrd in, and initialise cpio parser. */ |
Andrew Scull | 8087132 | 2018-08-06 12:04:09 +0100 | [diff] [blame] | 78 | initrd = mm_identity_map(params.initrd_begin, params.initrd_end, |
| 79 | MM_MODE_R); |
| 80 | if (!initrd) { |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 81 | panic("unable to map initrd in"); |
| 82 | } |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 83 | |
Andrew Scull | 8087132 | 2018-08-06 12:04:09 +0100 | [diff] [blame] | 84 | memiter_init(&cpio, initrd, |
Andrew Scull | 265ada9 | 2018-07-30 15:19:01 +0100 | [diff] [blame] | 85 | pa_addr(params.initrd_end) - pa_addr(params.initrd_begin)); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 86 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 87 | /* Load all VMs. */ |
Wedson Almeida Filho | 9ee60e9 | 2018-07-23 18:56:56 +0100 | [diff] [blame] | 88 | if (!load_primary(&cpio, params.kernel_arg, &primary_initrd)) { |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 89 | panic("unable to load primary VM"); |
| 90 | } |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 91 | |
Andrew Walbran | 34ce72e | 2018-09-13 16:47:44 +0100 | [diff] [blame] | 92 | update.initrd_begin = pa_from_va(va_from_ptr(primary_initrd.next)); |
| 93 | update.initrd_end = pa_from_va(va_from_ptr(primary_initrd.limit)); |
| 94 | /* load_secondary will add regions assigned to the secondary VMs from |
| 95 | * mem_ranges to reserved_ranges. */ |
| 96 | update.reserved_ranges_count = 0; |
| 97 | if (!load_secondary(&cpio, ¶ms, &update)) { |
Wedson Almeida Filho | 84a30a0 | 2018-07-23 20:05:05 +0100 | [diff] [blame] | 98 | panic("unable to load secondary VMs"); |
| 99 | } |
| 100 | |
Andrew Walbran | 34ce72e | 2018-09-13 16:47:44 +0100 | [diff] [blame] | 101 | /* Prepare to run by updating bootparams as seen by primary VM. */ |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 102 | if (!plat_update_boot_params(&update)) { |
| 103 | panic("plat_update_boot_params failed"); |
| 104 | } |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 105 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 106 | mm_defrag(); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 107 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 108 | dlog("Hafnium initialisation completed\n"); |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 109 | } |
| 110 | |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 111 | /** |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 112 | * The entry point of CPUs when they are turned on. It is supposed to initialise |
Wedson Almeida Filho | 8700964 | 2018-07-02 10:20:07 +0100 | [diff] [blame] | 113 | * all state and return the first vCPU to run. |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 114 | */ |
Wedson Almeida Filho | 8700964 | 2018-07-02 10:20:07 +0100 | [diff] [blame] | 115 | struct vcpu *cpu_main(void) |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 116 | { |
Wedson Almeida Filho | 8700964 | 2018-07-02 10:20:07 +0100 | [diff] [blame] | 117 | struct cpu *c = cpu(); |
Andrew Scull | 1950326 | 2018-09-20 14:48:39 +0100 | [diff] [blame^] | 118 | struct vm *primary; |
Wedson Almeida Filho | 8700964 | 2018-07-02 10:20:07 +0100 | [diff] [blame] | 119 | |
Wedson Almeida Filho | fdf4afc | 2018-07-19 15:45:21 +0100 | [diff] [blame] | 120 | /* |
| 121 | * Do global one-time initialisation just once. We avoid using atomics |
| 122 | * by only touching the variable from cpu 0. |
| 123 | */ |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 124 | static volatile bool inited = false; |
| 125 | if (cpu_index(c) == 0 && !inited) { |
| 126 | inited = true; |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 127 | one_time_init(); |
Wedson Almeida Filho | fed6902 | 2018-07-11 15:39:12 +0100 | [diff] [blame] | 128 | } |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 129 | |
Wedson Almeida Filho | 3fcbcff | 2018-07-10 23:53:39 +0100 | [diff] [blame] | 130 | dlog("Starting up cpu %d\n", cpu_index(c)); |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 131 | |
Wedson Almeida Filho | 03e767a | 2018-07-30 15:32:03 +0100 | [diff] [blame] | 132 | if (!mm_cpu_init()) { |
| 133 | panic("mm_cpu_init failed"); |
| 134 | } |
| 135 | |
Andrew Scull | 1950326 | 2018-09-20 14:48:39 +0100 | [diff] [blame^] | 136 | primary = vm_get(HF_PRIMARY_VM_ID); |
| 137 | vm_set_current(primary); |
Wedson Almeida Filho | 03e767a | 2018-07-30 15:32:03 +0100 | [diff] [blame] | 138 | |
Andrew Scull | 1950326 | 2018-09-20 14:48:39 +0100 | [diff] [blame^] | 139 | return &primary->vcpus[cpu_index(c)]; |
Wedson Almeida Filho | 987c0ff | 2018-06-20 16:34:38 +0100 | [diff] [blame] | 140 | } |