Rev 4327 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 4327 | Rev 4581 | ||
---|---|---|---|
Line 51... | Line 51... | ||
51 | #include <sys/types.h> |
51 | #include <sys/types.h> |
52 | #include <ipc/ipc.h> |
52 | #include <ipc/ipc.h> |
53 | #include <ipc/services.h> |
53 | #include <ipc/services.h> |
54 | #include <ipc/loader.h> |
54 | #include <ipc/loader.h> |
55 | #include <loader/pcb.h> |
55 | #include <loader/pcb.h> |
56 | #include <console.h> |
- | |
57 | #include <errno.h> |
56 | #include <errno.h> |
58 | #include <async.h> |
57 | #include <async.h> |
- | 58 | #include <string.h> |
|
59 | #include <as.h> |
59 | #include <as.h> |
60 | 60 | ||
61 | #include <elf.h> |
61 | #include <elf.h> |
62 | #include <elf_load.h> |
62 | #include <elf_load.h> |
63 | 63 | ||
Line 74... | Line 74... | ||
74 | /** Argument vector */ |
74 | /** Argument vector */ |
75 | static char **argv = NULL; |
75 | static char **argv = NULL; |
76 | /** Buffer holding all arguments */ |
76 | /** Buffer holding all arguments */ |
77 | static char *arg_buf = NULL; |
77 | static char *arg_buf = NULL; |
78 | 78 | ||
- | 79 | /** Number of preset files */ |
|
- | 80 | static int filc = 0; |
|
- | 81 | /** Preset files vector */ |
|
- | 82 | static fdi_node_t **filv = NULL; |
|
- | 83 | /** Buffer holding all preset files */ |
|
- | 84 | static fdi_node_t *fil_buf = NULL; |
|
- | 85 | ||
79 | static elf_info_t prog_info; |
86 | static elf_info_t prog_info; |
80 | static elf_info_t interp_info; |
87 | static elf_info_t interp_info; |
81 | 88 | ||
82 | static bool is_dyn_linked; |
89 | static bool is_dyn_linked; |
83 | 90 | ||
84 | /** Used to limit number of connections to one. */ |
91 | /** Used to limit number of connections to one. */ |
85 | static bool connected; |
92 | static bool connected; |
86 | 93 | ||
87 | static void loader_get_taskid(ipc_callid_t rid, ipc_call_t *request) |
94 | static void ldr_get_taskid(ipc_callid_t rid, ipc_call_t *request) |
88 | { |
95 | { |
89 | ipc_callid_t callid; |
96 | ipc_callid_t callid; |
90 | task_id_t task_id; |
97 | task_id_t task_id; |
91 | size_t len; |
98 | size_t len; |
92 | 99 | ||
Line 109... | Line 116... | ||
109 | /** Receive a call setting pathname of the program to execute. |
116 | /** Receive a call setting pathname of the program to execute. |
110 | * |
117 | * |
111 | * @param rid |
118 | * @param rid |
112 | * @param request |
119 | * @param request |
113 | */ |
120 | */ |
114 | static void loader_set_pathname(ipc_callid_t rid, ipc_call_t *request) |
121 | static void ldr_set_pathname(ipc_callid_t rid, ipc_call_t *request) |
115 | { |
122 | { |
116 | ipc_callid_t callid; |
123 | ipc_callid_t callid; |
117 | size_t len; |
124 | size_t len; |
118 | char *name_buf; |
125 | char *name_buf; |
119 | 126 | ||
Line 145... | Line 152... | ||
145 | /** Receive a call setting arguments of the program to execute. |
152 | /** Receive a call setting arguments of the program to execute. |
146 | * |
153 | * |
147 | * @param rid |
154 | * @param rid |
148 | * @param request |
155 | * @param request |
149 | */ |
156 | */ |
150 | static void loader_set_args(ipc_callid_t rid, ipc_call_t *request) |
157 | static void ldr_set_args(ipc_callid_t rid, ipc_call_t *request) |
151 | { |
158 | { |
152 | ipc_callid_t callid; |
159 | ipc_callid_t callid; |
153 | size_t buf_size, arg_size; |
160 | size_t buf_size, arg_size; |
154 | char *p; |
161 | char *p; |
155 | int n; |
162 | int n; |
Line 218... | Line 225... | ||
218 | argv[n] = NULL; |
225 | argv[n] = NULL; |
219 | 226 | ||
220 | ipc_answer_0(rid, EOK); |
227 | ipc_answer_0(rid, EOK); |
221 | } |
228 | } |
222 | 229 | ||
- | 230 | /** Receive a call setting preset files of the program to execute. |
|
- | 231 | * |
|
- | 232 | * @param rid |
|
- | 233 | * @param request |
|
- | 234 | */ |
|
- | 235 | static void ldr_set_files(ipc_callid_t rid, ipc_call_t *request) |
|
- | 236 | { |
|
- | 237 | ipc_callid_t callid; |
|
- | 238 | size_t buf_size; |
|
- | 239 | if (!ipc_data_write_receive(&callid, &buf_size)) { |
|
- | 240 | ipc_answer_0(callid, EINVAL); |
|
- | 241 | ipc_answer_0(rid, EINVAL); |
|
- | 242 | return; |
|
- | 243 | } |
|
- | 244 | ||
- | 245 | if ((buf_size % sizeof(fdi_node_t)) != 0) { |
|
- | 246 | ipc_answer_0(callid, EINVAL); |
|
- | 247 | ipc_answer_0(rid, EINVAL); |
|
- | 248 | return; |
|
- | 249 | } |
|
- | 250 | ||
- | 251 | if (fil_buf != NULL) { |
|
- | 252 | free(fil_buf); |
|
- | 253 | fil_buf = NULL; |
|
- | 254 | } |
|
- | 255 | ||
- | 256 | if (filv != NULL) { |
|
- | 257 | free(filv); |
|
- | 258 | filv = NULL; |
|
- | 259 | } |
|
- | 260 | ||
- | 261 | fil_buf = malloc(buf_size); |
|
- | 262 | if (!fil_buf) { |
|
- | 263 | ipc_answer_0(callid, ENOMEM); |
|
- | 264 | ipc_answer_0(rid, ENOMEM); |
|
- | 265 | return; |
|
- | 266 | } |
|
- | 267 | ||
- | 268 | ipc_data_write_finalize(callid, fil_buf, buf_size); |
|
- | 269 | ||
- | 270 | int count = buf_size / sizeof(fdi_node_t); |
|
- | 271 | ||
- | 272 | /* Allocate filvv */ |
|
- | 273 | filv = malloc((count + 1) * sizeof(fdi_node_t *)); |
|
- | 274 | ||
- | 275 | if (filv == NULL) { |
|
- | 276 | free(fil_buf); |
|
- | 277 | ipc_answer_0(rid, ENOMEM); |
|
- | 278 | return; |
|
- | 279 | } |
|
- | 280 | ||
- | 281 | /* |
|
- | 282 | * Fill filv with argument pointers |
|
- | 283 | */ |
|
- | 284 | int i; |
|
- | 285 | for (i = 0; i < count; i++) |
|
- | 286 | filv[i] = &fil_buf[i]; |
|
- | 287 | ||
- | 288 | filc = count; |
|
- | 289 | filv[count] = NULL; |
|
- | 290 | ||
- | 291 | ipc_answer_0(rid, EOK); |
|
- | 292 | } |
|
- | 293 | ||
223 | /** Load the previously selected program. |
294 | /** Load the previously selected program. |
224 | * |
295 | * |
225 | * @param rid |
296 | * @param rid |
226 | * @param request |
297 | * @param request |
227 | * @return 0 on success, !0 on error. |
298 | * @return 0 on success, !0 on error. |
228 | */ |
299 | */ |
229 | static int loader_load(ipc_callid_t rid, ipc_call_t *request) |
300 | static int ldr_load(ipc_callid_t rid, ipc_call_t *request) |
230 | { |
301 | { |
231 | int rc; |
302 | int rc; |
232 | 303 | ||
233 | rc = elf_load_file(pathname, 0, &prog_info); |
304 | rc = elf_load_file(pathname, 0, &prog_info); |
234 | if (rc < 0) { |
305 | if (rc != EE_OK) { |
235 | DPRINTF("Failed to load executable '%s'.\n", pathname); |
306 | DPRINTF("Failed to load executable '%s'.\n", pathname); |
236 | ipc_answer_0(rid, EINVAL); |
307 | ipc_answer_0(rid, EINVAL); |
237 | return 1; |
308 | return 1; |
238 | } |
309 | } |
239 | 310 | ||
240 | elf_create_pcb(&prog_info, &pcb); |
311 | elf_create_pcb(&prog_info, &pcb); |
241 | 312 | ||
242 | pcb.argc = argc; |
313 | pcb.argc = argc; |
243 | pcb.argv = argv; |
314 | pcb.argv = argv; |
244 | 315 | ||
- | 316 | pcb.filc = filc; |
|
- | 317 | pcb.filv = filv; |
|
- | 318 | ||
245 | if (prog_info.interp == NULL) { |
319 | if (prog_info.interp == NULL) { |
246 | /* Statically linked program */ |
320 | /* Statically linked program */ |
247 | is_dyn_linked = false; |
321 | is_dyn_linked = false; |
248 | ipc_answer_0(rid, EOK); |
322 | ipc_answer_0(rid, EOK); |
249 | return 0; |
323 | return 0; |
250 | } |
324 | } |
251 | 325 | ||
252 | rc = elf_load_file(prog_info.interp, 0, &interp_info); |
326 | rc = elf_load_file(prog_info.interp, 0, &interp_info); |
253 | if (rc < 0) { |
327 | if (rc != EE_OK) { |
254 | DPRINTF("Failed to load interpreter '%s.'\n", |
328 | DPRINTF("Failed to load interpreter '%s.'\n", |
255 | prog_info.interp); |
329 | prog_info.interp); |
256 | ipc_answer_0(rid, EINVAL); |
330 | ipc_answer_0(rid, EINVAL); |
257 | return 1; |
331 | return 1; |
258 | } |
332 | } |
Line 268... | Line 342... | ||
268 | * |
342 | * |
269 | * @param rid |
343 | * @param rid |
270 | * @param request |
344 | * @param request |
271 | * @return 0 on success, !0 on error. |
345 | * @return 0 on success, !0 on error. |
272 | */ |
346 | */ |
273 | static void loader_run(ipc_callid_t rid, ipc_call_t *request) |
347 | static void ldr_run(ipc_callid_t rid, ipc_call_t *request) |
274 | { |
348 | { |
275 | const char *cp; |
349 | const char *cp; |
276 | 350 | ||
277 | /* Set the task name. */ |
351 | /* Set the task name. */ |
278 | cp = str_rchr(pathname, '/'); |
352 | cp = str_rchr(pathname, '/'); |
Line 281... | Line 355... | ||
281 | 355 | ||
282 | if (is_dyn_linked == true) { |
356 | if (is_dyn_linked == true) { |
283 | /* Dynamically linked program */ |
357 | /* Dynamically linked program */ |
284 | DPRINTF("Run ELF interpreter.\n"); |
358 | DPRINTF("Run ELF interpreter.\n"); |
285 | DPRINTF("Entry point: 0x%lx\n", interp_info.entry); |
359 | DPRINTF("Entry point: 0x%lx\n", interp_info.entry); |
286 | console_close(); |
- | |
287 | 360 | ||
288 | ipc_answer_0(rid, EOK); |
361 | ipc_answer_0(rid, EOK); |
289 | elf_run(&interp_info, &pcb); |
362 | elf_run(&interp_info, &pcb); |
290 | } else { |
363 | } else { |
291 | /* Statically linked program */ |
364 | /* Statically linked program */ |
292 | console_close(); |
- | |
293 | ipc_answer_0(rid, EOK); |
365 | ipc_answer_0(rid, EOK); |
294 | elf_run(&prog_info, &pcb); |
366 | elf_run(&prog_info, &pcb); |
295 | } |
367 | } |
296 | 368 | ||
297 | /* Not reached */ |
369 | /* Not reached */ |
298 | } |
370 | } |
299 | 371 | ||
300 | /** Handle loader connection. |
372 | /** Handle loader connection. |
301 | * |
373 | * |
302 | * Receive and carry out commands (of which the last one should be |
374 | * Receive and carry out commands (of which the last one should be |
303 | * to execute the loaded program). |
375 | * to execute the loaded program). |
304 | */ |
376 | */ |
305 | static void loader_connection(ipc_callid_t iid, ipc_call_t *icall) |
377 | static void ldr_connection(ipc_callid_t iid, ipc_call_t *icall) |
306 | { |
378 | { |
307 | ipc_callid_t callid; |
379 | ipc_callid_t callid; |
308 | ipc_call_t call; |
380 | ipc_call_t call; |
309 | int retval; |
381 | int retval; |
310 | 382 | ||
Line 328... | Line 400... | ||
328 | 400 | ||
329 | switch (IPC_GET_METHOD(call)) { |
401 | switch (IPC_GET_METHOD(call)) { |
330 | case IPC_M_PHONE_HUNGUP: |
402 | case IPC_M_PHONE_HUNGUP: |
331 | exit(0); |
403 | exit(0); |
332 | case LOADER_GET_TASKID: |
404 | case LOADER_GET_TASKID: |
333 | loader_get_taskid(callid, &call); |
405 | ldr_get_taskid(callid, &call); |
334 | continue; |
406 | continue; |
335 | case LOADER_SET_PATHNAME: |
407 | case LOADER_SET_PATHNAME: |
336 | loader_set_pathname(callid, &call); |
408 | ldr_set_pathname(callid, &call); |
337 | continue; |
409 | continue; |
338 | case LOADER_SET_ARGS: |
410 | case LOADER_SET_ARGS: |
339 | loader_set_args(callid, &call); |
411 | ldr_set_args(callid, &call); |
- | 412 | continue; |
|
- | 413 | case LOADER_SET_FILES: |
|
- | 414 | ldr_set_files(callid, &call); |
|
340 | continue; |
415 | continue; |
341 | case LOADER_LOAD: |
416 | case LOADER_LOAD: |
342 | loader_load(callid, &call); |
417 | ldr_load(callid, &call); |
343 | continue; |
418 | continue; |
344 | case LOADER_RUN: |
419 | case LOADER_RUN: |
345 | loader_run(callid, &call); |
420 | ldr_run(callid, &call); |
346 | /* Not reached */ |
421 | /* Not reached */ |
347 | default: |
422 | default: |
348 | retval = ENOENT; |
423 | retval = ENOENT; |
349 | break; |
424 | break; |
350 | } |
425 | } |
Line 364... | Line 439... | ||
364 | ipcarg_t phonead; |
439 | ipcarg_t phonead; |
365 | 440 | ||
366 | connected = false; |
441 | connected = false; |
367 | 442 | ||
368 | /* Set a handler of incomming connections. */ |
443 | /* Set a handler of incomming connections. */ |
369 | async_set_client_connection(loader_connection); |
444 | async_set_client_connection(ldr_connection); |
370 | 445 | ||
371 | /* Register at naming service. */ |
446 | /* Register at naming service. */ |
372 | if (ipc_connect_to_me(PHONE_NS, SERVICE_LOAD, 0, 0, &phonead) != 0) |
447 | if (ipc_connect_to_me(PHONE_NS, SERVICE_LOAD, 0, 0, &phonead) != 0) |
373 | return -1; |
448 | return -1; |
374 | 449 |