blob: e6ddb17a140381b59abd7d8b0c597eff8a18a57e [file] [log] [blame]
Simon Glass4b0730d2011-09-26 14:10:39 +00001/*
2 * Copyright (c) 2011 The Chromium OS Authors.
Wolfgang Denk1a459662013-07-08 09:37:19 +02003 * SPDX-License-Identifier: GPL-2.0+
Simon Glass4b0730d2011-09-26 14:10:39 +00004 */
Simon Glass9569c402015-03-05 12:25:26 -07005#define DEBUG
Simon Glass4b0730d2011-09-26 14:10:39 +00006#include <common.h>
Simon Glass61336832014-07-23 06:55:02 -06007#include <dm/root.h>
Simon Glass7a9219c2011-10-03 19:26:44 +00008#include <os.h>
Simon Glassb45122f2015-02-27 22:06:34 -07009#include <asm/io.h>
Simon Glass5c2859c2013-11-10 10:27:03 -070010#include <asm/state.h>
Simon Glass4b0730d2011-09-26 14:10:39 +000011
12DECLARE_GLOBAL_DATA_PTR;
13
Simon Glass9569c402015-03-05 12:25:26 -070014/* Enable access to PCI memory with map_sysmem() */
15static bool enable_pci_map;
16
17#ifdef CONFIG_PCI
18/* Last device that was mapped into memory, and length of mapping */
19static struct udevice *map_dev;
20unsigned long map_len;
21#endif
22
Simon Glass88bd0e92013-11-10 10:27:00 -070023void reset_cpu(ulong ignored)
Simon Glass4b0730d2011-09-26 14:10:39 +000024{
Simon Glass8939df02015-05-10 21:07:27 -060025 /* Do this here while it still has an effect */
26 os_fd_restore();
Simon Glass5c2859c2013-11-10 10:27:03 -070027 if (state_uninit())
28 os_exit(2);
29
Simon Glass61336832014-07-23 06:55:02 -060030 if (dm_uninit())
31 os_exit(2);
32
Simon Glass7a9219c2011-10-03 19:26:44 +000033 /* This is considered normal termination for now */
34 os_exit(0);
Simon Glass88bd0e92013-11-10 10:27:00 -070035}
36
37int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
38{
39 reset_cpu(0);
40
Simon Glass4b0730d2011-09-26 14:10:39 +000041 return 0;
42}
43
44/* delay x useconds */
45void __udelay(unsigned long usec)
46{
Matthias Weisserd99a6872011-11-29 12:16:40 +010047 os_usleep(usec);
Simon Glass4b0730d2011-09-26 14:10:39 +000048}
49
Simon Glass4b0730d2011-09-26 14:10:39 +000050int cleanup_before_linux(void)
51{
52 return 0;
53}
54
Simon Glass29748512015-05-13 07:02:26 -060055int cleanup_before_linux_select(int flags)
56{
57 return 0;
58}
59
Simon Glass4b0730d2011-09-26 14:10:39 +000060void *map_physmem(phys_addr_t paddr, unsigned long len, unsigned long flags)
61{
Simon Glass9569c402015-03-05 12:25:26 -070062#ifdef CONFIG_PCI
63 unsigned long plen = len;
64 void *ptr;
65
66 map_dev = NULL;
67 if (enable_pci_map && !pci_map_physmem(paddr, &len, &map_dev, &ptr)) {
68 if (plen != len) {
69 printf("%s: Warning: partial map at %x, wanted %lx, got %lx\n",
70 __func__, paddr, len, plen);
71 }
72 map_len = len;
73 return ptr;
74 }
75#endif
76
Simon Glass8ee666a2012-12-13 20:49:11 +000077 return (void *)(gd->arch.ram_buf + paddr);
Simon Glass4b0730d2011-09-26 14:10:39 +000078}
79
Simon Glass9569c402015-03-05 12:25:26 -070080void unmap_physmem(const void *vaddr, unsigned long flags)
81{
82#ifdef CONFIG_PCI
83 if (map_dev) {
84 pci_unmap_physmem(vaddr, map_len, map_dev);
85 map_dev = NULL;
86 }
87#endif
88}
89
90void sandbox_set_enable_pci_map(int enable)
91{
92 enable_pci_map = enable;
93}
94
Simon Glass66bd1cf2014-02-27 13:25:55 -070095phys_addr_t map_to_sysmem(const void *ptr)
Simon Glass781adb52013-04-20 08:42:37 +000096{
97 return (u8 *)ptr - gd->arch.ram_buf;
98}
99
Simon Glass4b0730d2011-09-26 14:10:39 +0000100void flush_dcache_range(unsigned long start, unsigned long stop)
101{
102}
Simon Glassb45122f2015-02-27 22:06:34 -0700103
104int sandbox_read_fdt_from_file(void)
105{
106 struct sandbox_state *state = state_get_current();
107 const char *fname = state->fdt_fname;
108 void *blob;
109 loff_t size;
110 int err;
111 int fd;
112
113 blob = map_sysmem(CONFIG_SYS_FDT_LOAD_ADDR, 0);
114 if (!state->fdt_fname) {
115 err = fdt_create_empty_tree(blob, 256);
116 if (!err)
117 goto done;
118 printf("Unable to create empty FDT: %s\n", fdt_strerror(err));
119 return -EINVAL;
120 }
121
122 err = os_get_filesize(fname, &size);
123 if (err < 0) {
124 printf("Failed to file FDT file '%s'\n", fname);
125 return err;
126 }
127 fd = os_open(fname, OS_O_RDONLY);
128 if (fd < 0) {
129 printf("Failed to open FDT file '%s'\n", fname);
130 return -EACCES;
131 }
132 if (os_read(fd, blob, size) != size) {
133 os_close(fd);
134 return -EIO;
135 }
136 os_close(fd);
137
138done:
139 gd->fdt_blob = blob;
140
141 return 0;
142}