1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Controller of read/write threads for virtio-trace
4  *
5  * Copyright (C) 2012 Hitachi, Ltd.
6  * Created by Yoshihiro Yunomae <yoshihiro.yunomae.ez@hitachi.com>
7  *            Masami Hiramatsu <masami.hiramatsu.pt@hitachi.com>
8  */
9 
10 #define _GNU_SOURCE
11 #include <fcntl.h>
12 #include <poll.h>
13 #include <signal.h>
14 #include <stdio.h>
15 #include <stdlib.h>
16 #include <unistd.h>
17 #include "trace-agent.h"
18 
19 #define HOST_MSG_SIZE		256
20 #define EVENT_WAIT_MSEC		100
21 
22 static volatile sig_atomic_t global_signal_val;
23 bool global_sig_receive;	/* default false */
24 bool global_run_operation;	/* default false*/
25 
26 /* Handle SIGTERM/SIGINT/SIGQUIT to exit */
signal_handler(int sig)27 static void signal_handler(int sig)
28 {
29 	global_signal_val = sig;
30 }
31 
rw_ctl_init(const char * ctl_path)32 int rw_ctl_init(const char *ctl_path)
33 {
34 	int ctl_fd;
35 
36 	ctl_fd = open(ctl_path, O_RDONLY);
37 	if (ctl_fd == -1) {
38 		pr_err("Cannot open ctl_fd\n");
39 		goto error;
40 	}
41 
42 	return ctl_fd;
43 
44 error:
45 	exit(EXIT_FAILURE);
46 }
47 
wait_order(int ctl_fd)48 static int wait_order(int ctl_fd)
49 {
50 	struct pollfd poll_fd;
51 	int ret = 0;
52 
53 	while (!global_sig_receive) {
54 		poll_fd.fd = ctl_fd;
55 		poll_fd.events = POLLIN;
56 
57 		ret = poll(&poll_fd, 1, EVENT_WAIT_MSEC);
58 
59 		if (global_signal_val) {
60 			global_sig_receive = true;
61 			pr_info("Receive interrupt %d\n", global_signal_val);
62 
63 			/* Wakes rw-threads when they are sleeping */
64 			if (!global_run_operation)
65 				pthread_cond_broadcast(&cond_wakeup);
66 
67 			ret = -1;
68 			break;
69 		}
70 
71 		if (ret < 0) {
72 			pr_err("Polling error\n");
73 			goto error;
74 		}
75 
76 		if (ret)
77 			break;
78 	};
79 
80 	return ret;
81 
82 error:
83 	exit(EXIT_FAILURE);
84 }
85 
86 /*
87  * contol read/write threads by handling global_run_operation
88  */
rw_ctl_loop(int ctl_fd)89 void *rw_ctl_loop(int ctl_fd)
90 {
91 	ssize_t rlen;
92 	char buf[HOST_MSG_SIZE];
93 	int ret;
94 
95 	/* Setup signal handlers */
96 	signal(SIGTERM, signal_handler);
97 	signal(SIGINT, signal_handler);
98 	signal(SIGQUIT, signal_handler);
99 
100 	while (!global_sig_receive) {
101 
102 		ret = wait_order(ctl_fd);
103 		if (ret < 0)
104 			break;
105 
106 		rlen = read(ctl_fd, buf, sizeof(buf));
107 		if (rlen < 0) {
108 			pr_err("read data error in ctl thread\n");
109 			goto error;
110 		}
111 
112 		if (rlen == 2 && buf[0] == '1') {
113 			/*
114 			 * If host writes '1' to a control path,
115 			 * this controller wakes all read/write threads.
116 			 */
117 			global_run_operation = true;
118 			pthread_cond_broadcast(&cond_wakeup);
119 			pr_debug("Wake up all read/write threads\n");
120 		} else if (rlen == 2 && buf[0] == '0') {
121 			/*
122 			 * If host writes '0' to a control path, read/write
123 			 * threads will wait for notification from Host.
124 			 */
125 			global_run_operation = false;
126 			pr_debug("Stop all read/write threads\n");
127 		} else
128 			pr_info("Invalid host notification: %s\n", buf);
129 	}
130 
131 	return NULL;
132 
133 error:
134 	exit(EXIT_FAILURE);
135 }
136