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