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 *map_physmem(phys_addr_t paddr, unsigned long len, unsigned long flags) 60 { 61 #if defined(CONFIG_PCI) && !defined(CONFIG_SPL_BUILD) 62 unsigned long plen = len; 63 void *ptr; 64 65 map_dev = NULL; 66 if (enable_pci_map && !pci_map_physmem(paddr, &len, &map_dev, &ptr)) { 67 if (plen != len) { 68 printf("%s: Warning: partial map at %x, wanted %lx, got %lx\n", 69 __func__, paddr, len, plen); 70 } 71 map_len = len; 72 return ptr; 73 } 74 #endif 75 76 return (void *)(gd->arch.ram_buf + paddr); 77 } 78 79 void unmap_physmem(const void *vaddr, unsigned long flags) 80 { 81 #ifdef CONFIG_PCI 82 if (map_dev) { 83 pci_unmap_physmem(vaddr, map_len, map_dev); 84 map_dev = NULL; 85 } 86 #endif 87 } 88 89 void sandbox_set_enable_pci_map(int enable) 90 { 91 enable_pci_map = enable; 92 } 93 94 phys_addr_t map_to_sysmem(const void *ptr) 95 { 96 return (u8 *)ptr - gd->arch.ram_buf; 97 } 98 99 void flush_dcache_range(unsigned long start, unsigned long stop) 100 { 101 } 102 103 int sandbox_read_fdt_from_file(void) 104 { 105 struct sandbox_state *state = state_get_current(); 106 const char *fname = state->fdt_fname; 107 void *blob; 108 loff_t size; 109 int err; 110 int fd; 111 112 blob = map_sysmem(CONFIG_SYS_FDT_LOAD_ADDR, 0); 113 if (!state->fdt_fname) { 114 err = fdt_create_empty_tree(blob, 256); 115 if (!err) 116 goto done; 117 printf("Unable to create empty FDT: %s\n", fdt_strerror(err)); 118 return -EINVAL; 119 } 120 121 err = os_get_filesize(fname, &size); 122 if (err < 0) { 123 printf("Failed to file FDT file '%s'\n", fname); 124 return err; 125 } 126 fd = os_open(fname, OS_O_RDONLY); 127 if (fd < 0) { 128 printf("Failed to open FDT file '%s'\n", fname); 129 return -EACCES; 130 } 131 if (os_read(fd, blob, size) != size) { 132 os_close(fd); 133 return -EIO; 134 } 135 os_close(fd); 136 137 done: 138 gd->fdt_blob = blob; 139 140 return 0; 141 } 142 143 ulong timer_get_boot_us(void) 144 { 145 static uint64_t base_count; 146 uint64_t count = os_get_nsec(); 147 148 if (!base_count) 149 base_count = count; 150 151 return (count - base_count) / 1000; 152 } 153