Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (c) 2011 The Chromium OS Authors. |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 4 | */ |
| 5 | |
Heinrich Schuchardt | 28eb509 | 2020-11-12 00:29:56 +0100 | [diff] [blame] | 6 | #define _GNU_SOURCE |
| 7 | |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 8 | #include <dirent.h> |
Simon Glass | e8015a6 | 2012-01-10 15:54:05 -0800 | [diff] [blame] | 9 | #include <errno.h> |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 10 | #include <fcntl.h> |
Andrew Scull | 2b40f80 | 2022-05-30 10:00:11 +0000 | [diff] [blame] | 11 | #include <pthread.h> |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 12 | #include <getopt.h> |
Simon Glass | 5dccd15 | 2018-05-16 09:42:22 -0600 | [diff] [blame] | 13 | #include <setjmp.h> |
Rasmus Villemoes | 2b72ad2 | 2020-02-14 10:58:37 +0000 | [diff] [blame] | 14 | #include <signal.h> |
Heinrich Schuchardt | bb63ea8 | 2022-04-04 22:45:03 +0200 | [diff] [blame] | 15 | #include <stdarg.h> |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 16 | #include <stdio.h> |
Simon Glass | fb4b4e8 | 2013-05-19 16:45:35 -0700 | [diff] [blame] | 17 | #include <stdint.h> |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 18 | #include <stdlib.h> |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 19 | #include <string.h> |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 20 | #include <termios.h> |
Matthias Weisser | 0d3dd14 | 2011-11-29 12:16:40 +0100 | [diff] [blame] | 21 | #include <time.h> |
Heinrich Schuchardt | 28eb509 | 2020-11-12 00:29:56 +0100 | [diff] [blame] | 22 | #include <ucontext.h> |
Simon Glass | e8015a6 | 2012-01-10 15:54:05 -0800 | [diff] [blame] | 23 | #include <unistd.h> |
Matthias Weisser | b5f7b47 | 2011-11-05 11:40:34 +0100 | [diff] [blame] | 24 | #include <sys/mman.h> |
Simon Glass | e8015a6 | 2012-01-10 15:54:05 -0800 | [diff] [blame] | 25 | #include <sys/stat.h> |
Simon Glass | 17064c0 | 2012-01-10 15:54:06 -0800 | [diff] [blame] | 26 | #include <sys/time.h> |
Simon Glass | e8015a6 | 2012-01-10 15:54:05 -0800 | [diff] [blame] | 27 | #include <sys/types.h> |
Heinrich Schuchardt | 28eb509 | 2020-11-12 00:29:56 +0100 | [diff] [blame] | 28 | #include <linux/compiler_attributes.h> |
Matthias Weisser | 0d3dd14 | 2011-11-29 12:16:40 +0100 | [diff] [blame] | 29 | #include <linux/types.h> |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 30 | |
Andrew Scull | 2b40f80 | 2022-05-30 10:00:11 +0000 | [diff] [blame] | 31 | #include <asm/fuzzing_engine.h> |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 32 | #include <asm/getopt.h> |
Andrew Scull | ca5d137 | 2022-05-30 10:00:10 +0000 | [diff] [blame] | 33 | #include <asm/main.h> |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 34 | #include <asm/sections.h> |
| 35 | #include <asm/state.h> |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 36 | #include <os.h> |
Simon Glass | 504548f | 2015-04-20 12:37:22 -0600 | [diff] [blame] | 37 | #include <rtc_def.h> |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 38 | |
Heinrich Schuchardt | c0d1a00 | 2020-12-30 18:07:48 +0100 | [diff] [blame] | 39 | /* Environment variable for time offset */ |
| 40 | #define ENV_TIME_OFFSET "UBOOT_SB_TIME_OFFSET" |
| 41 | |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 42 | /* Operating System Interface */ |
| 43 | |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 44 | struct os_mem_hdr { |
| 45 | size_t length; /* number of bytes in the block */ |
| 46 | }; |
| 47 | |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 48 | ssize_t os_read(int fd, void *buf, size_t count) |
| 49 | { |
| 50 | return read(fd, buf, count); |
| 51 | } |
| 52 | |
| 53 | ssize_t os_write(int fd, const void *buf, size_t count) |
| 54 | { |
| 55 | return write(fd, buf, count); |
| 56 | } |
| 57 | |
Heinrich Schuchardt | bb63ea8 | 2022-04-04 22:45:03 +0200 | [diff] [blame] | 58 | int os_printf(const char *fmt, ...) |
| 59 | { |
| 60 | va_list args; |
| 61 | int i; |
| 62 | |
| 63 | va_start(args, fmt); |
| 64 | i = vfprintf(stdout, fmt, args); |
| 65 | va_end(args); |
| 66 | |
| 67 | return i; |
| 68 | } |
| 69 | |
Mike Frysinger | 60addac | 2011-10-25 13:02:58 +0200 | [diff] [blame] | 70 | off_t os_lseek(int fd, off_t offset, int whence) |
| 71 | { |
| 72 | if (whence == OS_SEEK_SET) |
| 73 | whence = SEEK_SET; |
| 74 | else if (whence == OS_SEEK_CUR) |
| 75 | whence = SEEK_CUR; |
| 76 | else if (whence == OS_SEEK_END) |
| 77 | whence = SEEK_END; |
| 78 | else |
| 79 | os_exit(1); |
| 80 | return lseek(fd, offset, whence); |
| 81 | } |
| 82 | |
Simon Glass | 3196d75 | 2012-02-20 23:56:58 -0500 | [diff] [blame] | 83 | int os_open(const char *pathname, int os_flags) |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 84 | { |
Simon Glass | 3196d75 | 2012-02-20 23:56:58 -0500 | [diff] [blame] | 85 | int flags; |
| 86 | |
| 87 | switch (os_flags & OS_O_MASK) { |
| 88 | case OS_O_RDONLY: |
| 89 | default: |
| 90 | flags = O_RDONLY; |
| 91 | break; |
| 92 | |
| 93 | case OS_O_WRONLY: |
| 94 | flags = O_WRONLY; |
| 95 | break; |
| 96 | |
| 97 | case OS_O_RDWR: |
| 98 | flags = O_RDWR; |
| 99 | break; |
| 100 | } |
| 101 | |
| 102 | if (os_flags & OS_O_CREAT) |
| 103 | flags |= O_CREAT; |
Simon Glass | ce55a11 | 2018-10-01 11:55:07 -0600 | [diff] [blame] | 104 | if (os_flags & OS_O_TRUNC) |
| 105 | flags |= O_TRUNC; |
Heinrich Schuchardt | fc96df6 | 2020-10-27 20:29:24 +0100 | [diff] [blame] | 106 | /* |
| 107 | * During a cold reset execv() is used to relaunch the U-Boot binary. |
| 108 | * We must ensure that all files are closed in this case. |
| 109 | */ |
| 110 | flags |= O_CLOEXEC; |
Simon Glass | 3196d75 | 2012-02-20 23:56:58 -0500 | [diff] [blame] | 111 | |
| 112 | return open(pathname, flags, 0777); |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 113 | } |
| 114 | |
| 115 | int os_close(int fd) |
| 116 | { |
Heinrich Schuchardt | 69db2ee | 2020-10-27 20:29:21 +0100 | [diff] [blame] | 117 | /* Do not close the console input */ |
| 118 | if (fd) |
| 119 | return close(fd); |
| 120 | return -1; |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 121 | } |
| 122 | |
Stephen Warren | cd5edba | 2014-03-01 22:18:00 -0700 | [diff] [blame] | 123 | int os_unlink(const char *pathname) |
| 124 | { |
| 125 | return unlink(pathname); |
| 126 | } |
| 127 | |
Simon Glass | cd0684f | 2011-10-03 19:26:44 +0000 | [diff] [blame] | 128 | void os_exit(int exit_code) |
| 129 | { |
| 130 | exit(exit_code); |
| 131 | } |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 132 | |
Rasmus Villemoes | ae400f3 | 2022-09-27 11:54:04 +0200 | [diff] [blame] | 133 | unsigned int os_alarm(unsigned int seconds) |
| 134 | { |
| 135 | return alarm(seconds); |
| 136 | } |
| 137 | |
| 138 | void os_set_alarm_handler(void (*handler)(int)) |
| 139 | { |
| 140 | if (!handler) |
| 141 | handler = SIG_DFL; |
| 142 | signal(SIGALRM, handler); |
| 143 | } |
| 144 | |
| 145 | void os_raise_sigalrm(void) |
| 146 | { |
| 147 | raise(SIGALRM); |
| 148 | } |
| 149 | |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 150 | int os_write_file(const char *fname, const void *buf, int size) |
Simon Glass | cbfa845 | 2018-10-01 11:55:08 -0600 | [diff] [blame] | 151 | { |
Simon Glass | cbfa845 | 2018-10-01 11:55:08 -0600 | [diff] [blame] | 152 | int fd; |
| 153 | |
| 154 | fd = os_open(fname, OS_O_WRONLY | OS_O_CREAT | OS_O_TRUNC); |
| 155 | if (fd < 0) { |
| 156 | printf("Cannot open file '%s'\n", fname); |
| 157 | return -EIO; |
| 158 | } |
| 159 | if (os_write(fd, buf, size) != size) { |
| 160 | printf("Cannot write to file '%s'\n", fname); |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 161 | os_close(fd); |
Simon Glass | cbfa845 | 2018-10-01 11:55:08 -0600 | [diff] [blame] | 162 | return -EIO; |
| 163 | } |
| 164 | os_close(fd); |
Simon Glass | cbfa845 | 2018-10-01 11:55:08 -0600 | [diff] [blame] | 165 | |
| 166 | return 0; |
| 167 | } |
| 168 | |
Heinrich Schuchardt | 6db1b65 | 2023-04-05 11:34:15 +0200 | [diff] [blame] | 169 | off_t os_filesize(int fd) |
Simon Glass | 7b9cf84f | 2021-08-18 21:40:30 -0600 | [diff] [blame] | 170 | { |
| 171 | off_t size; |
| 172 | |
| 173 | size = os_lseek(fd, 0, OS_SEEK_END); |
| 174 | if (size < 0) |
| 175 | return -errno; |
| 176 | if (os_lseek(fd, 0, OS_SEEK_SET) < 0) |
| 177 | return -errno; |
| 178 | |
| 179 | return size; |
| 180 | } |
| 181 | |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 182 | int os_read_file(const char *fname, void **bufp, int *sizep) |
| 183 | { |
| 184 | off_t size; |
| 185 | int ret = -EIO; |
| 186 | int fd; |
| 187 | |
| 188 | fd = os_open(fname, OS_O_RDONLY); |
| 189 | if (fd < 0) { |
| 190 | printf("Cannot open file '%s'\n", fname); |
| 191 | goto err; |
| 192 | } |
Simon Glass | 7b9cf84f | 2021-08-18 21:40:30 -0600 | [diff] [blame] | 193 | size = os_filesize(fd); |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 194 | if (size < 0) { |
Simon Glass | 7b9cf84f | 2021-08-18 21:40:30 -0600 | [diff] [blame] | 195 | printf("Cannot get file size of '%s'\n", fname); |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 196 | goto err; |
| 197 | } |
Simon Glass | 7b9cf84f | 2021-08-18 21:40:30 -0600 | [diff] [blame] | 198 | |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 199 | *bufp = os_malloc(size); |
Simon Glass | 8d176d8 | 2018-11-06 15:21:25 -0700 | [diff] [blame] | 200 | if (!*bufp) { |
| 201 | printf("Not enough memory to read file '%s'\n", fname); |
| 202 | ret = -ENOMEM; |
| 203 | goto err; |
| 204 | } |
| 205 | if (os_read(fd, *bufp, size) != size) { |
| 206 | printf("Cannot read from file '%s'\n", fname); |
| 207 | goto err; |
| 208 | } |
| 209 | os_close(fd); |
| 210 | *sizep = size; |
| 211 | |
| 212 | return 0; |
| 213 | err: |
| 214 | os_close(fd); |
| 215 | return ret; |
| 216 | } |
| 217 | |
Simon Glass | e4c25c8 | 2021-08-18 21:40:31 -0600 | [diff] [blame] | 218 | int os_map_file(const char *pathname, int os_flags, void **bufp, int *sizep) |
| 219 | { |
| 220 | void *ptr; |
Heinrich Schuchardt | 6db1b65 | 2023-04-05 11:34:15 +0200 | [diff] [blame] | 221 | off_t size; |
Simon Glass | e4c25c8 | 2021-08-18 21:40:31 -0600 | [diff] [blame] | 222 | int ifd; |
| 223 | |
| 224 | ifd = os_open(pathname, os_flags); |
| 225 | if (ifd < 0) { |
| 226 | printf("Cannot open file '%s'\n", pathname); |
| 227 | return -EIO; |
| 228 | } |
| 229 | size = os_filesize(ifd); |
| 230 | if (size < 0) { |
| 231 | printf("Cannot get file size of '%s'\n", pathname); |
| 232 | return -EIO; |
| 233 | } |
Heinrich Schuchardt | 6db1b65 | 2023-04-05 11:34:15 +0200 | [diff] [blame] | 234 | if ((unsigned long long)size > (unsigned long long)SIZE_MAX) { |
| 235 | printf("File '%s' too large to map\n", pathname); |
| 236 | return -EIO; |
| 237 | } |
Simon Glass | e4c25c8 | 2021-08-18 21:40:31 -0600 | [diff] [blame] | 238 | |
| 239 | ptr = mmap(0, size, PROT_READ | PROT_WRITE, MAP_SHARED, ifd, 0); |
| 240 | if (ptr == MAP_FAILED) { |
| 241 | printf("Can't map file '%s': %s\n", pathname, strerror(errno)); |
| 242 | return -EPERM; |
| 243 | } |
| 244 | |
| 245 | *bufp = ptr; |
| 246 | *sizep = size; |
| 247 | |
| 248 | return 0; |
| 249 | } |
| 250 | |
Simon Glass | 5c1fd58 | 2021-10-23 17:25:58 -0600 | [diff] [blame] | 251 | int os_unmap(void *buf, int size) |
| 252 | { |
| 253 | if (munmap(buf, size)) { |
| 254 | printf("Can't unmap %p %x\n", buf, size); |
| 255 | return -EIO; |
| 256 | } |
| 257 | |
| 258 | return 0; |
| 259 | } |
| 260 | |
Simon Glass | 528a0f6 | 2023-08-24 13:55:37 -0600 | [diff] [blame] | 261 | int os_persistent_file(char *buf, int maxsize, const char *fname) |
| 262 | { |
| 263 | const char *dirname = getenv("U_BOOT_PERSISTENT_DATA_DIR"); |
| 264 | char *ptr; |
| 265 | int len; |
| 266 | |
| 267 | len = strlen(fname) + (dirname ? strlen(dirname) + 1 : 0) + 1; |
| 268 | if (len > maxsize) |
| 269 | return -ENOSPC; |
| 270 | |
| 271 | ptr = buf; |
| 272 | if (dirname) { |
| 273 | strcpy(ptr, dirname); |
| 274 | ptr += strlen(dirname); |
| 275 | *ptr++ = '/'; |
| 276 | } |
| 277 | strcpy(ptr, fname); |
| 278 | |
| 279 | if (access(buf, F_OK) == -1) |
| 280 | return -ENOENT; |
| 281 | |
| 282 | return 0; |
| 283 | } |
| 284 | |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 285 | /* Restore tty state when we exit */ |
| 286 | static struct termios orig_term; |
Simon Glass | 678ef47 | 2014-02-27 13:26:22 -0700 | [diff] [blame] | 287 | static bool term_setup; |
Simon Glass | ae50ec7 | 2018-10-01 11:55:20 -0600 | [diff] [blame] | 288 | static bool term_nonblock; |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 289 | |
Simon Glass | 9c3b7d6 | 2015-05-10 21:07:27 -0600 | [diff] [blame] | 290 | void os_fd_restore(void) |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 291 | { |
Simon Glass | 9c3b7d6 | 2015-05-10 21:07:27 -0600 | [diff] [blame] | 292 | if (term_setup) { |
Simon Glass | ae50ec7 | 2018-10-01 11:55:20 -0600 | [diff] [blame] | 293 | int flags; |
| 294 | |
Simon Glass | 678ef47 | 2014-02-27 13:26:22 -0700 | [diff] [blame] | 295 | tcsetattr(0, TCSANOW, &orig_term); |
Simon Glass | ae50ec7 | 2018-10-01 11:55:20 -0600 | [diff] [blame] | 296 | if (term_nonblock) { |
| 297 | flags = fcntl(0, F_GETFL, 0); |
| 298 | fcntl(0, F_SETFL, flags & ~O_NONBLOCK); |
| 299 | } |
Simon Glass | 9c3b7d6 | 2015-05-10 21:07:27 -0600 | [diff] [blame] | 300 | term_setup = false; |
| 301 | } |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 302 | } |
| 303 | |
Rasmus Villemoes | 2b72ad2 | 2020-02-14 10:58:37 +0000 | [diff] [blame] | 304 | static void os_sigint_handler(int sig) |
| 305 | { |
| 306 | os_fd_restore(); |
| 307 | signal(SIGINT, SIG_DFL); |
| 308 | raise(SIGINT); |
| 309 | } |
| 310 | |
Heinrich Schuchardt | 28eb509 | 2020-11-12 00:29:56 +0100 | [diff] [blame] | 311 | static void os_signal_handler(int sig, siginfo_t *info, void *con) |
| 312 | { |
| 313 | ucontext_t __maybe_unused *context = con; |
| 314 | unsigned long pc; |
| 315 | |
| 316 | #if defined(__x86_64__) |
| 317 | pc = context->uc_mcontext.gregs[REG_RIP]; |
| 318 | #elif defined(__aarch64__) |
| 319 | pc = context->uc_mcontext.pc; |
| 320 | #elif defined(__riscv) |
| 321 | pc = context->uc_mcontext.__gregs[REG_PC]; |
| 322 | #else |
| 323 | const char msg[] = |
| 324 | "\nUnsupported architecture, cannot read program counter\n"; |
| 325 | |
| 326 | os_write(1, msg, sizeof(msg)); |
| 327 | pc = 0; |
| 328 | #endif |
| 329 | |
| 330 | os_signal_action(sig, pc); |
| 331 | } |
| 332 | |
| 333 | int os_setup_signal_handlers(void) |
| 334 | { |
| 335 | struct sigaction act; |
| 336 | |
| 337 | act.sa_sigaction = os_signal_handler; |
| 338 | sigemptyset(&act.sa_mask); |
Heinrich Schuchardt | d3741bc | 2021-07-05 19:43:00 +0200 | [diff] [blame] | 339 | act.sa_flags = SA_SIGINFO; |
Heinrich Schuchardt | 28eb509 | 2020-11-12 00:29:56 +0100 | [diff] [blame] | 340 | if (sigaction(SIGILL, &act, NULL) || |
| 341 | sigaction(SIGBUS, &act, NULL) || |
| 342 | sigaction(SIGSEGV, &act, NULL)) |
| 343 | return -1; |
| 344 | return 0; |
| 345 | } |
| 346 | |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 347 | /* Put tty into raw mode so <tab> and <ctrl+c> work */ |
Simon Glass | 678ef47 | 2014-02-27 13:26:22 -0700 | [diff] [blame] | 348 | void os_tty_raw(int fd, bool allow_sigs) |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 349 | { |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 350 | struct termios term; |
Simon Glass | ae50ec7 | 2018-10-01 11:55:20 -0600 | [diff] [blame] | 351 | int flags; |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 352 | |
Simon Glass | 678ef47 | 2014-02-27 13:26:22 -0700 | [diff] [blame] | 353 | if (term_setup) |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 354 | return; |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 355 | |
| 356 | /* If not a tty, don't complain */ |
| 357 | if (tcgetattr(fd, &orig_term)) |
| 358 | return; |
| 359 | |
| 360 | term = orig_term; |
| 361 | term.c_iflag = IGNBRK | IGNPAR; |
| 362 | term.c_oflag = OPOST | ONLCR; |
| 363 | term.c_cflag = CS8 | CREAD | CLOCAL; |
Simon Glass | 678ef47 | 2014-02-27 13:26:22 -0700 | [diff] [blame] | 364 | term.c_lflag = allow_sigs ? ISIG : 0; |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 365 | if (tcsetattr(fd, TCSANOW, &term)) |
| 366 | return; |
| 367 | |
Simon Glass | ae50ec7 | 2018-10-01 11:55:20 -0600 | [diff] [blame] | 368 | flags = fcntl(fd, F_GETFL, 0); |
| 369 | if (!(flags & O_NONBLOCK)) { |
| 370 | if (fcntl(fd, F_SETFL, flags | O_NONBLOCK)) |
| 371 | return; |
| 372 | term_nonblock = true; |
| 373 | } |
| 374 | |
Simon Glass | 9c3b7d6 | 2015-05-10 21:07:27 -0600 | [diff] [blame] | 375 | term_setup = true; |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 376 | atexit(os_fd_restore); |
Rasmus Villemoes | 2b72ad2 | 2020-02-14 10:58:37 +0000 | [diff] [blame] | 377 | signal(SIGINT, os_sigint_handler); |
Mike Frysinger | a5baaee | 2011-10-26 00:21:29 +0000 | [diff] [blame] | 378 | } |
Matthias Weisser | b5f7b47 | 2011-11-05 11:40:34 +0100 | [diff] [blame] | 379 | |
Simon Glass | 4c902fa | 2021-02-06 09:57:32 -0700 | [diff] [blame] | 380 | /* |
| 381 | * Provide our own malloc so we don't use space in the sandbox ram_buf for |
| 382 | * allocations that are internal to sandbox, or need to be done before U-Boot's |
| 383 | * malloc() is ready. |
| 384 | */ |
Matthias Weisser | b5f7b47 | 2011-11-05 11:40:34 +0100 | [diff] [blame] | 385 | void *os_malloc(size_t length) |
| 386 | { |
Simon Glass | be005d8 | 2018-09-15 00:50:54 -0600 | [diff] [blame] | 387 | int page_size = getpagesize(); |
Simon Glass | fc2dde8 | 2019-04-08 13:20:42 -0600 | [diff] [blame] | 388 | struct os_mem_hdr *hdr; |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 389 | |
Simon Glass | 4c902fa | 2021-02-06 09:57:32 -0700 | [diff] [blame] | 390 | if (!length) |
| 391 | return NULL; |
Simon Glass | 57ba942 | 2018-06-17 08:57:43 -0600 | [diff] [blame] | 392 | /* |
| 393 | * Use an address that is hopefully available to us so that pointers |
| 394 | * to this memory are fairly obvious. If we end up with a different |
| 395 | * address, that's fine too. |
| 396 | */ |
| 397 | hdr = mmap((void *)0x10000000, length + page_size, |
Alexander Graf | 934a545 | 2018-06-22 14:44:13 +0200 | [diff] [blame] | 398 | PROT_READ | PROT_WRITE | PROT_EXEC, |
| 399 | MAP_PRIVATE | MAP_ANONYMOUS, -1, 0); |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 400 | if (hdr == MAP_FAILED) |
| 401 | return NULL; |
| 402 | hdr->length = length; |
| 403 | |
Simon Glass | be005d8 | 2018-09-15 00:50:54 -0600 | [diff] [blame] | 404 | return (void *)hdr + page_size; |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 405 | } |
| 406 | |
Masahiro Yamada | ee95728 | 2014-01-15 13:06:41 +0900 | [diff] [blame] | 407 | void os_free(void *ptr) |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 408 | { |
Simon Glass | fc2dde8 | 2019-04-08 13:20:42 -0600 | [diff] [blame] | 409 | int page_size = getpagesize(); |
| 410 | struct os_mem_hdr *hdr; |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 411 | |
Simon Glass | fc2dde8 | 2019-04-08 13:20:42 -0600 | [diff] [blame] | 412 | if (ptr) { |
| 413 | hdr = ptr - page_size; |
| 414 | munmap(hdr, hdr->length + page_size); |
| 415 | } |
Simon Glass | 4c902fa | 2021-02-06 09:57:32 -0700 | [diff] [blame] | 416 | } |
| 417 | |
| 418 | /* These macros are from kernel.h but not accessible in this file */ |
| 419 | #define ALIGN(x, a) __ALIGN_MASK((x), (typeof(x))(a) - 1) |
| 420 | #define __ALIGN_MASK(x, mask) (((x) + (mask)) & ~(mask)) |
| 421 | |
| 422 | /* |
| 423 | * Provide our own malloc so we don't use space in the sandbox ram_buf for |
| 424 | * allocations that are internal to sandbox, or need to be done before U-Boot's |
| 425 | * malloc() is ready. |
| 426 | */ |
| 427 | void *os_realloc(void *ptr, size_t length) |
| 428 | { |
| 429 | int page_size = getpagesize(); |
| 430 | struct os_mem_hdr *hdr; |
| 431 | void *new_ptr; |
| 432 | |
| 433 | /* Reallocating a NULL pointer is just an alloc */ |
| 434 | if (!ptr) |
| 435 | return os_malloc(length); |
| 436 | |
| 437 | /* Changing a length to 0 is just a free */ |
| 438 | if (length) { |
| 439 | os_free(ptr); |
| 440 | return NULL; |
| 441 | } |
| 442 | |
| 443 | /* |
| 444 | * If the new size is the same number of pages as the old, nothing to |
| 445 | * do. There isn't much point in shrinking things |
| 446 | */ |
| 447 | hdr = ptr - page_size; |
| 448 | if (ALIGN(length, page_size) <= ALIGN(hdr->length, page_size)) |
| 449 | return ptr; |
| 450 | |
| 451 | /* We have to grow it, so allocate something new */ |
| 452 | new_ptr = os_malloc(length); |
| 453 | memcpy(new_ptr, ptr, hdr->length); |
| 454 | os_free(ptr); |
| 455 | |
| 456 | return new_ptr; |
Simon Glass | 1e6594c | 2013-11-10 10:26:57 -0700 | [diff] [blame] | 457 | } |
| 458 | |
Matthias Weisser | 0d3dd14 | 2011-11-29 12:16:40 +0100 | [diff] [blame] | 459 | void os_usleep(unsigned long usec) |
| 460 | { |
| 461 | usleep(usec); |
| 462 | } |
| 463 | |
Simon Glass | fb4b4e8 | 2013-05-19 16:45:35 -0700 | [diff] [blame] | 464 | uint64_t __attribute__((no_instrument_function)) os_get_nsec(void) |
Matthias Weisser | 0d3dd14 | 2011-11-29 12:16:40 +0100 | [diff] [blame] | 465 | { |
| 466 | #if defined(CLOCK_MONOTONIC) && defined(_POSIX_MONOTONIC_CLOCK) |
| 467 | struct timespec tp; |
| 468 | if (EINVAL == clock_gettime(CLOCK_MONOTONIC, &tp)) { |
| 469 | struct timeval tv; |
| 470 | |
| 471 | gettimeofday(&tv, NULL); |
| 472 | tp.tv_sec = tv.tv_sec; |
| 473 | tp.tv_nsec = tv.tv_usec * 1000; |
| 474 | } |
| 475 | return tp.tv_sec * 1000000000ULL + tp.tv_nsec; |
| 476 | #else |
| 477 | struct timeval tv; |
| 478 | gettimeofday(&tv, NULL); |
| 479 | return tv.tv_sec * 1000000000ULL + tv.tv_usec * 1000; |
| 480 | #endif |
| 481 | } |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 482 | |
| 483 | static char *short_opts; |
| 484 | static struct option *long_opts; |
| 485 | |
| 486 | int os_parse_args(struct sandbox_state *state, int argc, char *argv[]) |
| 487 | { |
Marek Behún | 184c4af | 2021-05-20 13:24:06 +0200 | [diff] [blame] | 488 | struct sandbox_cmdline_option **sb_opt = |
| 489 | __u_boot_sandbox_option_start(); |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 490 | size_t num_options = __u_boot_sandbox_option_count(); |
| 491 | size_t i; |
| 492 | |
| 493 | int hidden_short_opt; |
| 494 | size_t si; |
| 495 | |
| 496 | int c; |
| 497 | |
| 498 | if (short_opts || long_opts) |
| 499 | return 1; |
| 500 | |
| 501 | state->argc = argc; |
| 502 | state->argv = argv; |
| 503 | |
| 504 | /* dynamically construct the arguments to the system getopt_long */ |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 505 | short_opts = os_malloc(sizeof(*short_opts) * num_options * 2 + 1); |
| 506 | long_opts = os_malloc(sizeof(*long_opts) * (num_options + 1)); |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 507 | if (!short_opts || !long_opts) |
| 508 | return 1; |
| 509 | |
| 510 | /* |
| 511 | * getopt_long requires "val" to be unique (since that is what the |
| 512 | * func returns), so generate unique values automatically for flags |
| 513 | * that don't have a short option. pick 0x100 as that is above the |
| 514 | * single byte range (where ASCII/ISO-XXXX-X charsets live). |
| 515 | */ |
| 516 | hidden_short_opt = 0x100; |
| 517 | si = 0; |
| 518 | for (i = 0; i < num_options; ++i) { |
| 519 | long_opts[i].name = sb_opt[i]->flag; |
| 520 | long_opts[i].has_arg = sb_opt[i]->has_arg ? |
| 521 | required_argument : no_argument; |
| 522 | long_opts[i].flag = NULL; |
| 523 | |
| 524 | if (sb_opt[i]->flag_short) { |
| 525 | short_opts[si++] = long_opts[i].val = sb_opt[i]->flag_short; |
| 526 | if (long_opts[i].has_arg == required_argument) |
| 527 | short_opts[si++] = ':'; |
| 528 | } else |
| 529 | long_opts[i].val = sb_opt[i]->flag_short = hidden_short_opt++; |
| 530 | } |
| 531 | short_opts[si] = '\0'; |
| 532 | |
| 533 | /* we need to handle output ourselves since u-boot provides printf */ |
| 534 | opterr = 0; |
| 535 | |
Simon Glass | 0a4eabb | 2020-02-03 07:36:04 -0700 | [diff] [blame] | 536 | memset(&long_opts[num_options], '\0', sizeof(*long_opts)); |
Simon Glass | 8a3e035 | 2012-02-15 15:51:16 -0800 | [diff] [blame] | 537 | /* |
| 538 | * walk all of the options the user gave us on the command line, |
| 539 | * figure out what u-boot option structure they belong to (via |
| 540 | * the unique short val key), and call the appropriate callback. |
| 541 | */ |
| 542 | while ((c = getopt_long(argc, argv, short_opts, long_opts, NULL)) != -1) { |
| 543 | for (i = 0; i < num_options; ++i) { |
| 544 | if (sb_opt[i]->flag_short == c) { |
| 545 | if (sb_opt[i]->callback(state, optarg)) { |
| 546 | state->parse_err = sb_opt[i]->flag; |
| 547 | return 0; |
| 548 | } |
| 549 | break; |
| 550 | } |
| 551 | } |
| 552 | if (i == num_options) { |
| 553 | /* |
| 554 | * store the faulting flag for later display. we have to |
| 555 | * store the flag itself as the getopt parsing itself is |
| 556 | * tricky: need to handle the following flags (assume all |
| 557 | * of the below are unknown): |
| 558 | * -a optopt='a' optind=<next> |
| 559 | * -abbbb optopt='a' optind=<this> |
| 560 | * -aaaaa optopt='a' optind=<this> |
| 561 | * --a optopt=0 optind=<this> |
| 562 | * as you can see, it is impossible to determine the exact |
| 563 | * faulting flag without doing the parsing ourselves, so |
| 564 | * we just report the specific flag that failed. |
| 565 | */ |
| 566 | if (optopt) { |
| 567 | static char parse_err[3] = { '-', 0, '\0', }; |
| 568 | parse_err[1] = optopt; |
| 569 | state->parse_err = parse_err; |
| 570 | } else |
| 571 | state->parse_err = argv[optind - 1]; |
| 572 | break; |
| 573 | } |
| 574 | } |
| 575 | |
| 576 | return 0; |
| 577 | } |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 578 | |
| 579 | void os_dirent_free(struct os_dirent_node *node) |
| 580 | { |
| 581 | struct os_dirent_node *next; |
| 582 | |
| 583 | while (node) { |
| 584 | next = node->next; |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 585 | os_free(node); |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 586 | node = next; |
| 587 | } |
| 588 | } |
| 589 | |
| 590 | int os_dirent_ls(const char *dirname, struct os_dirent_node **headp) |
| 591 | { |
Stefan Brüns | ae71ede | 2016-10-01 20:41:42 +0200 | [diff] [blame] | 592 | struct dirent *entry; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 593 | struct os_dirent_node *head, *node, *next; |
| 594 | struct stat buf; |
| 595 | DIR *dir; |
| 596 | int ret; |
| 597 | char *fname; |
Heinrich Schuchardt | f53b5ea | 2017-09-21 12:56:07 +0200 | [diff] [blame] | 598 | char *old_fname; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 599 | int len; |
Stefan Brüns | b212990 | 2016-10-01 20:41:40 +0200 | [diff] [blame] | 600 | int dirlen; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 601 | |
| 602 | *headp = NULL; |
| 603 | dir = opendir(dirname); |
| 604 | if (!dir) |
| 605 | return -1; |
| 606 | |
Stefan Brüns | b212990 | 2016-10-01 20:41:40 +0200 | [diff] [blame] | 607 | /* Create a buffer upfront, with typically sufficient size */ |
| 608 | dirlen = strlen(dirname) + 2; |
| 609 | len = dirlen + 256; |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 610 | fname = os_malloc(len); |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 611 | if (!fname) { |
| 612 | ret = -ENOMEM; |
| 613 | goto done; |
| 614 | } |
| 615 | |
| 616 | for (node = head = NULL;; node = next) { |
Stefan Brüns | ae71ede | 2016-10-01 20:41:42 +0200 | [diff] [blame] | 617 | errno = 0; |
| 618 | entry = readdir(dir); |
| 619 | if (!entry) { |
| 620 | ret = errno; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 621 | break; |
Stefan Brüns | ae71ede | 2016-10-01 20:41:42 +0200 | [diff] [blame] | 622 | } |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 623 | next = os_malloc(sizeof(*node) + strlen(entry->d_name) + 1); |
Heinrich Schuchardt | f53b5ea | 2017-09-21 12:56:07 +0200 | [diff] [blame] | 624 | if (!next) { |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 625 | os_dirent_free(head); |
| 626 | ret = -ENOMEM; |
| 627 | goto done; |
| 628 | } |
Heinrich Schuchardt | f53b5ea | 2017-09-21 12:56:07 +0200 | [diff] [blame] | 629 | if (dirlen + strlen(entry->d_name) > len) { |
| 630 | len = dirlen + strlen(entry->d_name); |
| 631 | old_fname = fname; |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 632 | fname = os_realloc(fname, len); |
Heinrich Schuchardt | f53b5ea | 2017-09-21 12:56:07 +0200 | [diff] [blame] | 633 | if (!fname) { |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 634 | os_free(old_fname); |
| 635 | os_free(next); |
Heinrich Schuchardt | f53b5ea | 2017-09-21 12:56:07 +0200 | [diff] [blame] | 636 | os_dirent_free(head); |
| 637 | ret = -ENOMEM; |
| 638 | goto done; |
| 639 | } |
| 640 | } |
Stephen Warren | 9671c67 | 2014-06-11 10:26:23 -0600 | [diff] [blame] | 641 | next->next = NULL; |
Stefan Brüns | ae71ede | 2016-10-01 20:41:42 +0200 | [diff] [blame] | 642 | strcpy(next->name, entry->d_name); |
| 643 | switch (entry->d_type) { |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 644 | case DT_REG: |
| 645 | next->type = OS_FILET_REG; |
| 646 | break; |
| 647 | case DT_DIR: |
| 648 | next->type = OS_FILET_DIR; |
| 649 | break; |
| 650 | case DT_LNK: |
| 651 | next->type = OS_FILET_LNK; |
| 652 | break; |
Stefan Brüns | b7ffa82 | 2016-10-04 21:46:35 +0200 | [diff] [blame] | 653 | default: |
| 654 | next->type = OS_FILET_UNKNOWN; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 655 | } |
| 656 | next->size = 0; |
| 657 | snprintf(fname, len, "%s/%s", dirname, next->name); |
| 658 | if (!stat(fname, &buf)) |
| 659 | next->size = buf.st_size; |
| 660 | if (node) |
| 661 | node->next = next; |
Stefan Brüns | d4cb888 | 2016-10-01 20:41:39 +0200 | [diff] [blame] | 662 | else |
| 663 | head = next; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 664 | } |
| 665 | *headp = head; |
| 666 | |
| 667 | done: |
| 668 | closedir(dir); |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 669 | os_free(fname); |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 670 | return ret; |
| 671 | } |
| 672 | |
| 673 | const char *os_dirent_typename[OS_FILET_COUNT] = { |
| 674 | " ", |
| 675 | "SYM", |
| 676 | "DIR", |
| 677 | "???", |
| 678 | }; |
| 679 | |
| 680 | const char *os_dirent_get_typename(enum os_dirent_t type) |
| 681 | { |
Tom Rini | b6f605e | 2017-05-13 20:11:30 -0400 | [diff] [blame] | 682 | if (type >= OS_FILET_REG && type < OS_FILET_COUNT) |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 683 | return os_dirent_typename[type]; |
| 684 | |
| 685 | return os_dirent_typename[OS_FILET_UNKNOWN]; |
| 686 | } |
| 687 | |
Heinrich Schuchardt | 011a1e0 | 2022-01-11 01:50:24 +0100 | [diff] [blame] | 688 | /* |
| 689 | * For compatibility reasons avoid loff_t here. |
| 690 | * U-Boot defines loff_t as long long. |
| 691 | * But /usr/include/linux/types.h may not define it at all. |
| 692 | * Alpine Linux being one example. |
| 693 | */ |
| 694 | int os_get_filesize(const char *fname, long long *size) |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 695 | { |
| 696 | struct stat buf; |
| 697 | int ret; |
| 698 | |
| 699 | ret = stat(fname, &buf); |
| 700 | if (ret) |
| 701 | return ret; |
Suriyan Ramasami | 378da103 | 2014-11-17 14:39:37 -0800 | [diff] [blame] | 702 | *size = buf.st_size; |
| 703 | return 0; |
Simon Glass | f1c45c8 | 2012-12-26 09:53:34 +0000 | [diff] [blame] | 704 | } |
Simon Glass | 3e9fd24 | 2013-11-10 10:27:01 -0700 | [diff] [blame] | 705 | |
Simon Glass | 29d1143 | 2017-12-04 13:48:17 -0700 | [diff] [blame] | 706 | void os_putc(int ch) |
| 707 | { |
Simon Glass | d56c6f4 | 2022-03-27 14:26:14 -0600 | [diff] [blame] | 708 | os_write(1, &ch, 1); |
Simon Glass | 29d1143 | 2017-12-04 13:48:17 -0700 | [diff] [blame] | 709 | } |
| 710 | |
| 711 | void os_puts(const char *str) |
| 712 | { |
| 713 | while (*str) |
| 714 | os_putc(*str++); |
| 715 | } |
| 716 | |
Pali Rohár | 4acd1a0 | 2022-09-05 11:31:16 +0200 | [diff] [blame] | 717 | void os_flush(void) |
| 718 | { |
| 719 | fflush(stdout); |
| 720 | } |
| 721 | |
Simon Glass | 9dd10bf | 2013-11-10 10:27:03 -0700 | [diff] [blame] | 722 | int os_write_ram_buf(const char *fname) |
| 723 | { |
| 724 | struct sandbox_state *state = state_get_current(); |
| 725 | int fd, ret; |
| 726 | |
| 727 | fd = open(fname, O_CREAT | O_WRONLY, 0777); |
| 728 | if (fd < 0) |
| 729 | return -ENOENT; |
| 730 | ret = write(fd, state->ram_buf, state->ram_size); |
| 731 | close(fd); |
| 732 | if (ret != state->ram_size) |
| 733 | return -EIO; |
| 734 | |
| 735 | return 0; |
| 736 | } |
| 737 | |
| 738 | int os_read_ram_buf(const char *fname) |
| 739 | { |
| 740 | struct sandbox_state *state = state_get_current(); |
| 741 | int fd, ret; |
Heinrich Schuchardt | 011a1e0 | 2022-01-11 01:50:24 +0100 | [diff] [blame] | 742 | long long size; |
Simon Glass | 9dd10bf | 2013-11-10 10:27:03 -0700 | [diff] [blame] | 743 | |
Suriyan Ramasami | 378da103 | 2014-11-17 14:39:37 -0800 | [diff] [blame] | 744 | ret = os_get_filesize(fname, &size); |
| 745 | if (ret < 0) |
| 746 | return ret; |
Simon Glass | 9dd10bf | 2013-11-10 10:27:03 -0700 | [diff] [blame] | 747 | if (size != state->ram_size) |
| 748 | return -ENOSPC; |
| 749 | fd = open(fname, O_RDONLY); |
| 750 | if (fd < 0) |
| 751 | return -ENOENT; |
| 752 | |
| 753 | ret = read(fd, state->ram_buf, state->ram_size); |
| 754 | close(fd); |
| 755 | if (ret != state->ram_size) |
| 756 | return -EIO; |
| 757 | |
| 758 | return 0; |
| 759 | } |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 760 | |
| 761 | static int make_exec(char *fname, const void *data, int size) |
| 762 | { |
| 763 | int fd; |
| 764 | |
| 765 | strcpy(fname, "/tmp/u-boot.jump.XXXXXX"); |
| 766 | fd = mkstemp(fname); |
| 767 | if (fd < 0) |
| 768 | return -ENOENT; |
| 769 | if (write(fd, data, size) < 0) |
| 770 | return -EIO; |
| 771 | close(fd); |
| 772 | if (chmod(fname, 0777)) |
| 773 | return -ENOEXEC; |
| 774 | |
| 775 | return 0; |
| 776 | } |
| 777 | |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 778 | /** |
| 779 | * add_args() - Allocate a new argv with the given args |
| 780 | * |
| 781 | * This is used to create a new argv array with all the old arguments and some |
| 782 | * new ones that are passed in |
| 783 | * |
| 784 | * @argvp: Returns newly allocated args list |
| 785 | * @add_args: Arguments to add, each a string |
| 786 | * @count: Number of arguments in @add_args |
Heinrich Schuchardt | 47b4c02 | 2022-01-19 18:05:50 +0100 | [diff] [blame] | 787 | * Return: 0 if OK, -ENOMEM if out of memory |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 788 | */ |
| 789 | static int add_args(char ***argvp, char *add_args[], int count) |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 790 | { |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 791 | char **argv, **ap; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 792 | int argc; |
| 793 | |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 794 | for (argc = 0; (*argvp)[argc]; argc++) |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 795 | ; |
| 796 | |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 797 | argv = os_malloc((argc + count + 1) * sizeof(char *)); |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 798 | if (!argv) { |
| 799 | printf("Out of memory for %d argv\n", count); |
| 800 | return -ENOMEM; |
| 801 | } |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 802 | for (ap = *argvp, argc = 0; *ap; ap++) { |
| 803 | char *arg = *ap; |
| 804 | |
| 805 | /* Drop args that we don't want to propagate */ |
| 806 | if (*arg == '-' && strlen(arg) == 2) { |
| 807 | switch (arg[1]) { |
| 808 | case 'j': |
| 809 | case 'm': |
| 810 | ap++; |
| 811 | continue; |
| 812 | } |
| 813 | } else if (!strcmp(arg, "--rm_memory")) { |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 814 | continue; |
| 815 | } |
| 816 | argv[argc++] = arg; |
| 817 | } |
| 818 | |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 819 | memcpy(argv + argc, add_args, count * sizeof(char *)); |
| 820 | argv[argc + count] = NULL; |
| 821 | |
| 822 | *argvp = argv; |
| 823 | return 0; |
| 824 | } |
| 825 | |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 826 | /** |
| 827 | * os_jump_to_file() - Jump to a new program |
| 828 | * |
| 829 | * This saves the memory buffer, sets up arguments to the new process, then |
| 830 | * execs it. |
| 831 | * |
| 832 | * @fname: Filename to exec |
Heinrich Schuchardt | 47b4c02 | 2022-01-19 18:05:50 +0100 | [diff] [blame] | 833 | * Return: does not return on success, any return value is an error |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 834 | */ |
Simon Glass | dafc5d7 | 2021-03-15 18:11:07 +1300 | [diff] [blame] | 835 | static int os_jump_to_file(const char *fname, bool delete_it) |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 836 | { |
| 837 | struct sandbox_state *state = state_get_current(); |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 838 | char mem_fname[30]; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 839 | int fd, err; |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 840 | char *extra_args[5]; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 841 | char **argv = state->argv; |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 842 | int argc; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 843 | #ifdef DEBUG |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 844 | int i; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 845 | #endif |
| 846 | |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 847 | strcpy(mem_fname, "/tmp/u-boot.mem.XXXXXX"); |
| 848 | fd = mkstemp(mem_fname); |
| 849 | if (fd < 0) |
| 850 | return -ENOENT; |
| 851 | close(fd); |
| 852 | err = os_write_ram_buf(mem_fname); |
| 853 | if (err) |
| 854 | return err; |
| 855 | |
| 856 | os_fd_restore(); |
| 857 | |
Simon Glass | dafc5d7 | 2021-03-15 18:11:07 +1300 | [diff] [blame] | 858 | argc = 0; |
| 859 | if (delete_it) { |
| 860 | extra_args[argc++] = "-j"; |
| 861 | extra_args[argc++] = (char *)fname; |
| 862 | } |
| 863 | extra_args[argc++] = "-m"; |
| 864 | extra_args[argc++] = mem_fname; |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 865 | if (state->ram_buf_rm) |
| 866 | extra_args[argc++] = "--rm_memory"; |
| 867 | err = add_args(&argv, extra_args, argc); |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 868 | if (err) |
| 869 | return err; |
Simon Glass | 7465f00 | 2018-11-15 18:44:07 -0700 | [diff] [blame] | 870 | argv[0] = (char *)fname; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 871 | |
| 872 | #ifdef DEBUG |
| 873 | for (i = 0; argv[i]; i++) |
| 874 | printf("%d %s\n", i, argv[i]); |
| 875 | #endif |
| 876 | |
| 877 | if (state_uninit()) |
| 878 | os_exit(2); |
| 879 | |
| 880 | err = execv(fname, argv); |
Simon Glass | edd094e | 2021-02-06 09:57:33 -0700 | [diff] [blame] | 881 | os_free(argv); |
Simon Glass | cca2552 | 2018-11-15 18:44:08 -0700 | [diff] [blame] | 882 | if (err) { |
| 883 | perror("Unable to run image"); |
Simon Glass | 23eabbb | 2018-11-23 21:29:24 -0700 | [diff] [blame] | 884 | printf("Image filename '%s'\n", fname); |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 885 | return err; |
Simon Glass | cca2552 | 2018-11-15 18:44:08 -0700 | [diff] [blame] | 886 | } |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 887 | |
Simon Glass | dafc5d7 | 2021-03-15 18:11:07 +1300 | [diff] [blame] | 888 | if (delete_it) |
| 889 | return unlink(fname); |
| 890 | |
| 891 | return -EFAULT; |
Simon Glass | 860b7d9 | 2014-02-27 13:26:15 -0700 | [diff] [blame] | 892 | } |
Simon Glass | 504548f | 2015-04-20 12:37:22 -0600 | [diff] [blame] | 893 | |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 894 | int os_jump_to_image(const void *dest, int size) |
| 895 | { |
| 896 | char fname[30]; |
| 897 | int err; |
| 898 | |
| 899 | err = make_exec(fname, dest, size); |
| 900 | if (err) |
| 901 | return err; |
| 902 | |
Simon Glass | dafc5d7 | 2021-03-15 18:11:07 +1300 | [diff] [blame] | 903 | return os_jump_to_file(fname, true); |
Simon Glass | 7dafd02 | 2018-11-15 18:44:05 -0700 | [diff] [blame] | 904 | } |
| 905 | |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 906 | int os_find_u_boot(char *fname, int maxlen, bool use_img, |
| 907 | const char *cur_prefix, const char *next_prefix) |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 908 | { |
| 909 | struct sandbox_state *state = state_get_current(); |
| 910 | const char *progname = state->argv[0]; |
| 911 | int len = strlen(progname); |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 912 | char subdir[10]; |
| 913 | char *suffix; |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 914 | char *p; |
| 915 | int fd; |
| 916 | |
| 917 | if (len >= maxlen || len < 4) |
| 918 | return -ENOSPC; |
| 919 | |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 920 | strcpy(fname, progname); |
Simon Glass | dc4d8eb | 2018-10-01 11:55:10 -0600 | [diff] [blame] | 921 | suffix = fname + len - 4; |
| 922 | |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 923 | /* Change the existing suffix to the new one */ |
| 924 | if (*suffix != '-') |
| 925 | return -EINVAL; |
Simon Glass | dc4d8eb | 2018-10-01 11:55:10 -0600 | [diff] [blame] | 926 | |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 927 | if (*next_prefix) |
| 928 | strcpy(suffix + 1, next_prefix); /* e.g. "-tpl" to "-spl" */ |
| 929 | else |
| 930 | *suffix = '\0'; /* e.g. "-spl" to "" */ |
| 931 | fd = os_open(fname, O_RDONLY); |
| 932 | if (fd >= 0) { |
| 933 | close(fd); |
| 934 | return 0; |
Simon Glass | dc4d8eb | 2018-10-01 11:55:10 -0600 | [diff] [blame] | 935 | } |
| 936 | |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 937 | /* |
| 938 | * We didn't find it, so try looking for 'u-boot-xxx' in the xxx/ |
| 939 | * directory. Replace the old dirname with the new one. |
| 940 | */ |
| 941 | snprintf(subdir, sizeof(subdir), "/%s/", cur_prefix); |
| 942 | p = strstr(fname, subdir); |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 943 | if (p) { |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 944 | if (*next_prefix) |
| 945 | /* e.g. ".../tpl/u-boot-spl" to "../spl/u-boot-spl" */ |
| 946 | memcpy(p + 1, next_prefix, strlen(next_prefix)); |
| 947 | else |
| 948 | /* e.g. ".../spl/u-boot" to ".../u-boot" */ |
| 949 | strcpy(p, p + 1 + strlen(cur_prefix)); |
Simon Glass | b90e487 | 2021-03-07 17:35:13 -0700 | [diff] [blame] | 950 | if (use_img) |
| 951 | strcat(p, ".img"); |
Simon Glass | 1cd0600 | 2021-07-05 16:32:45 -0600 | [diff] [blame] | 952 | |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 953 | fd = os_open(fname, O_RDONLY); |
| 954 | if (fd >= 0) { |
| 955 | close(fd); |
| 956 | return 0; |
| 957 | } |
| 958 | } |
| 959 | |
| 960 | return -ENOENT; |
| 961 | } |
| 962 | |
| 963 | int os_spl_to_uboot(const char *fname) |
| 964 | { |
Patrick Delaunay | 6daf905 | 2020-11-20 09:48:33 +0100 | [diff] [blame] | 965 | struct sandbox_state *state = state_get_current(); |
| 966 | |
Patrick Delaunay | 6daf905 | 2020-11-20 09:48:33 +0100 | [diff] [blame] | 967 | /* U-Boot will delete ram buffer after read: "--rm_memory"*/ |
| 968 | state->ram_buf_rm = true; |
Simon Glass | dafc5d7 | 2021-03-15 18:11:07 +1300 | [diff] [blame] | 969 | |
| 970 | return os_jump_to_file(fname, false); |
Simon Glass | 2c931ba | 2016-07-04 11:57:45 -0600 | [diff] [blame] | 971 | } |
| 972 | |
Heinrich Schuchardt | c0d1a00 | 2020-12-30 18:07:48 +0100 | [diff] [blame] | 973 | long os_get_time_offset(void) |
| 974 | { |
| 975 | const char *offset; |
| 976 | |
| 977 | offset = getenv(ENV_TIME_OFFSET); |
| 978 | if (offset) |
| 979 | return strtol(offset, NULL, 0); |
| 980 | return 0; |
| 981 | } |
| 982 | |
| 983 | void os_set_time_offset(long offset) |
| 984 | { |
| 985 | char buf[21]; |
| 986 | int ret; |
| 987 | |
| 988 | snprintf(buf, sizeof(buf), "%ld", offset); |
| 989 | ret = setenv(ENV_TIME_OFFSET, buf, true); |
| 990 | if (ret) |
| 991 | printf("Could not set environment variable %s\n", |
| 992 | ENV_TIME_OFFSET); |
| 993 | } |
| 994 | |
Simon Glass | 504548f | 2015-04-20 12:37:22 -0600 | [diff] [blame] | 995 | void os_localtime(struct rtc_time *rt) |
| 996 | { |
| 997 | time_t t = time(NULL); |
| 998 | struct tm *tm; |
| 999 | |
| 1000 | tm = localtime(&t); |
| 1001 | rt->tm_sec = tm->tm_sec; |
| 1002 | rt->tm_min = tm->tm_min; |
| 1003 | rt->tm_hour = tm->tm_hour; |
| 1004 | rt->tm_mday = tm->tm_mday; |
| 1005 | rt->tm_mon = tm->tm_mon + 1; |
| 1006 | rt->tm_year = tm->tm_year + 1900; |
| 1007 | rt->tm_wday = tm->tm_wday; |
| 1008 | rt->tm_yday = tm->tm_yday; |
| 1009 | rt->tm_isdst = tm->tm_isdst; |
| 1010 | } |
Simon Glass | 5dccd15 | 2018-05-16 09:42:22 -0600 | [diff] [blame] | 1011 | |
Simon Glass | b7255ef | 2018-09-15 00:50:55 -0600 | [diff] [blame] | 1012 | void os_abort(void) |
| 1013 | { |
| 1014 | abort(); |
| 1015 | } |
Simon Glass | 4e766c2 | 2018-10-01 21:12:32 -0600 | [diff] [blame] | 1016 | |
| 1017 | int os_mprotect_allow(void *start, size_t len) |
| 1018 | { |
| 1019 | int page_size = getpagesize(); |
| 1020 | |
| 1021 | /* Move start to the start of a page, len to the end */ |
| 1022 | start = (void *)(((ulong)start) & ~(page_size - 1)); |
| 1023 | len = (len + page_size * 2) & ~(page_size - 1); |
| 1024 | |
| 1025 | return mprotect(start, len, PROT_READ | PROT_WRITE); |
| 1026 | } |
Simon Glass | 752707a | 2019-04-08 13:20:41 -0600 | [diff] [blame] | 1027 | |
| 1028 | void *os_find_text_base(void) |
| 1029 | { |
| 1030 | char line[500]; |
| 1031 | void *base = NULL; |
| 1032 | int len; |
| 1033 | int fd; |
| 1034 | |
| 1035 | /* |
| 1036 | * This code assumes that the first line of /proc/self/maps holds |
| 1037 | * information about the text, for example: |
| 1038 | * |
| 1039 | * 5622d9907000-5622d9a55000 r-xp 00000000 08:01 15067168 u-boot |
| 1040 | * |
| 1041 | * The first hex value is assumed to be the address. |
| 1042 | * |
| 1043 | * This is tested in Linux 4.15. |
| 1044 | */ |
| 1045 | fd = open("/proc/self/maps", O_RDONLY); |
| 1046 | if (fd == -1) |
| 1047 | return NULL; |
| 1048 | len = read(fd, line, sizeof(line)); |
| 1049 | if (len > 0) { |
| 1050 | char *end = memchr(line, '-', len); |
| 1051 | |
| 1052 | if (end) { |
Heinrich Schuchardt | 05a1684 | 2019-10-26 23:17:44 +0200 | [diff] [blame] | 1053 | uintptr_t addr; |
Simon Glass | 752707a | 2019-04-08 13:20:41 -0600 | [diff] [blame] | 1054 | |
| 1055 | *end = '\0'; |
Heinrich Schuchardt | 05a1684 | 2019-10-26 23:17:44 +0200 | [diff] [blame] | 1056 | if (sscanf(line, "%zx", &addr) == 1) |
Simon Glass | 752707a | 2019-04-08 13:20:41 -0600 | [diff] [blame] | 1057 | base = (void *)addr; |
| 1058 | } |
| 1059 | } |
| 1060 | close(fd); |
| 1061 | |
| 1062 | return base; |
| 1063 | } |
Heinrich Schuchardt | 1c67844 | 2020-10-27 20:29:25 +0100 | [diff] [blame] | 1064 | |
Heinrich Schuchardt | 79cb241 | 2022-09-02 02:32:25 +0200 | [diff] [blame] | 1065 | /** |
| 1066 | * os_unblock_signals() - unblock all signals |
| 1067 | * |
| 1068 | * If we are relaunching the sandbox in a signal handler, we have to unblock |
| 1069 | * the respective signal before calling execv(). See signal(7) man-page. |
| 1070 | */ |
| 1071 | static void os_unblock_signals(void) |
| 1072 | { |
| 1073 | sigset_t sigs; |
| 1074 | |
| 1075 | sigfillset(&sigs); |
| 1076 | sigprocmask(SIG_UNBLOCK, &sigs, NULL); |
| 1077 | } |
| 1078 | |
Heinrich Schuchardt | 1c67844 | 2020-10-27 20:29:25 +0100 | [diff] [blame] | 1079 | void os_relaunch(char *argv[]) |
| 1080 | { |
Heinrich Schuchardt | 79cb241 | 2022-09-02 02:32:25 +0200 | [diff] [blame] | 1081 | os_unblock_signals(); |
| 1082 | |
Heinrich Schuchardt | 1c67844 | 2020-10-27 20:29:25 +0100 | [diff] [blame] | 1083 | execv(argv[0], argv); |
| 1084 | os_exit(1); |
| 1085 | } |
Andrew Scull | ca5d137 | 2022-05-30 10:00:10 +0000 | [diff] [blame] | 1086 | |
Andrew Scull | 2b40f80 | 2022-05-30 10:00:11 +0000 | [diff] [blame] | 1087 | |
| 1088 | #ifdef CONFIG_FUZZ |
| 1089 | static void *fuzzer_thread(void * ptr) |
| 1090 | { |
| 1091 | char cmd[64]; |
| 1092 | char *argv[5] = {"./u-boot", "-T", "-c", cmd, NULL}; |
| 1093 | const char *fuzz_test; |
| 1094 | |
| 1095 | /* Find which test to run from an environment variable. */ |
| 1096 | fuzz_test = getenv("UBOOT_SB_FUZZ_TEST"); |
| 1097 | if (!fuzz_test) |
| 1098 | os_abort(); |
| 1099 | |
| 1100 | snprintf(cmd, sizeof(cmd), "fuzz %s", fuzz_test); |
| 1101 | |
| 1102 | sandbox_main(4, argv); |
| 1103 | os_abort(); |
| 1104 | return NULL; |
| 1105 | } |
| 1106 | |
| 1107 | static bool fuzzer_initialized = false; |
| 1108 | static pthread_mutex_t fuzzer_mutex = PTHREAD_MUTEX_INITIALIZER; |
| 1109 | static pthread_cond_t fuzzer_cond = PTHREAD_COND_INITIALIZER; |
| 1110 | static const uint8_t *fuzzer_data; |
| 1111 | static size_t fuzzer_size; |
| 1112 | |
| 1113 | int sandbox_fuzzing_engine_get_input(const uint8_t **data, size_t *size) |
| 1114 | { |
| 1115 | if (!fuzzer_initialized) |
| 1116 | return -ENOSYS; |
| 1117 | |
| 1118 | /* Tell the main thread we need new inputs then wait for them. */ |
| 1119 | pthread_mutex_lock(&fuzzer_mutex); |
| 1120 | pthread_cond_signal(&fuzzer_cond); |
| 1121 | pthread_cond_wait(&fuzzer_cond, &fuzzer_mutex); |
| 1122 | *data = fuzzer_data; |
| 1123 | *size = fuzzer_size; |
| 1124 | pthread_mutex_unlock(&fuzzer_mutex); |
| 1125 | return 0; |
| 1126 | } |
| 1127 | |
| 1128 | int LLVMFuzzerTestOneInput(const uint8_t *data, size_t size) |
| 1129 | { |
| 1130 | static pthread_t tid; |
| 1131 | |
| 1132 | pthread_mutex_lock(&fuzzer_mutex); |
| 1133 | |
| 1134 | /* Initialize the sandbox on another thread. */ |
| 1135 | if (!fuzzer_initialized) { |
| 1136 | fuzzer_initialized = true; |
| 1137 | if (pthread_create(&tid, NULL, fuzzer_thread, NULL)) |
| 1138 | os_abort(); |
| 1139 | pthread_cond_wait(&fuzzer_cond, &fuzzer_mutex); |
| 1140 | } |
| 1141 | |
| 1142 | /* Hand over the input. */ |
| 1143 | fuzzer_data = data; |
| 1144 | fuzzer_size = size; |
| 1145 | pthread_cond_signal(&fuzzer_cond); |
| 1146 | |
| 1147 | /* Wait for the inputs to be finished with. */ |
| 1148 | pthread_cond_wait(&fuzzer_cond, &fuzzer_mutex); |
| 1149 | pthread_mutex_unlock(&fuzzer_mutex); |
| 1150 | |
| 1151 | return 0; |
| 1152 | } |
| 1153 | #else |
Andrew Scull | ca5d137 | 2022-05-30 10:00:10 +0000 | [diff] [blame] | 1154 | int main(int argc, char *argv[]) |
| 1155 | { |
| 1156 | return sandbox_main(argc, argv); |
| 1157 | } |
Andrew Scull | 2b40f80 | 2022-05-30 10:00:11 +0000 | [diff] [blame] | 1158 | #endif |