brolang/std/mem/mem.bro

import "@ffi/c"

AllocError :: enum {
	out_of_memory
}

Allocator :: struct {
	context ?@mut anyopaque
	vtable @AllocatorVTable
}

AllocatorVTable :: struct {
	alloc @func(context ?@mut anyopaque, size usize, alignment usize) ?*mut u8
	realloc @func(context ?@mut anyopaque, memory ?*mut u8, old_size usize, new_size usize, alignment usize) ?*mut u8
	free @func(context ?@mut anyopaque, memory ?*mut u8, size usize, alignment usize) void
}

raw_alloc func(allocator Allocator, size usize, alignment usize) ?*mut u8 {
	return allocator.vtable.alloc(allocator.context, size, alignment)
}

raw_realloc func(allocator Allocator, memory ?*mut u8, old_size usize, new_size usize, alignment usize) ?*mut u8 {
	return allocator.vtable.realloc(allocator.context, memory, old_size, new_size, alignment)
}

raw_free func(allocator Allocator, memory ?*mut u8, size usize, alignment usize) void {
	allocator.vtable.free(allocator.context, memory, size, alignment)
}

eql func($T type, left, right []T) bool {
	if left.len != right.len {
		return false
	}

	i usize = 0
	while i < left.len : i += 1 {
		if left[i] != right[i] {
			return false
		}
	}
	return true
}

hide empty_storage [1]mut u64 = [0]

hide empty_slice func($T type, count usize) []mut T {
	pointer *mut T :: ptrcast!(T, (&empty_storage).ptr)
	return pointer[..count]
}

empty func($T type) []mut T {
	return empty_slice(T, 0)
}

alloc func($T type, allocator Allocator, count usize) []mut T ! AllocError {
	if count == 0 {
		return empty_slice(T, 0)
	}

	element_size usize :: sizeof!(T)
	if element_size == 0 {
		return empty_slice(T, count)
	}
	if count > divtrunc!(maxval!(usize), element_size) {
		return .out_of_memory
	}

	memory ?*mut u8 = raw_alloc(allocator, count * element_size, alignof!(T))
	if memory |bytes| {
		pointer *mut T :: ptrcast!(T, bytes)
		return pointer[..count]
	}
	return .out_of_memory
}

realloc func($T type, allocator Allocator, memory []mut T, new_count usize) []mut T ! AllocError {
	if new_count == memory.len {
		return memory
	}
	if new_count == 0 {
		free(allocator, memory)
		return empty_slice(T, 0)
	}

	element_size usize :: sizeof!(T)
	if element_size == 0 {
		return empty_slice(T, new_count)
	}
	if new_count > divtrunc!(maxval!(usize), element_size) {
		return .out_of_memory
	}

	old_memory ?*mut u8 = none
	old_size usize = 0
	if memory.len != 0 {
		old_memory = ptrcast!(u8, memory.ptr)
		old_size = memory.len * element_size
	}
	resized ?*mut u8 = raw_realloc(
		allocator,
		old_memory,
		old_size,
		new_count * element_size,
		alignof!(T),
	)
	if resized |bytes| {
		pointer *mut T :: ptrcast!(T, bytes)
		return pointer[..new_count]
	}
	return .out_of_memory
}

free func($T type, allocator Allocator, memory []mut T) void {
	if memory.len != 0 and sizeof!(T) != 0 {
		raw_free(allocator, ptrcast!(u8, memory.ptr), memory.len * sizeof!(T), alignof!(T))
	}
}

hide malloc_alignment usize :: 16 # ponytail: aarch64-macos libc malloc alignment assumption.

hide power_of_two func(value usize) bool {
	if value == 0 {
		return false
	}

	current usize = value
	while current > 1 {
		half usize = divtrunc!(current, 2)
		if half * 2 != current {
			return false
		}
		current = half
	}

	return true
}

hide c_alloc func(_ ?@mut anyopaque, size usize, alignment usize) ?*mut u8 {
	if power_of_two(alignment) == false {
		return none
	}

	if alignment <= malloc_alignment {
		return ptrcast!(u8, c.malloc(c_ulong(size)))
	}

	memory [1]mut ?*mut anyopaque = [none]
	status c_int = c.posix_memalign((&memory).ptr, c_ulong(alignment), c_ulong(size))
	if status != 0 {
		return none
	}

	return ptrcast!(u8, memory[0])
}

hide c_realloc func(_ ?@mut anyopaque, memory ?*mut u8, old_size usize, new_size usize, alignment usize) ?*mut u8 {
	if power_of_two(alignment) == false {
		return none
	}

	if new_size == 0 {
		c.free(memory)
		return none
	}

	if memory |old_memory| {
		if alignment <= malloc_alignment {
			return ptrcast!(u8, c.realloc(old_memory, c_ulong(new_size)))
		}

		new_memory ?*mut u8 = c_alloc(none, new_size, alignment)
		if new_memory |new_bytes| {
			copy_size usize = old_size
			if new_size < copy_size {
				copy_size = new_size
			}
			i usize = 0
			while i < copy_size : i += 1 {
				new_bytes[i] = old_memory[i]
			}
			c.free(old_memory)
		}
		return new_memory
	}

	return c_alloc(none, new_size, alignment)
}

hide c_free func(_ ?@mut anyopaque, memory ?*mut u8, _ usize, _ usize) void {
	c.free(memory)
}

hide c_vtable AllocatorVTable :: AllocatorVTable {
	alloc = c_alloc,
	realloc = c_realloc,
	free = c_free,
}

c_allocator Allocator :: Allocator {
	context = none,
	vtable = &c_vtable,
}