44 lines
1.1 KiB
C
44 lines
1.1 KiB
C
|
#include "mem.h"
|
||
|
|
|
||
|
|
void memory_copy(u8 *source, u8 *dest, int nbytes) {
|
||
|
|
int i;
|
||
|
|
for (i = 0; i < nbytes; i++) {
|
||
|
|
*(dest + i) = *(source + i);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void memory_set(u8 *dest, u8 val, u32 len) {
|
||
|
|
u8 *temp = (u8 *)dest;
|
||
|
|
for ( ; len != 0; len--) *temp++ = val;
|
||
|
|
}
|
||
|
|
|
||
|
|
// See mem.h for free_mem_addr global declaration
|
||
|
|
/* Implementation is just a pointer to some free memory which
|
||
|
|
* keeps growing */
|
||
|
|
u32 kmalloc(u32 size, int align, u32 *phys_addr) {
|
||
|
|
/* Pages are aligned to 4K, or 0x1000 */
|
||
|
|
if (align == 1 && (free_mem_addr & 0xFFFFF000)) {
|
||
|
|
free_mem_addr &= 0xFFFFF000;
|
||
|
|
free_mem_addr += 0x1000;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
char c[16];
|
||
|
|
hex_to_ascii( (u32) *phys_addr, c);
|
||
|
|
kprint("Inside kmalloc phys_addr = ");
|
||
|
|
kprint(c);
|
||
|
|
kprint("\n");
|
||
|
|
|
||
|
|
/* Save also the physical address */
|
||
|
|
*phys_addr = free_mem_addr;
|
||
|
|
|
||
|
|
hex_to_ascii( (u32) *phys_addr, c);
|
||
|
|
kprint("Inside kmalloc phys_addr = ");
|
||
|
|
kprint(c);
|
||
|
|
kprint("\n");
|
||
|
|
|
||
|
|
u32 ret = free_mem_addr;
|
||
|
|
free_mem_addr += size; /* Remember to increment the pointer */
|
||
|
|
return ret;
|
||
|
|
}
|