arch/sandbox/cpu/cpu.c

   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__, (uint)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 }