1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
|
#include "vm.h"
#include "mtrap.h"
uintptr_t mem_size;
uint32_t num_harts;
static void mstatus_init()
{
uintptr_t ms = 0;
#ifdef __riscv64
ms = INSERT_FIELD(ms, MSTATUS_SA, UA_RV64);
#endif
ms = INSERT_FIELD(ms, MSTATUS_PRV, PRV_M);
ms = INSERT_FIELD(ms, MSTATUS_IE, 0);
ms = INSERT_FIELD(ms, MSTATUS_PRV1, PRV_S);
ms = INSERT_FIELD(ms, MSTATUS_IE1, 0);
ms = INSERT_FIELD(ms, MSTATUS_PRV2, PRV_U);
ms = INSERT_FIELD(ms, MSTATUS_IE2, 1);
ms = INSERT_FIELD(ms, MSTATUS_MPRV, PRV_M);
ms = INSERT_FIELD(ms, MSTATUS_VM, VM_CHOICE);
ms = INSERT_FIELD(ms, MSTATUS_FS, 3);
ms = INSERT_FIELD(ms, MSTATUS_XS, 3);
write_csr(mstatus, ms);
ms = read_csr(mstatus);
if (EXTRACT_FIELD(ms, MSTATUS_PRV1) != PRV_S) {
ms = INSERT_FIELD(ms, MSTATUS_PRV1, PRV_U);
ms = INSERT_FIELD(ms, MSTATUS_IE1, 1);
write_csr(mstatus, ms);
panic("supervisor support is required");
}
if (EXTRACT_FIELD(ms, MSTATUS_VM) != VM_CHOICE)
have_vm = 0;
}
static void memory_init()
{
if (mem_size == 0)
panic("could not determine memory capacity");
}
static void hart_init()
{
if (num_harts == 0)
panic("could not determine number of harts");
if (num_harts != 1)
panic("TODO: SMP support");
}
static void fp_init()
{
kassert(read_csr(mstatus) & MSTATUS_FS);
extern int test_fpu_presence();
#ifdef __riscv_hard_float
if (!test_fpu_presence())
panic("FPU not found; recompile pk with -msoft-float");
for (int i = 0; i < 32; i++)
init_fp_reg(i);
#else
if (test_fpu_presence())
panic("FPU unexpectedly found; recompile pk without -msoft-float");
#endif
}
void machine_init()
{
file_init();
struct mainvars arg_buffer;
struct mainvars *args = parse_args(&arg_buffer);
mstatus_init();
memory_init();
hart_init();
fp_init();
vm_init();
boot_loader(args);
}
|