Merge branch 'master' of git://git.denx.de/u-boot-arm
[platform/kernel/u-boot.git] / lib / addr_map.c
1 /*
2  * Copyright 2008 Freescale Semiconductor, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License
6  * Version 2 as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful,
9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
11  * GNU General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
16  * MA 02111-1307 USA
17  */
18
19 #include <common.h>
20 #include <addr_map.h>
21
22 static struct {
23         phys_addr_t paddr;
24         phys_size_t size;
25         unsigned long vaddr;
26 } address_map[CONFIG_SYS_NUM_ADDR_MAP];
27
28 phys_addr_t addrmap_virt_to_phys(void * vaddr)
29 {
30         int i;
31
32         for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
33                 u64 base, upper, addr;
34
35                 if (address_map[i].size == 0)
36                         continue;
37
38                 addr = (u64)((u32)vaddr);
39                 base = (u64)(address_map[i].vaddr);
40                 upper = (u64)(address_map[i].size) + base - 1;
41
42                 if (addr >= base && addr <= upper) {
43                         return addr - address_map[i].vaddr + address_map[i].paddr;
44                 }
45         }
46
47         return (phys_addr_t)(~0);
48 }
49
50 unsigned long addrmap_phys_to_virt(phys_addr_t paddr)
51 {
52         int i;
53
54         for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
55                 u64 base, upper, addr;
56
57                 if (address_map[i].size == 0)
58                         continue;
59
60                 addr = (u64)paddr;
61                 base = (u64)(address_map[i].paddr);
62                 upper = (u64)(address_map[i].size) + base - 1;
63
64                 if (addr >= base && addr <= upper) {
65                         return paddr - address_map[i].paddr + address_map[i].vaddr;
66                 }
67         }
68
69         return (unsigned long)(~0);
70 }
71
72 void addrmap_set_entry(unsigned long vaddr, phys_addr_t paddr,
73                         phys_size_t size, int idx)
74 {
75         if (idx > CONFIG_SYS_NUM_ADDR_MAP)
76                 return;
77
78         address_map[idx].vaddr = vaddr;
79         address_map[idx].paddr = paddr;
80         address_map[idx].size  = size;
81 }