1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright 2008 Freescale Semiconductor, Inc.
4 */
5
6 #include <common.h>
7 #include <addr_map.h>
8
9 struct addrmap address_map[CONFIG_SYS_NUM_ADDR_MAP];
10
addrmap_virt_to_phys(void * vaddr)11 phys_addr_t addrmap_virt_to_phys(void * vaddr)
12 {
13 int i;
14
15 for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
16 u64 base, upper, addr;
17
18 if (address_map[i].size == 0)
19 continue;
20
21 addr = (u64)((u32)vaddr);
22 base = (u64)(address_map[i].vaddr);
23 upper = (u64)(address_map[i].size) + base - 1;
24
25 if (addr >= base && addr <= upper) {
26 return addr - address_map[i].vaddr + address_map[i].paddr;
27 }
28 }
29
30 return (phys_addr_t)(~0);
31 }
32
addrmap_phys_to_virt(phys_addr_t paddr)33 void *addrmap_phys_to_virt(phys_addr_t paddr)
34 {
35 int i;
36
37 for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
38 phys_addr_t base, upper;
39
40 if (address_map[i].size == 0)
41 continue;
42
43 base = address_map[i].paddr;
44 upper = address_map[i].size + base - 1;
45
46 if (paddr >= base && paddr <= upper) {
47 phys_addr_t offset;
48
49 offset = address_map[i].paddr - address_map[i].vaddr;
50
51 return (void *)(unsigned long)(paddr - offset);
52 }
53 }
54
55 return (void *)(~0);
56 }
57
addrmap_set_entry(unsigned long vaddr,phys_addr_t paddr,phys_size_t size,int idx)58 void addrmap_set_entry(unsigned long vaddr, phys_addr_t paddr,
59 phys_size_t size, int idx)
60 {
61 if (idx > CONFIG_SYS_NUM_ADDR_MAP)
62 return;
63
64 address_map[idx].vaddr = vaddr;
65 address_map[idx].paddr = paddr;
66 address_map[idx].size = size;
67 }
68