Blame view
lib/addr_map.c
1.36 KB
d41ce506b Initial Release, ... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 |
/* * Copyright 2008 Freescale Semiconductor, Inc. * * SPDX-License-Identifier: GPL-2.0 */ #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; } |