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 #include <mapmem.h>
9
10 struct addrmap address_map[CONFIG_SYS_NUM_ADDR_MAP];
11
addrmap_virt_to_phys(void * vaddr)12 phys_addr_t addrmap_virt_to_phys(void * vaddr)
13 {
14 int i;
15
16 for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
17 u64 base, upper, addr;
18
19 if (address_map[i].size == 0)
20 continue;
21
22 addr = map_to_sysmem(vaddr);
23 base = (u64)(address_map[i].vaddr);
24 upper = (u64)(address_map[i].size) + base - 1;
25
26 if (addr >= base && addr <= upper) {
27 return addr - address_map[i].vaddr + address_map[i].paddr;
28 }
29 }
30
31 return (phys_addr_t)(~0);
32 }
33
addrmap_phys_to_virt(phys_addr_t paddr)34 void *addrmap_phys_to_virt(phys_addr_t paddr)
35 {
36 int i;
37
38 for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++) {
39 phys_addr_t base, upper;
40
41 if (address_map[i].size == 0)
42 continue;
43
44 base = address_map[i].paddr;
45 upper = address_map[i].size + base - 1;
46
47 if (paddr >= base && paddr <= upper) {
48 phys_addr_t offset;
49
50 offset = address_map[i].paddr - address_map[i].vaddr;
51
52 return map_sysmem(paddr - offset, 0);
53 }
54 }
55
56 return (void *)(~0);
57 }
58
addrmap_set_entry(unsigned long vaddr,phys_addr_t paddr,phys_size_t size,int idx)59 void addrmap_set_entry(unsigned long vaddr, phys_addr_t paddr,
60 phys_size_t size, int idx)
61 {
62 if (idx > CONFIG_SYS_NUM_ADDR_MAP)
63 return;
64
65 address_map[idx].vaddr = vaddr;
66 address_map[idx].paddr = paddr;
67 address_map[idx].size = size;
68 }
69