1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <errno.h>
23#include <fcntl.h>
24#include <getopt.h>
25#include <stdlib.h>
26#include <termios.h>
27#include <time.h>
28#include <unistd.h>
29#include <sys/mman.h>
30#include <sys/stat.h>
31#include <sys/time.h>
32#include <sys/types.h>
33#include <linux/types.h>
34
35#include <asm/getopt.h>
36#include <asm/sections.h>
37#include <asm/state.h>
38#include <os.h>
39
40
41
42ssize_t os_read(int fd, void *buf, size_t count)
43{
44 return read(fd, buf, count);
45}
46
47ssize_t os_write(int fd, const void *buf, size_t count)
48{
49 return write(fd, buf, count);
50}
51
52off_t os_lseek(int fd, off_t offset, int whence)
53{
54 if (whence == OS_SEEK_SET)
55 whence = SEEK_SET;
56 else if (whence == OS_SEEK_CUR)
57 whence = SEEK_CUR;
58 else if (whence == OS_SEEK_END)
59 whence = SEEK_END;
60 else
61 os_exit(1);
62 return lseek(fd, offset, whence);
63}
64
65int os_open(const char *pathname, int os_flags)
66{
67 int flags;
68
69 switch (os_flags & OS_O_MASK) {
70 case OS_O_RDONLY:
71 default:
72 flags = O_RDONLY;
73 break;
74
75 case OS_O_WRONLY:
76 flags = O_WRONLY;
77 break;
78
79 case OS_O_RDWR:
80 flags = O_RDWR;
81 break;
82 }
83
84 if (os_flags & OS_O_CREAT)
85 flags |= O_CREAT;
86
87 return open(pathname, flags, 0777);
88}
89
90int os_close(int fd)
91{
92 return close(fd);
93}
94
95void os_exit(int exit_code)
96{
97 exit(exit_code);
98}
99
100
101static struct termios orig_term;
102
103static void os_fd_restore(void)
104{
105 tcsetattr(0, TCSANOW, &orig_term);
106}
107
108
109void os_tty_raw(int fd)
110{
111 static int setup = 0;
112 struct termios term;
113
114 if (setup)
115 return;
116 setup = 1;
117
118
119 if (tcgetattr(fd, &orig_term))
120 return;
121
122 term = orig_term;
123 term.c_iflag = IGNBRK | IGNPAR;
124 term.c_oflag = OPOST | ONLCR;
125 term.c_cflag = CS8 | CREAD | CLOCAL;
126 term.c_lflag = 0;
127 if (tcsetattr(fd, TCSANOW, &term))
128 return;
129
130 atexit(os_fd_restore);
131}
132
133void *os_malloc(size_t length)
134{
135 return mmap(NULL, length, PROT_READ | PROT_WRITE,
136 MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
137}
138
139void os_usleep(unsigned long usec)
140{
141 usleep(usec);
142}
143
144u64 os_get_nsec(void)
145{
146#if defined(CLOCK_MONOTONIC) && defined(_POSIX_MONOTONIC_CLOCK)
147 struct timespec tp;
148 if (EINVAL == clock_gettime(CLOCK_MONOTONIC, &tp)) {
149 struct timeval tv;
150
151 gettimeofday(&tv, NULL);
152 tp.tv_sec = tv.tv_sec;
153 tp.tv_nsec = tv.tv_usec * 1000;
154 }
155 return tp.tv_sec * 1000000000ULL + tp.tv_nsec;
156#else
157 struct timeval tv;
158 gettimeofday(&tv, NULL);
159 return tv.tv_sec * 1000000000ULL + tv.tv_usec * 1000;
160#endif
161}
162
163static char *short_opts;
164static struct option *long_opts;
165
166int os_parse_args(struct sandbox_state *state, int argc, char *argv[])
167{
168 struct sb_cmdline_option **sb_opt = __u_boot_sandbox_option_start;
169 size_t num_options = __u_boot_sandbox_option_count();
170 size_t i;
171
172 int hidden_short_opt;
173 size_t si;
174
175 int c;
176
177 if (short_opts || long_opts)
178 return 1;
179
180 state->argc = argc;
181 state->argv = argv;
182
183
184 short_opts = os_malloc(sizeof(*short_opts) * num_options * 2 + 1);
185 long_opts = os_malloc(sizeof(*long_opts) * num_options);
186 if (!short_opts || !long_opts)
187 return 1;
188
189
190
191
192
193
194
195 hidden_short_opt = 0x100;
196 si = 0;
197 for (i = 0; i < num_options; ++i) {
198 long_opts[i].name = sb_opt[i]->flag;
199 long_opts[i].has_arg = sb_opt[i]->has_arg ?
200 required_argument : no_argument;
201 long_opts[i].flag = NULL;
202
203 if (sb_opt[i]->flag_short) {
204 short_opts[si++] = long_opts[i].val = sb_opt[i]->flag_short;
205 if (long_opts[i].has_arg == required_argument)
206 short_opts[si++] = ':';
207 } else
208 long_opts[i].val = sb_opt[i]->flag_short = hidden_short_opt++;
209 }
210 short_opts[si] = '\0';
211
212
213 opterr = 0;
214
215
216
217
218
219
220 while ((c = getopt_long(argc, argv, short_opts, long_opts, NULL)) != -1) {
221 for (i = 0; i < num_options; ++i) {
222 if (sb_opt[i]->flag_short == c) {
223 if (sb_opt[i]->callback(state, optarg)) {
224 state->parse_err = sb_opt[i]->flag;
225 return 0;
226 }
227 break;
228 }
229 }
230 if (i == num_options) {
231
232
233
234
235
236
237
238
239
240
241
242
243
244 if (optopt) {
245 static char parse_err[3] = { '-', 0, '\0', };
246 parse_err[1] = optopt;
247 state->parse_err = parse_err;
248 } else
249 state->parse_err = argv[optind - 1];
250 break;
251 }
252 }
253
254 return 0;
255}
256