Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 | // SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2022 Sean Anderson <sean.anderson@seco.com> * Copyright 2014 Broadcom Corporation */ #include <log.h> #include <semihosting.h> #include <linux/errno.h> #include <linux/string.h> #define SYSOPEN 0x01 #define SYSCLOSE 0x02 #define SYSWRITEC 0x03 #define SYSWRITE0 0x04 #define SYSWRITE 0x05 #define SYSREAD 0x06 #define SYSREADC 0x07 #define SYSISERROR 0x08 #define SYSSEEK 0x0A #define SYSFLEN 0x0C #define SYSERRNO 0x13 #if CONFIG_IS_ENABLED(SEMIHOSTING_FALLBACK) static bool _semihosting_enabled = true; static bool try_semihosting = true; bool semihosting_enabled(void) { if (try_semihosting) { smh_trap(SYSERRNO, NULL); try_semihosting = false; } return _semihosting_enabled; } void disable_semihosting(void) { _semihosting_enabled = false; } #endif /** * smh_errno() - Read the host's errno * * This gets the value of the host's errno and negates it. The host's errno may * or may not be set, so only call this function if a previous semihosting call * has failed. * * Return: a negative error value */ static int smh_errno(void) { long ret = smh_trap(SYSERRNO, NULL); if (ret > 0 && ret < INT_MAX) return -ret; return -EIO; } long smh_open(const char *fname, enum smh_open_mode mode) { long fd; struct smh_open_s { const char *fname; unsigned long mode; size_t len; } open; debug("%s: file \'%s\', mode \'%u\'\n", __func__, fname, mode); open.fname = fname; open.len = strlen(fname); open.mode = mode; /* Open the file on the host */ fd = smh_trap(SYSOPEN, &open); if (fd == -1) return smh_errno(); return fd; } /** * struct smg_rdwr_s - Arguments for read and write * @fd: A file descriptor returned from smh_open() * @memp: Pointer to a buffer of memory of at least @len bytes * @len: The number of bytes to read or write */ struct smh_rdwr_s { long fd; void *memp; size_t len; }; long smh_read(long fd, void *memp, size_t len) { long ret; struct smh_rdwr_s read; debug("%s: fd %ld, memp %p, len %zu\n", __func__, fd, memp, len); read.fd = fd; read.memp = memp; read.len = len; ret = smh_trap(SYSREAD, &read); if (ret < 0) return smh_errno(); return len - ret; } long smh_write(long fd, const void *memp, size_t len, ulong *written) { long ret; struct smh_rdwr_s write; debug("%s: fd %ld, memp %p, len %zu\n", __func__, fd, memp, len); write.fd = fd; write.memp = (void *)memp; write.len = len; ret = smh_trap(SYSWRITE, &write); *written = len - ret; if (ret) return smh_errno(); return 0; } long smh_close(long fd) { long ret; debug("%s: fd %ld\n", __func__, fd); ret = smh_trap(SYSCLOSE, &fd); if (ret == -1) return smh_errno(); return 0; } long smh_flen(long fd) { long ret; debug("%s: fd %ld\n", __func__, fd); ret = smh_trap(SYSFLEN, &fd); if (ret == -1) return smh_errno(); return ret; } long smh_seek(long fd, long pos) { long ret; struct smh_seek_s { long fd; long pos; } seek; debug("%s: fd %ld pos %ld\n", __func__, fd, pos); seek.fd = fd; seek.pos = pos; ret = smh_trap(SYSSEEK, &seek); if (ret) return smh_errno(); return 0; } int smh_getc(void) { return smh_trap(SYSREADC, NULL); } void smh_putc(char ch) { smh_trap(SYSWRITEC, &ch); } void smh_puts(const char *s) { smh_trap(SYSWRITE0, (char *)s); } |