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/root.h>
   8 #include <os.h>
   9 #include <asm/io.h>
  10 #include <asm/state.h>
  11
  12 DECLARE_GLOBAL_DATA_PTR;
  13
  14 /* Enable access to PCI memory with map_sysmem() */
  15 static bool enable_pci_map;
  16
  17 #ifdef CONFIG_PCI
  18 /* Last device that was mapped into memory, and length of mapping */
  19 static struct udevice *map_dev;
  20 unsigned long map_len;
  21 #endif
  22
  23 void reset_cpu(ulong ignored)
  24 {
  25         if (state_uninit())
  26                 os_exit(2);
  27
  28         if (dm_uninit())
  29                 os_exit(2);
  30
  31         /* This is considered normal termination for now */
  32         os_exit(0);
  33 }
  34
  35 int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  36 {
  37         reset_cpu(0);
  38
  39         return 0;
  40 }
  41
  42 /* delay x useconds */
  43 void __udelay(unsigned long usec)
  44 {
  45         os_usleep(usec);
  46 }
  47
  48 unsigned long __attribute__((no_instrument_function)) timer_get_us(void)
  49 {
  50         return os_get_nsec() / 1000;
  51 }
  52
  53 int cleanup_before_linux(void)
  54 {
  55         return 0;
  56 }
  57
  58 void *map_physmem(phys_addr_t paddr, unsigned long len, unsigned long flags)
  59 {
  60 #ifdef CONFIG_PCI
  61         unsigned long plen = len;
  62         void *ptr;
  63
  64         map_dev = NULL;
  65         if (enable_pci_map && !pci_map_physmem(paddr, &len, &map_dev, &ptr)) {
  66                 if (plen != len) {
  67                         printf("%s: Warning: partial map at %x, wanted %lx, got %lx\n",
  68                                __func__, paddr, len, plen);
  69                 }
  70                 map_len = len;
  71                 return ptr;
  72         }
  73 #endif
  74
  75         return (void *)(gd->arch.ram_buf + paddr);
  76 }
  77
  78 void unmap_physmem(const void *vaddr, unsigned long flags)
  79 {
  80 #ifdef CONFIG_PCI
  81         if (map_dev) {
  82                 pci_unmap_physmem(vaddr, map_len, map_dev);
  83                 map_dev = NULL;
  84         }
  85 #endif
  86 }
  87
  88 void sandbox_set_enable_pci_map(int enable)
  89 {
  90         enable_pci_map = enable;
  91 }
  92
  93 phys_addr_t map_to_sysmem(const void *ptr)
  94 {
  95         return (u8 *)ptr - gd->arch.ram_buf;
  96 }
  97
  98 void flush_dcache_range(unsigned long start, unsigned long stop)
  99 {
 100 }
 101
 102 int sandbox_read_fdt_from_file(void)
 103 {
 104         struct sandbox_state *state = state_get_current();
 105         const char *fname = state->fdt_fname;
 106         void *blob;
 107         loff_t size;
 108         int err;
 109         int fd;
 110
 111         blob = map_sysmem(CONFIG_SYS_FDT_LOAD_ADDR, 0);
 112         if (!state->fdt_fname) {
 113                 err = fdt_create_empty_tree(blob, 256);
 114                 if (!err)
 115                         goto done;
 116                 printf("Unable to create empty FDT: %s\n", fdt_strerror(err));
 117                 return -EINVAL;
 118         }
 119
 120         err = os_get_filesize(fname, &size);
 121         if (err < 0) {
 122                 printf("Failed to file FDT file '%s'\n", fname);
 123                 return err;
 124         }
 125         fd = os_open(fname, OS_O_RDONLY);
 126         if (fd < 0) {
 127                 printf("Failed to open FDT file '%s'\n", fname);
 128                 return -EACCES;
 129         }
 130         if (os_read(fd, blob, size) != size) {
 131                 os_close(fd);
 132                 return -EIO;
 133         }
 134         os_close(fd);
 135
 136 done:
 137         gd->fdt_blob = blob;
 138
 139         return 0;
 140 }