blob: 969cacf589180a19d31b37818cf42bad9dcf4ad9 [file] [log] [blame]
Andrew Scull18834872018-10-12 11:48:09 +01001/*
2 * Copyright 2018 Google LLC
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * https://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010017#include <stdalign.h>
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010018#include <stddef.h>
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010019#include <stdnoreturn.h>
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010020
Andrew Scullc960c032018-10-24 15:13:35 +010021#include "hf/arch/init.h"
22
Andrew Scull18c78fc2018-08-20 12:57:41 +010023#include "hf/api.h"
24#include "hf/boot_params.h"
25#include "hf/cpio.h"
26#include "hf/cpu.h"
27#include "hf/dlog.h"
28#include "hf/load.h"
29#include "hf/mm.h"
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000030#include "hf/mpool.h"
Andrew Scull18c78fc2018-08-20 12:57:41 +010031#include "hf/std.h"
32#include "hf/vm.h"
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010033
Andrew Scull19503262018-09-20 14:48:39 +010034#include "vmapi/hf/call.h"
35
Wedson Almeida Filho9ed8da52018-12-17 16:09:11 +000036alignas(alignof(
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000037 struct mm_page_table)) char ptable_buf[sizeof(struct mm_page_table) *
38 HEAP_PAGES];
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010039
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010040/**
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010041 * Blocks the hypervisor.
42 *
43 * TODO: Determine if we want to omit strings on non-debug builds.
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010044 */
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010045noreturn void panic(const char *fmt, ...)
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010046{
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010047 va_list args;
48
49 /* TODO: Block all CPUs. */
50
Andrew Scullfdd716e2018-12-20 05:37:31 +000051 dlog("Panic: ");
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010052
53 va_start(args, fmt);
Andrew Scullfdd716e2018-12-20 05:37:31 +000054 vdlog(fmt, args);
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010055 va_end(args);
56
Andrew Scullfdd716e2018-12-20 05:37:31 +000057 dlog("\n");
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010058
59 for (;;) {
Andrew Scull7364a8e2018-07-19 15:39:29 +010060 }
Wedson Almeida Filho87009642018-07-02 10:20:07 +010061}
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010062
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010063/**
64 * Performs one-time initialisation of the hypervisor.
65 */
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010066static void one_time_init(void)
67{
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010068 struct boot_params params;
69 struct boot_params_update update;
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010070 struct memiter primary_initrd;
Wedson Almeida Filho9ee60e92018-07-23 18:56:56 +010071 struct memiter cpio;
Andrew Scull80871322018-08-06 12:04:09 +010072 void *initrd;
Andrew Walbran34ce72e2018-09-13 16:47:44 +010073 size_t i;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000074 struct mpool ppool;
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010075
Andrew Scullfdd716e2018-12-20 05:37:31 +000076 dlog("Initialising hafnium\n");
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +010077
Andrew Scullc960c032018-10-24 15:13:35 +010078 arch_one_time_init();
79
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000080 mpool_init(&ppool, sizeof(struct mm_page_table));
81 mpool_add_chunk(&ppool, ptable_buf, sizeof(ptable_buf));
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010082
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000083 cpu_module_init();
84
85 if (!mm_init(&ppool)) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010086 panic("mm_init failed");
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010087 }
88
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000089 /* Enable locks now that mm is initialised. */
Andrew Scullfdd716e2018-12-20 05:37:31 +000090 dlog_enable_lock();
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +000091 mpool_enable_locks();
92
93 if (!plat_get_boot_params(&params, &ppool)) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +010094 panic("unable to retrieve boot params");
95 }
Wedson Almeida Filhofed69022018-07-11 15:39:12 +010096
Andrew Walbran34ce72e2018-09-13 16:47:44 +010097 for (i = 0; i < params.mem_ranges_count; ++i) {
98 dlog("Memory range: 0x%x - 0x%x\n",
99 pa_addr(params.mem_ranges[i].begin),
100 pa_addr(params.mem_ranges[i].end) - 1);
101 }
102
Andrew Scull265ada92018-07-30 15:19:01 +0100103 dlog("Ramdisk range: 0x%x - 0x%x\n", pa_addr(params.initrd_begin),
104 pa_addr(params.initrd_end) - 1);
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100105
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100106 /* Map initrd in, and initialise cpio parser. */
Andrew Scull80871322018-08-06 12:04:09 +0100107 initrd = mm_identity_map(params.initrd_begin, params.initrd_end,
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +0000108 MM_MODE_R, &ppool);
Andrew Scull80871322018-08-06 12:04:09 +0100109 if (!initrd) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100110 panic("unable to map initrd in");
111 }
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100112
Andrew Scull80871322018-08-06 12:04:09 +0100113 memiter_init(&cpio, initrd,
Andrew Scull265ada92018-07-30 15:19:01 +0100114 pa_addr(params.initrd_end) - pa_addr(params.initrd_begin));
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100115
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100116 /* Load all VMs. */
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +0000117 if (!load_primary(&cpio, params.kernel_arg, &primary_initrd, &ppool)) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100118 panic("unable to load primary VM");
119 }
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100120
Wedson Almeida Filhob2c159e2018-10-25 13:27:47 +0100121 /*
122 * load_secondary will add regions assigned to the secondary VMs from
123 * mem_ranges to reserved_ranges.
124 */
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100125 update.initrd_begin = pa_from_va(va_from_ptr(primary_initrd.next));
126 update.initrd_end = pa_from_va(va_from_ptr(primary_initrd.limit));
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100127 update.reserved_ranges_count = 0;
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +0000128 if (!load_secondary(&cpio, &params, &update, &ppool)) {
Wedson Almeida Filho84a30a02018-07-23 20:05:05 +0100129 panic("unable to load secondary VMs");
130 }
131
Andrew Walbran34ce72e2018-09-13 16:47:44 +0100132 /* Prepare to run by updating bootparams as seen by primary VM. */
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +0000133 if (!plat_update_boot_params(&update, &ppool)) {
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100134 panic("plat_update_boot_params failed");
135 }
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100136
Wedson Almeida Filho22d5eaa2018-12-16 00:38:49 +0000137 mm_defrag(&ppool);
138
139 /* Initialise the API page pool. ppool will be empty from now on. */
140 api_init(&ppool);
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100141
Andrew Scullda241972019-01-05 18:17:48 +0000142 /* Enable TLB invalidation for VM page table updates. */
143 mm_vm_enable_invalidation();
144
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100145 dlog("Hafnium initialisation completed\n");
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100146}
147
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100148/**
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100149 * The entry point of CPUs when they are turned on. It is supposed to initialise
Wedson Almeida Filho87009642018-07-02 10:20:07 +0100150 * all state and return the first vCPU to run.
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100151 */
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100152struct vcpu *cpu_main(struct cpu *c)
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100153{
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100154 struct vcpu *vcpu;
Andrew Scullc960c032018-10-24 15:13:35 +0100155 struct vm *vm;
Wedson Almeida Filho87009642018-07-02 10:20:07 +0100156
Wedson Almeida Filhofdf4afc2018-07-19 15:45:21 +0100157 /*
158 * Do global one-time initialisation just once. We avoid using atomics
159 * by only touching the variable from cpu 0.
160 */
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100161 static volatile bool inited = false;
Wedson Almeida Filho81568c42019-01-04 13:33:02 +0000162
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100163 if (cpu_index(c) == 0 && !inited) {
164 inited = true;
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100165 one_time_init();
Wedson Almeida Filhofed69022018-07-11 15:39:12 +0100166 }
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100167
Wedson Almeida Filho03e767a2018-07-30 15:32:03 +0100168 if (!mm_cpu_init()) {
169 panic("mm_cpu_init failed");
170 }
171
Wedson Almeida Filho1f81b752018-10-24 15:15:49 +0100172 vcpu = &vm_get(HF_PRIMARY_VM_ID)->vcpus[cpu_index(c)];
Andrew Scullc960c032018-10-24 15:13:35 +0100173 vm = vcpu->vm;
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100174 vcpu->cpu = c;
Andrew Scullc960c032018-10-24 15:13:35 +0100175
176 /* Reset the registers to give a clean start for the primary's vCPU. */
177 arch_regs_reset(&vcpu->regs, true, vm->id, vm->ptable.root,
178 vcpu_index(vcpu));
179
Wedson Almeida Filho00df6c72018-10-18 11:19:24 +0100180 return vcpu;
Wedson Almeida Filho987c0ff2018-06-20 16:34:38 +0100181}