|  | /* | 
|  | * Copyright (C) 2002 Jeff Dike (jdike@karaya.com) | 
|  | * Licensed under the GPL | 
|  | */ | 
|  |  | 
|  | #include <stdio.h> | 
|  | #include <stdlib.h> | 
|  | #include <unistd.h> | 
|  | #include <errno.h> | 
|  | #include <sched.h> | 
|  | #include <sys/signal.h> | 
|  | #include <sys/wait.h> | 
|  | #include "user.h" | 
|  | #include "kern_util.h" | 
|  | #include "user_util.h" | 
|  | #include "os.h" | 
|  |  | 
|  | struct helper_data { | 
|  | void (*pre_exec)(void*); | 
|  | void *pre_data; | 
|  | char **argv; | 
|  | int fd; | 
|  | }; | 
|  |  | 
|  | /* Debugging aid, changed only from gdb */ | 
|  | int helper_pause = 0; | 
|  |  | 
|  | static void helper_hup(int sig) | 
|  | { | 
|  | } | 
|  |  | 
|  | static int helper_child(void *arg) | 
|  | { | 
|  | struct helper_data *data = arg; | 
|  | char **argv = data->argv; | 
|  | int errval; | 
|  |  | 
|  | if(helper_pause){ | 
|  | signal(SIGHUP, helper_hup); | 
|  | pause(); | 
|  | } | 
|  | if(data->pre_exec != NULL) | 
|  | (*data->pre_exec)(data->pre_data); | 
|  | execvp(argv[0], argv); | 
|  | errval = errno; | 
|  | printk("helper_child - execve of '%s' failed - errno = %d\n", argv[0], errno); | 
|  | os_write_file(data->fd, &errval, sizeof(errval)); | 
|  | kill(os_getpid(), SIGKILL); | 
|  | return(0); | 
|  | } | 
|  |  | 
|  | /* Returns either the pid of the child process we run or -E* on failure. | 
|  | * XXX The alloc_stack here breaks if this is called in the tracing thread */ | 
|  | int run_helper(void (*pre_exec)(void *), void *pre_data, char **argv, | 
|  | unsigned long *stack_out) | 
|  | { | 
|  | struct helper_data data; | 
|  | unsigned long stack, sp; | 
|  | int pid, fds[2], ret, n; | 
|  |  | 
|  | if((stack_out != NULL) && (*stack_out != 0)) | 
|  | stack = *stack_out; | 
|  | else stack = alloc_stack(0, __cant_sleep()); | 
|  | if(stack == 0) | 
|  | return(-ENOMEM); | 
|  |  | 
|  | ret = os_pipe(fds, 1, 0); | 
|  | if(ret < 0){ | 
|  | printk("run_helper : pipe failed, ret = %d\n", -ret); | 
|  | goto out_free; | 
|  | } | 
|  |  | 
|  | ret = os_set_exec_close(fds[1], 1); | 
|  | if(ret < 0){ | 
|  | printk("run_helper : setting FD_CLOEXEC failed, ret = %d\n", | 
|  | -ret); | 
|  | goto out_close; | 
|  | } | 
|  |  | 
|  | sp = stack + page_size() - sizeof(void *); | 
|  | data.pre_exec = pre_exec; | 
|  | data.pre_data = pre_data; | 
|  | data.argv = argv; | 
|  | data.fd = fds[1]; | 
|  | pid = clone(helper_child, (void *) sp, CLONE_VM | SIGCHLD, &data); | 
|  | if(pid < 0){ | 
|  | ret = -errno; | 
|  | printk("run_helper : clone failed, errno = %d\n", errno); | 
|  | goto out_close; | 
|  | } | 
|  |  | 
|  | close(fds[1]); | 
|  | fds[1] = -1; | 
|  |  | 
|  | /* Read the errno value from the child, if the exec failed, or get 0 if | 
|  | * the exec succeeded because the pipe fd was set as close-on-exec. */ | 
|  | n = os_read_file(fds[0], &ret, sizeof(ret)); | 
|  | if (n < 0) { | 
|  | printk("run_helper : read on pipe failed, ret = %d\n", -n); | 
|  | ret = n; | 
|  | kill(pid, SIGKILL); | 
|  | CATCH_EINTR(waitpid(pid, NULL, 0)); | 
|  | } else if(n != 0){ | 
|  | CATCH_EINTR(n = waitpid(pid, NULL, 0)); | 
|  | ret = -errno; | 
|  | } else { | 
|  | ret = pid; | 
|  | } | 
|  |  | 
|  | out_close: | 
|  | if (fds[1] != -1) | 
|  | close(fds[1]); | 
|  | close(fds[0]); | 
|  | out_free: | 
|  | if(stack_out == NULL) | 
|  | free_stack(stack, 0); | 
|  | else *stack_out = stack; | 
|  | return(ret); | 
|  | } | 
|  |  | 
|  | int run_helper_thread(int (*proc)(void *), void *arg, unsigned int flags, | 
|  | unsigned long *stack_out, int stack_order) | 
|  | { | 
|  | unsigned long stack, sp; | 
|  | int pid, status, err; | 
|  |  | 
|  | stack = alloc_stack(stack_order, __cant_sleep()); | 
|  | if(stack == 0) return(-ENOMEM); | 
|  |  | 
|  | sp = stack + (page_size() << stack_order) - sizeof(void *); | 
|  | pid = clone(proc, (void *) sp, flags | SIGCHLD, arg); | 
|  | if(pid < 0){ | 
|  | err = -errno; | 
|  | printk("run_helper_thread : clone failed, errno = %d\n", | 
|  | errno); | 
|  | return err; | 
|  | } | 
|  | if(stack_out == NULL){ | 
|  | CATCH_EINTR(pid = waitpid(pid, &status, 0)); | 
|  | if(pid < 0){ | 
|  | err = -errno; | 
|  | printk("run_helper_thread - wait failed, errno = %d\n", | 
|  | errno); | 
|  | pid = err; | 
|  | } | 
|  | if(!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) | 
|  | printk("run_helper_thread - thread returned status " | 
|  | "0x%x\n", status); | 
|  | free_stack(stack, stack_order); | 
|  | } | 
|  | else *stack_out = stack; | 
|  | return(pid); | 
|  | } | 
|  |  | 
|  | int helper_wait(int pid) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | CATCH_EINTR(ret = waitpid(pid, NULL, WNOHANG)); | 
|  | if(ret < 0){ | 
|  | ret = -errno; | 
|  | printk("helper_wait : waitpid failed, errno = %d\n", errno); | 
|  | } | 
|  | return(ret); | 
|  | } |