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
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
|
/* Bitmap Based Allocation:
* https://web.archive.org/web/20190316115948/http://www.brokenthorn.com/Resources/OSDev17.html
*/
/* TODO: Stack based allocation? */
#include <stdbool.h>
#include <stdint.h>
#include <libk/stdio.h>
#include <mm/memory_map.h>
#include <mm/physical_mm.h>
#include <kernel/halt.h>
extern uint32_t kernel_start;
extern uint32_t kernel_end;
uint32_t block_count = 0;
uint32_t total_free_blocks = 0;
uint32_t memory_map[MAX_BLOCKS / BITMAP_ENTRY_SIZE];
ALWAYS_INLINE static void
physical_mm_log_memory_map(free_memory_regions_t *free_memory_regions)
{
printk("\nphysical_mm", "Free Memory Regions:");
for (int i = 0; i < free_memory_regions->n_regions; i++)
printk("physical_mm",
"start: 0x%.08x | length: 0x%.08x",
free_memory_regions->region_list[i]->addr_low,
free_memory_regions->region_list[i]->len_low);
printk("\nphysical_mm", "Kernel region:");
printk("physical_mm", "Start: 0x%x", &kernel_start);
printk("physical_mm", "End: 0x%x", &kernel_end);
printk("physical_mm",
"Size: 0x%x",
((uint32_t) &kernel_end) - ((uint32_t) &kernel_start));
}
/* Marks the block as 'used' */
ALWAYS_INLINE static void
physical_mm_set_used(const uint32_t bit)
{
uint32_t memory_map_index = bit / BITMAP_ENTRY_SIZE;
uint32_t bitmask = 1 << (bit % BITMAP_ENTRY_SIZE);
total_free_blocks--;
memory_map[memory_map_index] |= bitmask;
}
/* Marks the block as 'unused' */
ALWAYS_INLINE static void
physical_mm_set_usable(const uint32_t bit)
{
uint32_t memory_map_index = bit / BITMAP_ENTRY_SIZE;
uint32_t bitmask = 1 << (bit % BITMAP_ENTRY_SIZE);
total_free_blocks++;
memory_map[memory_map_index] &= ~bitmask;
}
/* Returns:
* True if the bit is set (block is in use)
* False if the bit is unset (block isn't in use)
*/
ALWAYS_INLINE static bool
physical_mm_test_bit(const uint32_t bit)
{
uint32_t memory_map_index = bit / BITMAP_ENTRY_SIZE;
uint32_t bitmask = 1 << (bit % BITMAP_ENTRY_SIZE);
return memory_map[memory_map_index] & bitmask;
}
ALWAYS_INLINE static void
physical_mm_initialize_region(uint32_t start, uint32_t length)
{
/* Get the location of the start address in the bitmap */
uint32_t bit = start / BLOCK_SIZE;
uint32_t n_blocks = length / BLOCK_SIZE;
for (; n_blocks > 0; n_blocks--)
if (physical_mm_test_bit(bit))
physical_mm_set_usable(bit++);
/* First block is always used (first 64 KiB) */
if (!physical_mm_test_bit(0))
physical_mm_set_used(0);
}
ALWAYS_INLINE static void
physical_mm_deinitialize_region(uint32_t start, uint32_t length)
{
uint32_t bit = start / BLOCK_SIZE;
uint32_t n_blocks = length / BLOCK_SIZE;
if (length % BLOCK_SIZE > 0)
n_blocks++;
for (; n_blocks > 0; n_blocks--)
if (!physical_mm_test_bit(bit))
physical_mm_set_used(bit++);
}
void
physical_mm_init(void)
{
free_memory_regions_t *free_memory_regions = memory_map_get_free_regions();
physical_mm_log_memory_map(free_memory_regions);
/* All blocks are initially used */
/* TODO: Move this block to a place after block_count is set. This is why
* using block_count instead of MAX_BLOCKS wasn't working. */
for (uint32_t i = 0; i < MAX_BLOCKS / BITMAP_ENTRY_SIZE; i++)
memory_map[i] = 0xffffffff;
uint32_t total_free_memory = 0;
for (int i = 0; i < free_memory_regions->n_regions; i++) {
multiboot_memory_map_t *region = free_memory_regions->region_list[i];
total_free_memory += region->len_low;
physical_mm_initialize_region(region->addr_low, region->len_low);
}
uint32_t kernel_size = ((uint32_t) &kernel_end) - ((uint32_t) &kernel_start);
physical_mm_deinitialize_region((uint32_t) &kernel_start, kernel_size);
total_free_memory -= kernel_size;
block_count = total_free_memory / BLOCK_SIZE;
printk("\nphysical_mm", "Total blocks: 0x%x", block_count);
printk("physical_mm", "Total free blocks: 0x%x", total_free_blocks);
#if 0
/* Manually loop through and calculate the number of free blocks. */
uint32_t free_blcks = 0;
for (uint32_t i = 0; i < MAX_BLOCKS / BITMAP_ENTRY_SIZE; i++)
/* At least one block in the entry isn't in use */
if (memory_map[i] != 0xffffffff)
/* Test each bit to see if it's zero */
for (uint32_t j = 0; j < BITMAP_ENTRY_SIZE; j++)
if (!physical_mm_test_bit(i * BITMAP_ENTRY_SIZE + j))
free_blcks++;
printk("physical_mm", "Calculated free blocks: 0x%x", free_blcks);
#endif
}
uint32_t
physical_mm_find_first_free_block(void)
{
/* TODO: Why doesn't using block_count instead of MAX_BLOCKS work? */
for (uint32_t i = 0; i < MAX_BLOCKS / BITMAP_ENTRY_SIZE; i++)
/* At least one block in the entry isn't in use */
if (memory_map[i] != 0xffffffff)
/* Test each bit to see if it's zero */
for (uint32_t j = 0; j < BITMAP_ENTRY_SIZE; j++)
if (!physical_mm_test_bit(i * BITMAP_ENTRY_SIZE + j))
return i * BITMAP_ENTRY_SIZE + j;
/* Shouldn't be reached, since we're keeping track of the number of free
* blocks */
ASSERT_NOT_REACHED();
return -1;
}
void *
physical_mm_allocate_block(void)
{
if (total_free_blocks == 0) {
printk("physical_mm", "No more free blocks!");
return NULL;
}
uint32_t block = physical_mm_find_first_free_block();
physical_mm_set_used(block);
uint32_t physical_address = block * BLOCK_SIZE;
return (void *) physical_address;
}
void
physical_mm_free_block(void *physical_address)
{
uint32_t block = ((uint32_t) physical_address) / BLOCK_SIZE;
physical_mm_set_usable(block);
}
|
