summaryrefslogtreecommitdiff
path: root/src/kernel/mm/pmm.cc
blob: 9b68fcda74c6152719369a7f538a7f46f819aec7 (plain)
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
#include "kernel/pmm.h"
#include "drivers/uart.h"

extern "C" char kernel_end[];

namespace PMM
{
    struct Run
    {
        struct Run *next;
    };

    struct
    {
        struct Run *freelist;
    } kmem;

    inline uint64_t PGROUNDUP(uint64_t a)
    {
        return (a + PGSIZE - 1) & ~(PGSIZE - 1);
    }

    void init()
    {
        uint64_t start = PGROUNDUP((uint64_t)kernel_end);

        Drivers::uart_puts("PMM: Initializing from");

        for (uint64_t p = start; p + PGSIZE <= PHYSTOP; p += PGSIZE)
        {
            free_page((void *)p);
        }
    }

    void free_page(void* pa)
    {
        struct Run *r;
        if (((uint64_t)pa % PGSIZE) != 0 || (uint64_t)pa < (uint64_t)kernel_end || (uint64_t)pa >= PHYSTOP)
        {
            Drivers::uart_puts("PMM: Error - Invalid free address\n");
            return;
        }
        r = (struct Run*)pa;

        r->next = kmem.freelist;
        kmem.freelist = r;
        
    }

    void* alloc_page()
    {
        struct Run* r;

        r = kmem.freelist;
        if (r)
        {
            kmem.freelist = r->next;

            uint64_t *p = (uint64_t *)r;
            for (int i = 0; i < PGSIZE / 8; i++)
            {
                p[i] = 0;
            }
        }
        else
        {
            Drivers::uart_puts("PMM: Out of memory!\n");
        }
        return (void *)r;
    }
}