Blame view
lib/addr_map.c
1.96 KB
63240ba88 Introduce addr_ma... |
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 |
/* * 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); } |
7b6e80538 lib/powerpc: addr... |
49 |
void *addrmap_phys_to_virt(phys_addr_t paddr) |
63240ba88 Introduce addr_ma... |
50 51 52 53 |
{ int i; for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) { |
7b6e80538 lib/powerpc: addr... |
54 |
phys_addr_t base, upper; |
63240ba88 Introduce addr_ma... |
55 56 57 |
if (address_map[i].size == 0) continue; |
7b6e80538 lib/powerpc: addr... |
58 59 |
base = address_map[i].paddr; upper = address_map[i].size + base - 1; |
63240ba88 Introduce addr_ma... |
60 |
|
7b6e80538 lib/powerpc: addr... |
61 62 63 64 65 66 |
if (paddr >= base && paddr <= upper) { phys_addr_t offset; offset = address_map[i].paddr - address_map[i].vaddr; return (void *)(unsigned long)(paddr - offset); |
63240ba88 Introduce addr_ma... |
67 68 |
} } |
7b6e80538 lib/powerpc: addr... |
69 |
return (void *)(~0); |
63240ba88 Introduce addr_ma... |
70 71 72 73 74 75 76 77 78 79 80 81 |
} 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; } |