Implement sa11x0_bs_unmap.

Submitted by:	kevlo

1 files changed, 15 insertions, 3 deletions

diff --git a/sys/arm/sa11x0/sa11x0_io.c b/sys/arm/sa11x0/sa11x0_io.c
index e88af0c938cd..964e18257cf0 100644
--- a/sys/arm/sa11x0/sa11x0_io.c
+++ b/sys/arm/sa11x0/sa11x0_io.c
@@ -188,9 +188,21 @@ sa11x0_bs_unmap(t, size)
 	void *t;
 	bus_size_t size;
 {
-	/*
-	 * Temporary implementation
-	 */
+	vm_offset_t va, endva;
+
+	if (pmap_devmap_find_va((vm_offset_t)t, size) != NULL) {
+		/* Device was statically mapped; nothing to do. */
+		return;
+	}
+
+	va = trunc_page((vm_offset_t)t);
+	endva = round_page((vm_offset_t)t + size);
+
+	while (va < endva) {
+		pmap_kremove(va);
+		va += PAGE_SIZE;
+	}
+	kmem_free(kernel_map, va, endva - va);
 }
 
 void