18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) 48c2ecf20Sopenharmony_ci */ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <stdio.h> 78c2ecf20Sopenharmony_ci#include <unistd.h> 88c2ecf20Sopenharmony_ci#include <errno.h> 98c2ecf20Sopenharmony_ci#include <os.h> 108c2ecf20Sopenharmony_ci 118c2ecf20Sopenharmony_cistruct dog_data { 128c2ecf20Sopenharmony_ci int stdin_fd; 138c2ecf20Sopenharmony_ci int stdout_fd; 148c2ecf20Sopenharmony_ci int close_me[2]; 158c2ecf20Sopenharmony_ci}; 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_cistatic void pre_exec(void *d) 188c2ecf20Sopenharmony_ci{ 198c2ecf20Sopenharmony_ci struct dog_data *data = d; 208c2ecf20Sopenharmony_ci 218c2ecf20Sopenharmony_ci dup2(data->stdin_fd, 0); 228c2ecf20Sopenharmony_ci dup2(data->stdout_fd, 1); 238c2ecf20Sopenharmony_ci dup2(data->stdout_fd, 2); 248c2ecf20Sopenharmony_ci close(data->stdin_fd); 258c2ecf20Sopenharmony_ci close(data->stdout_fd); 268c2ecf20Sopenharmony_ci close(data->close_me[0]); 278c2ecf20Sopenharmony_ci close(data->close_me[1]); 288c2ecf20Sopenharmony_ci} 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_ciint start_watchdog(int *in_fd_ret, int *out_fd_ret, char *sock) 318c2ecf20Sopenharmony_ci{ 328c2ecf20Sopenharmony_ci struct dog_data data; 338c2ecf20Sopenharmony_ci int in_fds[2], out_fds[2], pid, n, err; 348c2ecf20Sopenharmony_ci char pid_buf[sizeof("nnnnnnn\0")], c; 358c2ecf20Sopenharmony_ci char *pid_args[] = { "/usr/bin/uml_watchdog", "-pid", pid_buf, NULL }; 368c2ecf20Sopenharmony_ci char *mconsole_args[] = { "/usr/bin/uml_watchdog", "-mconsole", NULL, 378c2ecf20Sopenharmony_ci NULL }; 388c2ecf20Sopenharmony_ci char **args = NULL; 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci err = os_pipe(in_fds, 1, 0); 418c2ecf20Sopenharmony_ci if (err < 0) { 428c2ecf20Sopenharmony_ci printk("harddog_open - os_pipe failed, err = %d\n", -err); 438c2ecf20Sopenharmony_ci goto out; 448c2ecf20Sopenharmony_ci } 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci err = os_pipe(out_fds, 1, 0); 478c2ecf20Sopenharmony_ci if (err < 0) { 488c2ecf20Sopenharmony_ci printk("harddog_open - os_pipe failed, err = %d\n", -err); 498c2ecf20Sopenharmony_ci goto out_close_in; 508c2ecf20Sopenharmony_ci } 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_ci data.stdin_fd = out_fds[0]; 538c2ecf20Sopenharmony_ci data.stdout_fd = in_fds[1]; 548c2ecf20Sopenharmony_ci data.close_me[0] = out_fds[1]; 558c2ecf20Sopenharmony_ci data.close_me[1] = in_fds[0]; 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci if (sock != NULL) { 588c2ecf20Sopenharmony_ci mconsole_args[2] = sock; 598c2ecf20Sopenharmony_ci args = mconsole_args; 608c2ecf20Sopenharmony_ci } 618c2ecf20Sopenharmony_ci else { 628c2ecf20Sopenharmony_ci /* XXX The os_getpid() is not SMP correct */ 638c2ecf20Sopenharmony_ci sprintf(pid_buf, "%d", os_getpid()); 648c2ecf20Sopenharmony_ci args = pid_args; 658c2ecf20Sopenharmony_ci } 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci pid = run_helper(pre_exec, &data, args); 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_ci close(out_fds[0]); 708c2ecf20Sopenharmony_ci close(in_fds[1]); 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci if (pid < 0) { 738c2ecf20Sopenharmony_ci err = -pid; 748c2ecf20Sopenharmony_ci printk("harddog_open - run_helper failed, errno = %d\n", -err); 758c2ecf20Sopenharmony_ci goto out_close_out; 768c2ecf20Sopenharmony_ci } 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci n = read(in_fds[0], &c, sizeof(c)); 798c2ecf20Sopenharmony_ci if (n == 0) { 808c2ecf20Sopenharmony_ci printk("harddog_open - EOF on watchdog pipe\n"); 818c2ecf20Sopenharmony_ci helper_wait(pid); 828c2ecf20Sopenharmony_ci err = -EIO; 838c2ecf20Sopenharmony_ci goto out_close_out; 848c2ecf20Sopenharmony_ci } 858c2ecf20Sopenharmony_ci else if (n < 0) { 868c2ecf20Sopenharmony_ci printk("harddog_open - read of watchdog pipe failed, " 878c2ecf20Sopenharmony_ci "err = %d\n", errno); 888c2ecf20Sopenharmony_ci helper_wait(pid); 898c2ecf20Sopenharmony_ci err = n; 908c2ecf20Sopenharmony_ci goto out_close_out; 918c2ecf20Sopenharmony_ci } 928c2ecf20Sopenharmony_ci *in_fd_ret = in_fds[0]; 938c2ecf20Sopenharmony_ci *out_fd_ret = out_fds[1]; 948c2ecf20Sopenharmony_ci return 0; 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci out_close_in: 978c2ecf20Sopenharmony_ci close(in_fds[0]); 988c2ecf20Sopenharmony_ci close(in_fds[1]); 998c2ecf20Sopenharmony_ci out_close_out: 1008c2ecf20Sopenharmony_ci close(out_fds[0]); 1018c2ecf20Sopenharmony_ci close(out_fds[1]); 1028c2ecf20Sopenharmony_ci out: 1038c2ecf20Sopenharmony_ci return err; 1048c2ecf20Sopenharmony_ci} 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_civoid stop_watchdog(int in_fd, int out_fd) 1078c2ecf20Sopenharmony_ci{ 1088c2ecf20Sopenharmony_ci close(in_fd); 1098c2ecf20Sopenharmony_ci close(out_fd); 1108c2ecf20Sopenharmony_ci} 1118c2ecf20Sopenharmony_ci 1128c2ecf20Sopenharmony_ciint ping_watchdog(int fd) 1138c2ecf20Sopenharmony_ci{ 1148c2ecf20Sopenharmony_ci int n; 1158c2ecf20Sopenharmony_ci char c = '\n'; 1168c2ecf20Sopenharmony_ci 1178c2ecf20Sopenharmony_ci n = write(fd, &c, sizeof(c)); 1188c2ecf20Sopenharmony_ci if (n != sizeof(c)) { 1198c2ecf20Sopenharmony_ci printk("ping_watchdog - write failed, ret = %d, err = %d\n", 1208c2ecf20Sopenharmony_ci n, errno); 1218c2ecf20Sopenharmony_ci if (n < 0) 1228c2ecf20Sopenharmony_ci return n; 1238c2ecf20Sopenharmony_ci return -EIO; 1248c2ecf20Sopenharmony_ci } 1258c2ecf20Sopenharmony_ci return 1; 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_ci} 128