mem: Refactor vma/vmo

This commit is contained in:
2026-10-25 17:49:25 +01:00
parent ef08e2e5d7
commit efe1feb852
6 changed files with 1084 additions and 317 deletions
+319 -181
View File
@@ -1,75 +1,250 @@
// SPDX-License-Identifier: ISC
#include <zinnia/alloc.h>
#include <zinnia/errno.h>
#include <zinnia/list.h>
#include <zinnia/print.h>
#include <zinnia/utils.h>
#include <zinnia/vma.h>
#include <zinnia/vmo.h>
#include <string.h>
constexpr size_t RA_MIN_PAGES = 8;
constexpr size_t RA_MAX_PAGES = 64;
void vmo_init(struct vmo* vmo, const struct vmo_pager_ops* pager) {
refcount_init(&vmo->rc);
vmo->pager = pager;
mutex_init(&vmo->lock);
radix_init(&vmo->pages);
tailq_init(&vmo->mappings);
vmo->ra_next = UINT64_MAX;
vmo->ra_window = RA_MIN_PAGES;
vmo->cache = CACHE_ANY;
}
void vmo_ref(struct vmo* obj) {
refcount_inc(&obj->rc);
}
static void release_pages(struct vmo* vmo) {
struct page* batch[32];
uint64_t indices[32];
size_t found;
while ((found = radix_gang_lookup(&vmo->pages, 0, ARRAY_SIZE(batch), (void**)batch, indices)) != 0) {
for (size_t i = 0; i < found; i++) {
radix_remove(&vmo->pages, indices[i]);
page_unhold(batch[i]);
}
}
radix_destroy(&vmo->pages);
}
void vmo_unref(struct vmo* obj) {
if (refcount_dec(&obj->rc))
obj->destroy(obj);
if (!refcount_dec(&obj->rc))
return;
if (obj->pager->put_pages) {
errno_t status = vmo_sync(obj, 0, UINT64_MAX);
if (status)
log_warn("vmo: Dropping dirty pages after failed writeback (%i)\n", status);
}
release_pages(obj);
obj->pager->destroy(obj);
}
errno_t vmo_read(struct vmo* obj, uintptr_t offset, void* buf, size_t len, size_t* actual_read) {
static void mark_dirty(struct vmo* vmo, struct page* page, uint64_t index) {
if (!vmo->pager->put_pages)
return;
atomic_fetch_or(&page->flags, PAGE_DIRTY, ATOMIC_RELAXED);
radix_tag_set(&vmo->pages, index, RADIX_TAG_DIRTY);
}
static void wait_busy(struct vmo* vmo, struct page* page) {
page_hold(page);
mutex_unlock(&vmo->lock);
page_wait(page);
page_unhold(page);
mutex_lock(&vmo->lock);
}
static size_t cluster_size(struct vmo* vmo, uint64_t index) {
const size_t max = MIN(vmo->pager->max_cluster, RA_MAX_PAGES);
if (!vmo->pager->get_pages || max <= 1)
return 1;
vmo->ra_window = index == vmo->ra_next ? MIN(vmo->ra_window * 2, max) : MIN(RA_MIN_PAGES, max);
size_t count = vmo->ra_window;
if (index > UINT64_MAX - count)
count = UINT64_MAX - index;
vmo->ra_next = index + count;
for (size_t i = 1; i < count; i++) {
if (radix_lookup(&vmo->pages, index + i))
return i;
}
return MAX(count, 1);
}
static errno_t fill(struct vmo* vmo, uint64_t index, enum vmo_access access, struct page** out) {
struct page* pages[RA_MAX_PAGES];
size_t count = cluster_size(vmo, index);
const enum alloc_flags flags = vmo->pager->get_pages ? ALLOC_NOZERO : 0;
for (size_t i = 0; i < count; i++) {
struct page* page;
errno_t status = page_alloc(flags, &page);
if (!status) {
page->obj.owner = vmo;
page->obj.index = index + i;
atomic_store(&page->flags, PAGE_BUSY, ATOMIC_RELAXED);
status = radix_insert(&vmo->pages, index + i, page);
if (status)
page_unhold(page);
}
if (status) {
if (i == 0) {
mutex_unlock(&vmo->lock);
return status;
}
count = i;
break;
}
pages[i] = page;
}
page_hold(pages[0]);
mutex_unlock(&vmo->lock);
size_t valid = count;
errno_t status = 0;
if (vmo->pager->get_pages)
status = vmo->pager->get_pages(vmo, index, pages, count, &valid);
mutex_lock(&vmo->lock);
for (size_t i = 0; i < count; i++) {
if (status || i >= valid) {
radix_remove(&vmo->pages, index + i);
page_unbusy(pages[i]);
page_unhold(pages[i]);
continue;
}
if (i == 0 && access == VMO_WRITE)
mark_dirty(vmo, pages[i], index);
page_unbusy(pages[i]);
}
mutex_unlock(&vmo->lock);
if (status || valid == 0) {
page_unhold(pages[0]);
return status ? status : ENXIO;
}
*out = pages[0];
return 0;
}
errno_t vmo_get_page(struct vmo* vmo, uint64_t index, enum vmo_access access, struct page** out) {
if (vmo->pager->lookup)
return ENOTSUP;
mutex_lock(&vmo->lock);
while (true) {
struct page* page = radix_lookup(&vmo->pages, index);
if (!page)
return fill(vmo, index, access, out);
if (atomic_load(&page->flags, ATOMIC_ACQUIRE) & PAGE_BUSY) {
wait_busy(vmo, page);
continue;
}
page_hold(page);
if (access == VMO_WRITE)
mark_dirty(vmo, page, index);
mutex_unlock(&vmo->lock);
*out = page;
return 0;
}
}
void vmo_put_page(struct page* page) {
page_unhold(page);
}
static errno_t copy_data(
struct vmo* obj,
uint64_t offset,
size_t len,
enum vmo_access access,
void* buf,
iovec_iter_t* iter,
size_t* out
) {
const size_t page_size = arch_mem_page_size();
size_t progress = 0;
errno_t status = 0;
while (progress < len) {
const size_t misalign = (progress + offset) % page_size;
const size_t page_index = (progress + offset) / page_size;
const size_t copy_size = MIN(page_size - misalign, len - progress);
const size_t misalign = (offset + progress) % page_size;
const uint64_t index = (offset + progress) / page_size;
const size_t chunk = MIN(page_size - misalign, len - progress);
struct page* p;
status = obj->get_page(obj, page_index, &p);
if (status != 0)
struct page* page = nullptr;
phys_t phys;
if (obj->pager->lookup) {
status = obj->pager->lookup(obj, index, &phys);
} else {
status = vmo_get_page(obj, index, access, &page);
if (!status)
phys = vm_page_addr(page);
}
if (status)
break;
uintptr_t page_addr = vm_page_addr(p);
uint8_t* ptr = (uint8_t*)HHDM_PTR(phys) + misalign;
size_t done = chunk;
if (iter && access == VMO_WRITE)
status = iovec_iter_copy_from(iter, ptr, chunk, &done);
else if (iter)
status = iovec_iter_copy_to(iter, ptr, chunk, &done);
else if (access == VMO_WRITE)
memcpy(ptr, (uint8_t*)buf + progress, chunk);
else
memcpy((uint8_t*)buf + progress, ptr, chunk);
memcpy(buf + progress, HHDM_PTR(page_addr) + misalign, copy_size);
progress += copy_size;
if (page)
vmo_put_page(page);
progress += done;
if (status || done < chunk)
break;
}
if (actual_read)
*actual_read = progress;
if (out)
*out = progress;
return status;
}
errno_t vmo_write(struct vmo* obj, uintptr_t offset, const void* buf, size_t len, size_t* actual_written) {
const size_t page_size = arch_mem_page_size();
size_t progress = 0;
errno_t status = 0;
errno_t vmo_read(struct vmo* obj, uint64_t offset, void* buf, size_t len, size_t* actual_read) {
return copy_data(obj, offset, len, VMO_READ, buf, nullptr, actual_read);
}
while (progress < len) {
const size_t misalign = (progress + offset) % page_size;
const size_t page_index = (progress + offset) / page_size;
const size_t copy_size = MIN(page_size - misalign, len - progress);
errno_t vmo_write(struct vmo* obj, uint64_t offset, const void* buf, size_t len, size_t* actual_written) {
return copy_data(obj, offset, len, VMO_WRITE, (void*)buf, nullptr, actual_written);
}
struct page* p;
status = obj->get_page(obj, page_index, &p);
if (status != 0)
break;
errno_t vmo_read_iter(struct vmo* obj, uint64_t offset, iovec_iter_t* iter, size_t len, size_t* actual_read) {
return copy_data(obj, offset, len, VMO_READ, nullptr, iter, actual_read);
}
uintptr_t page_addr = vm_page_addr(p);
memcpy(HHDM_PTR(page_addr) + misalign, buf + progress, copy_size);
progress += copy_size;
}
if (actual_written)
*actual_written = progress;
return status;
errno_t vmo_write_iter(struct vmo* obj, uint64_t offset, iovec_iter_t* iter, size_t len, size_t* actual_written) {
return copy_data(obj, offset, len, VMO_WRITE, nullptr, iter, actual_written);
}
errno_t vmo_copy(
struct vmo* target,
uintptr_t target_offset,
uint64_t target_offset,
struct vmo* src,
uintptr_t src_offset,
uint64_t src_offset,
size_t len,
size_t* actual_copied
) {
@@ -80,25 +255,27 @@ errno_t vmo_copy(
while (progress < len) {
const size_t target_misalign = (progress + target_offset) % page_size;
const size_t src_misalign = (progress + src_offset) % page_size;
const size_t target_page_index = (progress + target_offset) / page_size;
const size_t src_page_index = (progress + src_offset) / page_size;
const size_t copy_size = MIN(MIN(page_size - target_misalign, page_size - src_misalign), len - progress);
struct page* tpage;
status = target->get_page(target, target_page_index, &tpage);
if (status != 0)
status = vmo_get_page(target, (progress + target_offset) / page_size, VMO_WRITE, &tpage);
if (status)
break;
struct page* spage;
status = src->get_page(src, src_page_index, &spage);
if (status != 0)
status = vmo_get_page(src, (progress + src_offset) / page_size, VMO_READ, &spage);
if (status) {
vmo_put_page(tpage);
break;
}
uintptr_t taddr = vm_page_addr(tpage);
uintptr_t saddr = vm_page_addr(spage);
memcpy(HHDM_PTR(taddr) + target_misalign, HHDM_PTR(saddr) + src_misalign, copy_size);
memcpy(
(uint8_t*)HHDM_PTR(vm_page_addr(tpage)) + target_misalign,
(uint8_t*)HHDM_PTR(vm_page_addr(spage)) + src_misalign,
copy_size
);
vmo_put_page(spage);
vmo_put_page(tpage);
progress += copy_size;
}
@@ -107,157 +284,118 @@ errno_t vmo_copy(
return status;
}
static errno_t paged_get_page(struct vmo* vmo, uintptr_t offset_idx, struct page** out) {
struct paged_vmo* paged = containerof(vmo, struct paged_vmo, object);
// Try to find the requested page in the cache.
struct page_list* iter;
spin_lock(&paged->lock);
list_foreach(iter, &paged->cache, next) {
if (iter->offset != offset_idx)
continue;
// We found a cached page!
*out = iter->value;
spin_unlock(&paged->lock);
errno_t vmo_sync(struct vmo* vmo, uint64_t first, uint64_t end) {
if (!vmo->pager->put_pages)
return 0;
}
spin_unlock(&paged->lock);
// Get page from out pager if we don't have one already.
struct page* new_page;
errno_t status = paged->source.get_page(&paged->source, offset_idx, &new_page);
if (status)
return status;
struct page* run[RA_MAX_PAGES];
const size_t max = MAX(MIN(vmo->pager->max_cluster, RA_MAX_PAGES), 1);
errno_t result = 0;
struct page_list* entry = mem_alloc(sizeof(struct page_list), 0);
if (!entry) {
paged->source.put_page(&paged->source, offset_idx, new_page);
return ENOMEM;
}
entry->offset = offset_idx;
entry->value = new_page;
spin_lock(&paged->lock);
list_foreach(iter, &paged->cache, next) {
if (iter->offset != offset_idx)
mutex_lock(&vmo->lock);
while (first < end) {
struct page* found;
uint64_t index;
if (!radix_gang_lookup_tag(&vmo->pages, first, RADIX_TAG_DIRTY, 1, (void**)&found, &index) || index >= end)
break;
if (!page_try_busy(found)) {
wait_busy(vmo, found);
continue;
}
*out = iter->value;
spin_unlock(&paged->lock);
mem_free(entry);
paged->source.put_page(&paged->source, offset_idx, new_page);
return 0;
size_t count = 1;
run[0] = found;
while (count < max && index + count < end && index + count != 0) {
struct page* next = radix_lookup(&vmo->pages, index + count);
if (!next || !radix_tag_get(&vmo->pages, index + count, RADIX_TAG_DIRTY) || !page_try_busy(next))
break;
run[count++] = next;
}
for (size_t i = 0; i < count; i++) {
radix_tag_clear(&vmo->pages, index + i, RADIX_TAG_DIRTY);
radix_tag_set(&vmo->pages, index + i, RADIX_TAG_WRITEBACK);
atomic_fetch_and(&run[i]->flags, ~PAGE_DIRTY, ATOMIC_RELAXED);
page_hold(run[i]);
vma_object_remove_page(vmo, index + i, vm_page_addr(run[i]), true);
}
mutex_unlock(&vmo->lock);
errno_t status = vmo->pager->put_pages(vmo, index, run, count);
mutex_lock(&vmo->lock);
for (size_t i = 0; i < count; i++) {
radix_tag_clear(&vmo->pages, index + i, RADIX_TAG_WRITEBACK);
if (status)
mark_dirty(vmo, run[i], index + i);
page_unbusy(run[i]);
page_unhold(run[i]);
}
if (status && !result)
result = status;
first = index + count;
if (first == 0)
break;
}
// Add page to the object cache.
list_insert_head(&paged->cache, entry, next);
spin_unlock(&paged->lock);
*out = new_page;
return 0;
mutex_unlock(&vmo->lock);
return result;
}
static void paged_destroy(struct vmo* vmo) {
struct paged_vmo* paged = containerof(vmo, struct paged_vmo, object);
struct page_list* iter = list_first(&paged->cache);
while (iter) {
struct page_list* next = list_next(iter, next);
paged->source.put_page(&paged->source, iter->offset, iter->value);
mem_free(iter);
iter = next;
}
mem_free(paged);
}
errno_t vmo_new_paged(struct pager_ops pager, struct paged_vmo** out) {
struct paged_vmo* result = mem_alloc(sizeof(struct paged_vmo), 0);
if (!result)
return ENOMEM;
refcount_init(&result->object.rc);
result->source = pager;
result->object.get_page = paged_get_page;
result->object.destroy = paged_destroy;
*out = result;
return 0;
}
static errno_t phys_get_page(struct pager_ops* pager, uintptr_t offset, struct page** out) {
phys_t addr;
errno_t status = mem_phys_alloc(1, 0, &addr);
if (status != 0)
return status;
size_t idx = addr / arch_mem_page_size();
*out = &vm_pfndb[idx];
return 0;
}
static errno_t phys_put_page(struct pager_ops* pager, uintptr_t offset, struct page* page) {
return mem_phys_free(vm_page_addr(page), 1);
}
static const struct pager_ops phys_pager = {
.get_page = phys_get_page,
.put_page = phys_put_page,
};
errno_t vmo_new_phys(struct paged_vmo** out) {
return vmo_new_paged(phys_pager, out);
}
void vmo_truncate_paged(struct paged_vmo* paged, size_t length) {
void vmo_truncate(struct vmo* vmo, uint64_t length) {
const size_t page_size = arch_mem_page_size();
const size_t keep_pages = ROUND_UP(length, page_size);
uint64_t first = length / page_size + (length % page_size != 0);
spin_lock(&paged->lock);
struct page_list** pp = &list_first(&paged->cache);
while (*pp) {
struct page_list* entry = *pp;
if (entry->offset >= keep_pages) {
*pp = list_next(entry, next);
paged->source.put_page(&paged->source, entry->offset, entry->value);
mem_free(entry);
} else {
pp = &list_next(entry, next);
mutex_lock(&vmo->lock);
while (true) {
struct page* page;
uint64_t index;
if (!radix_gang_lookup(&vmo->pages, first, 1, (void**)&page, &index))
break;
if (!page_try_busy(page)) {
wait_busy(vmo, page);
continue;
}
vma_object_remove_page(vmo, index, vm_page_addr(page), false);
radix_remove(&vmo->pages, index);
page_unbusy(page);
page_unhold(page);
first = index + 1;
}
if (length % page_size != 0) {
while (true) {
struct page* tail = radix_lookup(&vmo->pages, length / page_size);
if (!tail)
break;
if (atomic_load(&tail->flags, ATOMIC_ACQUIRE) & PAGE_BUSY) {
wait_busy(vmo, tail);
continue;
}
memset((uint8_t*)HHDM_PTR(vm_page_addr(tail)) + length % page_size, 0, page_size - length % page_size);
mark_dirty(vmo, tail, length / page_size);
break;
}
}
spin_unlock(&paged->lock);
mutex_unlock(&vmo->lock);
}
struct phys_range_vmo {
struct vmo object;
uintptr_t start;
size_t len;
struct anon_vmo {
struct vmo vmo;
};
static errno_t phys_range_get_page(struct vmo* vmo, uintptr_t offset_idx, struct page** out) {
struct phys_range_vmo* p = containerof(vmo, struct phys_range_vmo, object);
if (offset_idx >= p->len / arch_mem_page_size())
return EINVAL;
*out = &vm_pfndb[(p->start / arch_mem_page_size()) + offset_idx];
return 0;
static void anon_destroy(struct vmo* vmo) {
mem_free(containerof(vmo, struct anon_vmo, vmo));
}
static void phys_range_destroy(struct vmo* vmo) {
mem_free(containerof(vmo, struct phys_range_vmo, object));
}
static const struct vmo_pager_ops anon_pager = {
.destroy = anon_destroy,
};
errno_t vmo_new_phys_range(uintptr_t addr, size_t length, struct vmo** out) {
struct phys_range_vmo* vmo = mem_alloc(sizeof(struct phys_range_vmo), 0);
if (!vmo)
errno_t vmo_new_anon(struct vmo** out) {
struct anon_vmo* anon = mem_alloc(sizeof(struct anon_vmo), 0);
if (!anon)
return ENOMEM;
refcount_init(&vmo->object.rc);
vmo->object.get_page = phys_range_get_page;
vmo->object.destroy = phys_range_destroy;
vmo->start = ALIGN_DOWN(addr, arch_mem_page_size());
vmo->len = ALIGN_UP(length, arch_mem_page_size());
*out = &vmo->object;
vmo_init(&anon->vmo, &anon_pager);
*out = &anon->vmo;
return 0;
}