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