129 lines
2.4 KiB
C
129 lines
2.4 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <os.h>
|
||
|
|
#include "harddog.h"
|
||
|
|
|
||
|
|
struct dog_data {
|
||
|
|
int stdin_fd;
|
||
|
|
int stdout_fd;
|
||
|
|
int close_me[2];
|
||
|
|
};
|
||
|
|
|
||
|
|
static void pre_exec(void *d)
|
||
|
|
{
|
||
|
|
struct dog_data *data = d;
|
||
|
|
|
||
|
|
dup2(data->stdin_fd, 0);
|
||
|
|
dup2(data->stdout_fd, 1);
|
||
|
|
dup2(data->stdout_fd, 2);
|
||
|
|
close(data->stdin_fd);
|
||
|
|
close(data->stdout_fd);
|
||
|
|
close(data->close_me[0]);
|
||
|
|
close(data->close_me[1]);
|
||
|
|
}
|
||
|
|
|
||
|
|
int start_watchdog(int *in_fd_ret, int *out_fd_ret, char *sock)
|
||
|
|
{
|
||
|
|
struct dog_data data;
|
||
|
|
int in_fds[2], out_fds[2], pid, n, err;
|
||
|
|
char pid_buf[sizeof("nnnnnnn\0")], c;
|
||
|
|
char *pid_args[] = { "/usr/bin/uml_watchdog", "-pid", pid_buf, NULL };
|
||
|
|
char *mconsole_args[] = { "/usr/bin/uml_watchdog", "-mconsole", NULL,
|
||
|
|
NULL };
|
||
|
|
char **args = NULL;
|
||
|
|
|
||
|
|
err = os_pipe(in_fds, 1, 0);
|
||
|
|
if (err < 0) {
|
||
|
|
printk("harddog_open - os_pipe failed, err = %d\n", -err);
|
||
|
|
goto out;
|
||
|
|
}
|
||
|
|
|
||
|
|
err = os_pipe(out_fds, 1, 0);
|
||
|
|
if (err < 0) {
|
||
|
|
printk("harddog_open - os_pipe failed, err = %d\n", -err);
|
||
|
|
goto out_close_in;
|
||
|
|
}
|
||
|
|
|
||
|
|
data.stdin_fd = out_fds[0];
|
||
|
|
data.stdout_fd = in_fds[1];
|
||
|
|
data.close_me[0] = out_fds[1];
|
||
|
|
data.close_me[1] = in_fds[0];
|
||
|
|
|
||
|
|
if (sock != NULL) {
|
||
|
|
mconsole_args[2] = sock;
|
||
|
|
args = mconsole_args;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
/* XXX The os_getpid() is not SMP correct */
|
||
|
|
sprintf(pid_buf, "%d", os_getpid());
|
||
|
|
args = pid_args;
|
||
|
|
}
|
||
|
|
|
||
|
|
pid = run_helper(pre_exec, &data, args);
|
||
|
|
|
||
|
|
close(out_fds[0]);
|
||
|
|
close(in_fds[1]);
|
||
|
|
|
||
|
|
if (pid < 0) {
|
||
|
|
err = -pid;
|
||
|
|
printk("harddog_open - run_helper failed, errno = %d\n", -err);
|
||
|
|
goto out_close_out;
|
||
|
|
}
|
||
|
|
|
||
|
|
n = read(in_fds[0], &c, sizeof(c));
|
||
|
|
if (n == 0) {
|
||
|
|
printk("harddog_open - EOF on watchdog pipe\n");
|
||
|
|
helper_wait(pid);
|
||
|
|
err = -EIO;
|
||
|
|
goto out_close_out;
|
||
|
|
}
|
||
|
|
else if (n < 0) {
|
||
|
|
printk("harddog_open - read of watchdog pipe failed, "
|
||
|
|
"err = %d\n", errno);
|
||
|
|
helper_wait(pid);
|
||
|
|
err = n;
|
||
|
|
goto out_close_out;
|
||
|
|
}
|
||
|
|
*in_fd_ret = in_fds[0];
|
||
|
|
*out_fd_ret = out_fds[1];
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
out_close_in:
|
||
|
|
close(in_fds[0]);
|
||
|
|
close(in_fds[1]);
|
||
|
|
out_close_out:
|
||
|
|
close(out_fds[0]);
|
||
|
|
close(out_fds[1]);
|
||
|
|
out:
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
void stop_watchdog(int in_fd, int out_fd)
|
||
|
|
{
|
||
|
|
close(in_fd);
|
||
|
|
close(out_fd);
|
||
|
|
}
|
||
|
|
|
||
|
|
int ping_watchdog(int fd)
|
||
|
|
{
|
||
|
|
int n;
|
||
|
|
char c = '\n';
|
||
|
|
|
||
|
|
n = write(fd, &c, sizeof(c));
|
||
|
|
if (n != sizeof(c)) {
|
||
|
|
printk("ping_watchdog - write failed, ret = %d, err = %d\n",
|
||
|
|
n, errno);
|
||
|
|
if (n < 0)
|
||
|
|
return n;
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
return 1;
|
||
|
|
|
||
|
|
}
|