1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 2011 The Chromium OS Authors.
4 */
5 #define DEBUG
6 #include <common.h>
7 #include <dm.h>
8 #include <errno.h>
9 #include <linux/libfdt.h>
10 #include <os.h>
11 #include <asm/io.h>
12 #include <asm/setjmp.h>
13 #include <asm/state.h>
14 #include <dm/root.h>
15
16 DECLARE_GLOBAL_DATA_PTR;
17
18 /* Enable access to PCI memory with map_sysmem() */
19 static bool enable_pci_map;
20
21 #ifdef CONFIG_PCI
22 /* Last device that was mapped into memory, and length of mapping */
23 static struct udevice *map_dev;
24 unsigned long map_len;
25 #endif
26
sandbox_exit(void)27 void sandbox_exit(void)
28 {
29 /* Do this here while it still has an effect */
30 os_fd_restore();
31 if (state_uninit())
32 os_exit(2);
33
34 if (dm_uninit())
35 os_exit(2);
36
37 /* This is considered normal termination for now */
38 os_exit(0);
39 }
40
41 /* delay x useconds */
__udelay(unsigned long usec)42 void __udelay(unsigned long usec)
43 {
44 struct sandbox_state *state = state_get_current();
45
46 if (!state->skip_delays)
47 os_usleep(usec);
48 }
49
cleanup_before_linux(void)50 int cleanup_before_linux(void)
51 {
52 return 0;
53 }
54
cleanup_before_linux_select(int flags)55 int cleanup_before_linux_select(int flags)
56 {
57 return 0;
58 }
59
phys_to_virt(phys_addr_t paddr)60 void *phys_to_virt(phys_addr_t paddr)
61 {
62 return (void *)(gd->arch.ram_buf + paddr);
63 }
64
virt_to_phys(void * vaddr)65 phys_addr_t virt_to_phys(void *vaddr)
66 {
67 return (phys_addr_t)((uint8_t *)vaddr - gd->arch.ram_buf);
68 }
69
map_physmem(phys_addr_t paddr,unsigned long len,unsigned long flags)70 void *map_physmem(phys_addr_t paddr, unsigned long len, unsigned long flags)
71 {
72 #if defined(CONFIG_PCI) && !defined(CONFIG_SPL_BUILD)
73 unsigned long plen = len;
74 void *ptr;
75
76 map_dev = NULL;
77 if (enable_pci_map && !pci_map_physmem(paddr, &len, &map_dev, &ptr)) {
78 if (plen != len) {
79 printf("%s: Warning: partial map at %x, wanted %lx, got %lx\n",
80 __func__, (uint)paddr, len, plen);
81 }
82 map_len = len;
83 return ptr;
84 }
85 #endif
86
87 return phys_to_virt(paddr);
88 }
89
unmap_physmem(const void * vaddr,unsigned long flags)90 void unmap_physmem(const void *vaddr, unsigned long flags)
91 {
92 #ifdef CONFIG_PCI
93 if (map_dev) {
94 pci_unmap_physmem(vaddr, map_len, map_dev);
95 map_dev = NULL;
96 }
97 #endif
98 }
99
sandbox_set_enable_pci_map(int enable)100 void sandbox_set_enable_pci_map(int enable)
101 {
102 enable_pci_map = enable;
103 }
104
map_to_sysmem(const void * ptr)105 phys_addr_t map_to_sysmem(const void *ptr)
106 {
107 return (u8 *)ptr - gd->arch.ram_buf;
108 }
109
flush_dcache_range(unsigned long start,unsigned long stop)110 void flush_dcache_range(unsigned long start, unsigned long stop)
111 {
112 }
113
invalidate_dcache_range(unsigned long start,unsigned long stop)114 void invalidate_dcache_range(unsigned long start, unsigned long stop)
115 {
116 }
117
sandbox_read_fdt_from_file(void)118 int sandbox_read_fdt_from_file(void)
119 {
120 struct sandbox_state *state = state_get_current();
121 const char *fname = state->fdt_fname;
122 void *blob;
123 loff_t size;
124 int err;
125 int fd;
126
127 blob = map_sysmem(CONFIG_SYS_FDT_LOAD_ADDR, 0);
128 if (!state->fdt_fname) {
129 err = fdt_create_empty_tree(blob, 256);
130 if (!err)
131 goto done;
132 printf("Unable to create empty FDT: %s\n", fdt_strerror(err));
133 return -EINVAL;
134 }
135
136 err = os_get_filesize(fname, &size);
137 if (err < 0) {
138 printf("Failed to file FDT file '%s'\n", fname);
139 return err;
140 }
141 fd = os_open(fname, OS_O_RDONLY);
142 if (fd < 0) {
143 printf("Failed to open FDT file '%s'\n", fname);
144 return -EACCES;
145 }
146 if (os_read(fd, blob, size) != size) {
147 os_close(fd);
148 return -EIO;
149 }
150 os_close(fd);
151
152 done:
153 gd->fdt_blob = blob;
154
155 return 0;
156 }
157
timer_get_boot_us(void)158 ulong timer_get_boot_us(void)
159 {
160 static uint64_t base_count;
161 uint64_t count = os_get_nsec();
162
163 if (!base_count)
164 base_count = count;
165
166 return (count - base_count) / 1000;
167 }
168
setjmp(jmp_buf jmp)169 int setjmp(jmp_buf jmp)
170 {
171 return os_setjmp((ulong *)jmp, sizeof(*jmp));
172 }
173
longjmp(jmp_buf jmp,int ret)174 void longjmp(jmp_buf jmp, int ret)
175 {
176 os_longjmp((ulong *)jmp, ret);
177 while (1)
178 ;
179 }
180