|
24
|
1 #include "kernel.h"
|
|
|
2
|
|
|
3 #define HEAP_MAGIC 0xc0ffee
|
|
|
4 #define HEAP_START 0x400000
|
|
|
5 #define HEAP_SIZE 0x200000
|
|
|
6 #define HEAP_INUSE 1
|
|
|
7 #define HEAP_FREE 0
|
|
|
8
|
|
|
9 typedef struct {
|
|
|
10 uint64_t magic;
|
|
|
11 uint64_t state;
|
|
|
12 uint64_t size;
|
|
|
13 } heap_t;
|
|
|
14
|
|
|
15 /*
|
|
|
16 malloc and free divide the chunks of memory present at the heap
|
|
|
17 of the kernel into smaller parts.
|
|
|
18 The heap is located at: 0x
|
|
|
19 */
|
|
|
20 static heap_t* kernel_heap = (heap_t*) 0x400000; // 4 MB - 6 MB is heap
|
|
|
21 /* Allocates 'size' bytes and returns the pointer if succesfull.
|
|
|
22 Kernelpanic in case of failure..
|
|
|
23 */
|
|
|
24
|
|
26
|
25 void* kmalloc(uint64_t size)
|
|
|
26 {
|
|
24
|
27 // Start at the beginning of our heap and search a free block:
|
|
|
28 heap_t *current = kernel_heap;
|
|
|
29 while (current->magic == HEAP_MAGIC)
|
|
|
30 {
|
|
|
31 if ((current->state == HEAP_FREE) && (current->size >= size))
|
|
|
32 {
|
|
|
33 // Mark block as used:
|
|
|
34 current->state = HEAP_INUSE;
|
|
|
35
|
|
|
36 // Insert a heap header if required:
|
|
|
37 if (current->size > size + sizeof(heap_t) + 1)
|
|
|
38 {
|
|
|
39 // Calculate location of the inserted header:
|
|
|
40 heap_t *newheader = (heap_t*) (((char*)current)+size+sizeof(heap_t));
|
|
|
41
|
|
|
42 // Set the new header fields:
|
|
|
43 newheader->size = current->size - size - sizeof(heap_t);
|
|
|
44 newheader->state = HEAP_FREE;
|
|
|
45 newheader->magic = HEAP_MAGIC;
|
|
|
46
|
|
|
47 // Set the size of this block
|
|
|
48 current->size = size;
|
|
|
49 }
|
|
|
50 else
|
|
|
51 {
|
|
|
52 // We allocate this whole block
|
|
|
53 }
|
|
|
54 // Calculate the size of the block:
|
|
|
55 char *address = ((char*)current)+sizeof(heap_t);
|
|
|
56 return address;
|
|
|
57
|
|
|
58 }
|
|
|
59 // Goto next heap block:
|
|
|
60 current = (heap_t*)(((char*) current) + current->size + sizeof(heap_t));
|
|
|
61 }
|
|
|
62 return 0x0;
|
|
|
63 }
|
|
|
64
|
|
26
|
65 void kfree(void* ptr)
|
|
|
66 {
|
|
24
|
67 printf("Free address %x\n", ptr);
|
|
|
68 }
|
|
|
69
|
|
|
70 void init_heap(void)
|
|
|
71 {
|
|
|
72 // Initialize the kernel heap:
|
|
|
73 kernel_heap->magic = HEAP_MAGIC;
|
|
|
74 kernel_heap->state = HEAP_FREE;
|
|
|
75 kernel_heap->size = HEAP_SIZE - sizeof(heap_t);
|
|
|
76 }
|
|
25
|
77
|
