Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / u-boot / lib / addr_map.c

diff --git a/qemu/roms/u-boot/lib/addr_map.c b/qemu/roms/u-boot/lib/addr_map.c
new file mode 100644 (file)
index 0000000..31384d1
--- /dev/null
+++ b/qemu/roms/u-boot/lib/addr_map.c
@@ -0,0 +1,84 @@
+/*
+ * Copyright 2008 Freescale Semiconductor, Inc.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * Version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ */
+
+#include <common.h>
+#include <addr_map.h>
+
+static struct {
+       phys_addr_t paddr;
+       phys_size_t size;
+       unsigned long vaddr;
+} address_map[CONFIG_SYS_NUM_ADDR_MAP];
+
+phys_addr_t addrmap_virt_to_phys(void * vaddr)
+{
+       int i;
+
+       for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
+               u64 base, upper, addr;
+
+               if (address_map[i].size == 0)
+                       continue;
+
+               addr = (u64)((u32)vaddr);
+               base = (u64)(address_map[i].vaddr);
+               upper = (u64)(address_map[i].size) + base - 1;
+
+               if (addr >= base && addr <= upper) {
+                       return addr - address_map[i].vaddr + address_map[i].paddr;
+               }
+       }
+
+       return (phys_addr_t)(~0);
+}
+
+void *addrmap_phys_to_virt(phys_addr_t paddr)
+{
+       int i;
+
+       for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
+               phys_addr_t base, upper;
+
+               if (address_map[i].size == 0)
+                       continue;
+
+               base = address_map[i].paddr;
+               upper = address_map[i].size + base - 1;
+
+               if (paddr >= base && paddr <= upper) {
+                       phys_addr_t offset;
+
+                       offset = address_map[i].paddr - address_map[i].vaddr;
+
+                       return (void *)(unsigned long)(paddr - offset);
+               }
+       }
+
+       return (void *)(~0);
+}
+
+void addrmap_set_entry(unsigned long vaddr, phys_addr_t paddr,
+                       phys_size_t size, int idx)
+{
+       if (idx > CONFIG_SYS_NUM_ADDR_MAP)
+               return;
+
+       address_map[idx].vaddr = vaddr;
+       address_map[idx].paddr = paddr;
+       address_map[idx].size  = size;
+}