1 files changed, 44 insertions, 0 deletions

diff --git a/rsnix/src/memory.rs b/rsnix/src/memory.rs
index 099f607..2a32da8 100644
--- a/rsnix/src/memory.rs
+++ b/rsnix/src/memory.rs
@@ -1194,6 +1194,50 @@ pub fn alloc_pages(count: usize) -> Option<usize> {
     alloc_pages_aligned(count, 1)
 }
 
+/// Allocate `count` contiguous physical pages at or above `min_addr`
+/// (first-fit upward from there).  Used for controller DMA buffers that
+/// must avoid low conventional memory — the first 640 K on some real
+/// chipsets is hostile to PCI masters and shows up as a controller
+/// "System Error" (SE) halt.  Page-aligned like `alloc_pages`.
+pub fn alloc_pages_above(count: usize, min_addr: usize) -> Option<usize> {
+    if count == 0 {
+        return None;
+    }
+    unsafe {
+        if BITMAP.is_null() {
+            return None;
+        }
+        let span = SPAN_PAGES;
+        let min_page = min_addr.div_ceil(PAGE_SIZE).max(BASE_PAGE);
+        if min_page >= BASE_PAGE + span {
+            return None;
+        }
+        let start_idx = min_page - BASE_PAGE;
+        let mut run_start = 0usize;
+        let mut run_len = 0usize;
+        for idx in start_idx..span {
+            let free = (*BITMAP.add(idx / 8) >> (idx % 8)) & 1 == 0;
+            if free {
+                if run_len == 0 {
+                    run_start = idx;
+                }
+                run_len += 1;
+                if run_len >= count {
+                    let p = (BASE_PAGE + run_start) * PAGE_SIZE;
+                    for k in run_start..run_start + count {
+                        *BITMAP.add(k / 8) |= 1 << (k % 8);
+                    }
+                    FREE_PAGES -= count;
+                    return Some(p);
+                }
+            } else {
+                run_len = 0;
+            }
+        }
+        None
+    }
+}
+
 /// Allocate `count` contiguous physical pages whose start address is
 /// aligned to `align_pages` (a power of two, in page units).
 pub fn alloc_pages_aligned(count: usize, align_pages: usize) -> Option<usize> {