162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) 462306a36Sopenharmony_ci */ 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <stdlib.h> 762306a36Sopenharmony_ci#include <string.h> 862306a36Sopenharmony_ci#include <unistd.h> 962306a36Sopenharmony_ci#include <errno.h> 1062306a36Sopenharmony_ci#include <sched.h> 1162306a36Sopenharmony_ci#include <linux/limits.h> 1262306a36Sopenharmony_ci#include <sys/socket.h> 1362306a36Sopenharmony_ci#include <sys/wait.h> 1462306a36Sopenharmony_ci#include <kern_util.h> 1562306a36Sopenharmony_ci#include <os.h> 1662306a36Sopenharmony_ci#include <um_malloc.h> 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_cistruct helper_data { 1962306a36Sopenharmony_ci void (*pre_exec)(void*); 2062306a36Sopenharmony_ci void *pre_data; 2162306a36Sopenharmony_ci char **argv; 2262306a36Sopenharmony_ci int fd; 2362306a36Sopenharmony_ci char *buf; 2462306a36Sopenharmony_ci}; 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_cistatic int helper_child(void *arg) 2762306a36Sopenharmony_ci{ 2862306a36Sopenharmony_ci struct helper_data *data = arg; 2962306a36Sopenharmony_ci char **argv = data->argv; 3062306a36Sopenharmony_ci int err, ret; 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci if (data->pre_exec != NULL) 3362306a36Sopenharmony_ci (*data->pre_exec)(data->pre_data); 3462306a36Sopenharmony_ci err = execvp_noalloc(data->buf, argv[0], argv); 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci /* If the exec succeeds, we don't get here */ 3762306a36Sopenharmony_ci CATCH_EINTR(ret = write(data->fd, &err, sizeof(err))); 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci return 0; 4062306a36Sopenharmony_ci} 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci/* Returns either the pid of the child process we run or -E* on failure. */ 4362306a36Sopenharmony_ciint run_helper(void (*pre_exec)(void *), void *pre_data, char **argv) 4462306a36Sopenharmony_ci{ 4562306a36Sopenharmony_ci struct helper_data data; 4662306a36Sopenharmony_ci unsigned long stack, sp; 4762306a36Sopenharmony_ci int pid, fds[2], ret, n; 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci stack = alloc_stack(0, __uml_cant_sleep()); 5062306a36Sopenharmony_ci if (stack == 0) 5162306a36Sopenharmony_ci return -ENOMEM; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci ret = socketpair(AF_UNIX, SOCK_STREAM, 0, fds); 5462306a36Sopenharmony_ci if (ret < 0) { 5562306a36Sopenharmony_ci ret = -errno; 5662306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper : pipe failed, errno = %d\n", 5762306a36Sopenharmony_ci errno); 5862306a36Sopenharmony_ci goto out_free; 5962306a36Sopenharmony_ci } 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci ret = os_set_exec_close(fds[1]); 6262306a36Sopenharmony_ci if (ret < 0) { 6362306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper : setting FD_CLOEXEC failed, " 6462306a36Sopenharmony_ci "ret = %d\n", -ret); 6562306a36Sopenharmony_ci goto out_close; 6662306a36Sopenharmony_ci } 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci sp = stack + UM_KERN_PAGE_SIZE; 6962306a36Sopenharmony_ci data.pre_exec = pre_exec; 7062306a36Sopenharmony_ci data.pre_data = pre_data; 7162306a36Sopenharmony_ci data.argv = argv; 7262306a36Sopenharmony_ci data.fd = fds[1]; 7362306a36Sopenharmony_ci data.buf = __uml_cant_sleep() ? uml_kmalloc(PATH_MAX, UM_GFP_ATOMIC) : 7462306a36Sopenharmony_ci uml_kmalloc(PATH_MAX, UM_GFP_KERNEL); 7562306a36Sopenharmony_ci pid = clone(helper_child, (void *) sp, CLONE_VM, &data); 7662306a36Sopenharmony_ci if (pid < 0) { 7762306a36Sopenharmony_ci ret = -errno; 7862306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper : clone failed, errno = %d\n", 7962306a36Sopenharmony_ci errno); 8062306a36Sopenharmony_ci goto out_free2; 8162306a36Sopenharmony_ci } 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_ci close(fds[1]); 8462306a36Sopenharmony_ci fds[1] = -1; 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci /* 8762306a36Sopenharmony_ci * Read the errno value from the child, if the exec failed, or get 0 if 8862306a36Sopenharmony_ci * the exec succeeded because the pipe fd was set as close-on-exec. 8962306a36Sopenharmony_ci */ 9062306a36Sopenharmony_ci n = read(fds[0], &ret, sizeof(ret)); 9162306a36Sopenharmony_ci if (n == 0) { 9262306a36Sopenharmony_ci ret = pid; 9362306a36Sopenharmony_ci } else { 9462306a36Sopenharmony_ci if (n < 0) { 9562306a36Sopenharmony_ci n = -errno; 9662306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper : read on pipe failed, " 9762306a36Sopenharmony_ci "ret = %d\n", -n); 9862306a36Sopenharmony_ci ret = n; 9962306a36Sopenharmony_ci } 10062306a36Sopenharmony_ci CATCH_EINTR(waitpid(pid, NULL, __WALL)); 10162306a36Sopenharmony_ci } 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_ci if (ret < 0) 10462306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper : failed to exec %s on host: %s\n", 10562306a36Sopenharmony_ci argv[0], strerror(-ret)); 10662306a36Sopenharmony_ci 10762306a36Sopenharmony_ciout_free2: 10862306a36Sopenharmony_ci kfree(data.buf); 10962306a36Sopenharmony_ciout_close: 11062306a36Sopenharmony_ci if (fds[1] != -1) 11162306a36Sopenharmony_ci close(fds[1]); 11262306a36Sopenharmony_ci close(fds[0]); 11362306a36Sopenharmony_ciout_free: 11462306a36Sopenharmony_ci free_stack(stack, 0); 11562306a36Sopenharmony_ci return ret; 11662306a36Sopenharmony_ci} 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ciint run_helper_thread(int (*proc)(void *), void *arg, unsigned int flags, 11962306a36Sopenharmony_ci unsigned long *stack_out) 12062306a36Sopenharmony_ci{ 12162306a36Sopenharmony_ci unsigned long stack, sp; 12262306a36Sopenharmony_ci int pid, status, err; 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_ci stack = alloc_stack(0, __uml_cant_sleep()); 12562306a36Sopenharmony_ci if (stack == 0) 12662306a36Sopenharmony_ci return -ENOMEM; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci sp = stack + UM_KERN_PAGE_SIZE; 12962306a36Sopenharmony_ci pid = clone(proc, (void *) sp, flags, arg); 13062306a36Sopenharmony_ci if (pid < 0) { 13162306a36Sopenharmony_ci err = -errno; 13262306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper_thread : clone failed, " 13362306a36Sopenharmony_ci "errno = %d\n", errno); 13462306a36Sopenharmony_ci return err; 13562306a36Sopenharmony_ci } 13662306a36Sopenharmony_ci if (stack_out == NULL) { 13762306a36Sopenharmony_ci CATCH_EINTR(pid = waitpid(pid, &status, __WALL)); 13862306a36Sopenharmony_ci if (pid < 0) { 13962306a36Sopenharmony_ci err = -errno; 14062306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper_thread - wait failed, " 14162306a36Sopenharmony_ci "errno = %d\n", errno); 14262306a36Sopenharmony_ci pid = err; 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) 14562306a36Sopenharmony_ci printk(UM_KERN_ERR "run_helper_thread - thread " 14662306a36Sopenharmony_ci "returned status 0x%x\n", status); 14762306a36Sopenharmony_ci free_stack(stack, 0); 14862306a36Sopenharmony_ci } else 14962306a36Sopenharmony_ci *stack_out = stack; 15062306a36Sopenharmony_ci return pid; 15162306a36Sopenharmony_ci} 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ciint helper_wait(int pid) 15462306a36Sopenharmony_ci{ 15562306a36Sopenharmony_ci int ret, status; 15662306a36Sopenharmony_ci int wflags = __WALL; 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci CATCH_EINTR(ret = waitpid(pid, &status, wflags)); 15962306a36Sopenharmony_ci if (ret < 0) { 16062306a36Sopenharmony_ci printk(UM_KERN_ERR "helper_wait : waitpid process %d failed, " 16162306a36Sopenharmony_ci "errno = %d\n", pid, errno); 16262306a36Sopenharmony_ci return -errno; 16362306a36Sopenharmony_ci } else if (!WIFEXITED(status) || WEXITSTATUS(status) != 0) { 16462306a36Sopenharmony_ci printk(UM_KERN_ERR "helper_wait : process %d exited with " 16562306a36Sopenharmony_ci "status 0x%x\n", pid, status); 16662306a36Sopenharmony_ci return -ECHILD; 16762306a36Sopenharmony_ci } else 16862306a36Sopenharmony_ci return 0; 16962306a36Sopenharmony_ci} 170