blob: 728f8ddf087fc9d4cbba07fbf8ebc32456e664ee (
plain) (
blame)
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
|
#include <apos/types.h>
#include <apos/attrs.h>
#include <apos/utils.h>
#include <vmem.h>
#include <csr.h>
/* assume 64 bit for now */
struct __packed init_vmem {
int *leaf[512];
};
struct init_vmem *root_branch;
/* assume Sv39 for now */
void init_vmem()
{
size_t flags = VM_V | VM_X | VM_R | VM_W;
extern char *__init_start;
root_branch = (struct init_vmem *)align_down((size_t)&__init_start - SZ_4K, SZ_4K);
for(size_t i = 0; i < 512; ++i)
root_branch->leaf[i] = 0;
/* direct mapping (temp) */
for(size_t i = 0; i < 256; ++i)
root_branch->leaf[i] = (int *)((1UL << 28) * i | flags);
/* kernel (also sort of direct mapping) */
/* FIXME set up actually correct addressing retard */
for(size_t i = 256; i < 512; ++i)
root_branch->leaf[256] = (int *)(((RAM_BASE >> 12) << 10) | flags);
csr_write(CSR_SATP, SATP_MODE_Sv39 | ((size_t)root_branch >> 12));
}
void move_kernel()
{
extern char *__init_end;
extern char *__kernel_size;
size_t sz = (size_t)&__kernel_size;
char *src = (char *)&__init_end;
char *dst = (char *)VM_KERN;
for(size_t i = 0; i < sz; ++i)
dst[i] = src[i];
}
void __init init(void *fdt)
{
extern char *__init_end;
void (*kernel_main)(void *fdt) = (void (*)(void *))(VM_KERN);
init_vmem();
move_kernel();
kernel_main(fdt);
}
|
