1*25da2beaSAndroid Build Coastguard Worker /* SPDX-License-Identifier: MIT */
2*25da2beaSAndroid Build Coastguard Worker #include <errno.h>
3*25da2beaSAndroid Build Coastguard Worker #include <stdio.h>
4*25da2beaSAndroid Build Coastguard Worker #include <unistd.h>
5*25da2beaSAndroid Build Coastguard Worker #include <stdlib.h>
6*25da2beaSAndroid Build Coastguard Worker #include <string.h>
7*25da2beaSAndroid Build Coastguard Worker #include <fcntl.h>
8*25da2beaSAndroid Build Coastguard Worker #include <assert.h>
9*25da2beaSAndroid Build Coastguard Worker #include <pthread.h>
10*25da2beaSAndroid Build Coastguard Worker #include <sys/socket.h>
11*25da2beaSAndroid Build Coastguard Worker #include <netinet/tcp.h>
12*25da2beaSAndroid Build Coastguard Worker #include <netinet/in.h>
13*25da2beaSAndroid Build Coastguard Worker #include <poll.h>
14*25da2beaSAndroid Build Coastguard Worker #include <arpa/inet.h>
15*25da2beaSAndroid Build Coastguard Worker
16*25da2beaSAndroid Build Coastguard Worker #include "liburing.h"
17*25da2beaSAndroid Build Coastguard Worker
18*25da2beaSAndroid Build Coastguard Worker pthread_mutex_t mutex = PTHREAD_MUTEX_INITIALIZER;
19*25da2beaSAndroid Build Coastguard Worker pthread_cond_t cond = PTHREAD_COND_INITIALIZER;
20*25da2beaSAndroid Build Coastguard Worker
21*25da2beaSAndroid Build Coastguard Worker static int recv_thread_ready = 0;
22*25da2beaSAndroid Build Coastguard Worker static int recv_thread_done = 0;
23*25da2beaSAndroid Build Coastguard Worker
signal_var(int * var)24*25da2beaSAndroid Build Coastguard Worker static void signal_var(int *var)
25*25da2beaSAndroid Build Coastguard Worker {
26*25da2beaSAndroid Build Coastguard Worker pthread_mutex_lock(&mutex);
27*25da2beaSAndroid Build Coastguard Worker *var = 1;
28*25da2beaSAndroid Build Coastguard Worker pthread_cond_signal(&cond);
29*25da2beaSAndroid Build Coastguard Worker pthread_mutex_unlock(&mutex);
30*25da2beaSAndroid Build Coastguard Worker }
31*25da2beaSAndroid Build Coastguard Worker
wait_for_var(int * var)32*25da2beaSAndroid Build Coastguard Worker static void wait_for_var(int *var)
33*25da2beaSAndroid Build Coastguard Worker {
34*25da2beaSAndroid Build Coastguard Worker pthread_mutex_lock(&mutex);
35*25da2beaSAndroid Build Coastguard Worker
36*25da2beaSAndroid Build Coastguard Worker while (!*var)
37*25da2beaSAndroid Build Coastguard Worker pthread_cond_wait(&cond, &mutex);
38*25da2beaSAndroid Build Coastguard Worker
39*25da2beaSAndroid Build Coastguard Worker pthread_mutex_unlock(&mutex);
40*25da2beaSAndroid Build Coastguard Worker }
41*25da2beaSAndroid Build Coastguard Worker
42*25da2beaSAndroid Build Coastguard Worker struct data {
43*25da2beaSAndroid Build Coastguard Worker unsigned expected[2];
44*25da2beaSAndroid Build Coastguard Worker unsigned is_mask[2];
45*25da2beaSAndroid Build Coastguard Worker unsigned long timeout;
46*25da2beaSAndroid Build Coastguard Worker unsigned short port;
47*25da2beaSAndroid Build Coastguard Worker unsigned int addr;
48*25da2beaSAndroid Build Coastguard Worker int stop;
49*25da2beaSAndroid Build Coastguard Worker };
50*25da2beaSAndroid Build Coastguard Worker
send_thread(void * arg)51*25da2beaSAndroid Build Coastguard Worker static void *send_thread(void *arg)
52*25da2beaSAndroid Build Coastguard Worker {
53*25da2beaSAndroid Build Coastguard Worker struct data *data = arg;
54*25da2beaSAndroid Build Coastguard Worker
55*25da2beaSAndroid Build Coastguard Worker wait_for_var(&recv_thread_ready);
56*25da2beaSAndroid Build Coastguard Worker
57*25da2beaSAndroid Build Coastguard Worker int s0 = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
58*25da2beaSAndroid Build Coastguard Worker assert(s0 != -1);
59*25da2beaSAndroid Build Coastguard Worker
60*25da2beaSAndroid Build Coastguard Worker struct sockaddr_in addr;
61*25da2beaSAndroid Build Coastguard Worker
62*25da2beaSAndroid Build Coastguard Worker addr.sin_family = AF_INET;
63*25da2beaSAndroid Build Coastguard Worker addr.sin_port = data->port;
64*25da2beaSAndroid Build Coastguard Worker addr.sin_addr.s_addr = data->addr;
65*25da2beaSAndroid Build Coastguard Worker
66*25da2beaSAndroid Build Coastguard Worker if (connect(s0, (struct sockaddr*)&addr, sizeof(addr)) != -1)
67*25da2beaSAndroid Build Coastguard Worker wait_for_var(&recv_thread_done);
68*25da2beaSAndroid Build Coastguard Worker
69*25da2beaSAndroid Build Coastguard Worker close(s0);
70*25da2beaSAndroid Build Coastguard Worker return 0;
71*25da2beaSAndroid Build Coastguard Worker }
72*25da2beaSAndroid Build Coastguard Worker
recv_thread(void * arg)73*25da2beaSAndroid Build Coastguard Worker void *recv_thread(void *arg)
74*25da2beaSAndroid Build Coastguard Worker {
75*25da2beaSAndroid Build Coastguard Worker struct data *data = arg;
76*25da2beaSAndroid Build Coastguard Worker struct io_uring_sqe *sqe;
77*25da2beaSAndroid Build Coastguard Worker struct io_uring ring;
78*25da2beaSAndroid Build Coastguard Worker int i, ret;
79*25da2beaSAndroid Build Coastguard Worker
80*25da2beaSAndroid Build Coastguard Worker ret = io_uring_queue_init(8, &ring, 0);
81*25da2beaSAndroid Build Coastguard Worker assert(ret == 0);
82*25da2beaSAndroid Build Coastguard Worker
83*25da2beaSAndroid Build Coastguard Worker int s0 = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
84*25da2beaSAndroid Build Coastguard Worker assert(s0 != -1);
85*25da2beaSAndroid Build Coastguard Worker
86*25da2beaSAndroid Build Coastguard Worker int32_t val = 1;
87*25da2beaSAndroid Build Coastguard Worker ret = setsockopt(s0, SOL_SOCKET, SO_REUSEPORT, &val, sizeof(val));
88*25da2beaSAndroid Build Coastguard Worker assert(ret != -1);
89*25da2beaSAndroid Build Coastguard Worker ret = setsockopt(s0, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(val));
90*25da2beaSAndroid Build Coastguard Worker assert(ret != -1);
91*25da2beaSAndroid Build Coastguard Worker
92*25da2beaSAndroid Build Coastguard Worker struct sockaddr_in addr;
93*25da2beaSAndroid Build Coastguard Worker
94*25da2beaSAndroid Build Coastguard Worker addr.sin_family = AF_INET;
95*25da2beaSAndroid Build Coastguard Worker data->addr = inet_addr("127.0.0.1");
96*25da2beaSAndroid Build Coastguard Worker addr.sin_addr.s_addr = data->addr;
97*25da2beaSAndroid Build Coastguard Worker
98*25da2beaSAndroid Build Coastguard Worker i = 0;
99*25da2beaSAndroid Build Coastguard Worker do {
100*25da2beaSAndroid Build Coastguard Worker data->port = htons(1025 + (rand() % 64510));
101*25da2beaSAndroid Build Coastguard Worker addr.sin_port = data->port;
102*25da2beaSAndroid Build Coastguard Worker
103*25da2beaSAndroid Build Coastguard Worker if (bind(s0, (struct sockaddr*)&addr, sizeof(addr)) != -1)
104*25da2beaSAndroid Build Coastguard Worker break;
105*25da2beaSAndroid Build Coastguard Worker } while (++i < 100);
106*25da2beaSAndroid Build Coastguard Worker
107*25da2beaSAndroid Build Coastguard Worker if (i >= 100) {
108*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "Can't find good port, skipped\n");
109*25da2beaSAndroid Build Coastguard Worker data->stop = 1;
110*25da2beaSAndroid Build Coastguard Worker signal_var(&recv_thread_ready);
111*25da2beaSAndroid Build Coastguard Worker goto out;
112*25da2beaSAndroid Build Coastguard Worker }
113*25da2beaSAndroid Build Coastguard Worker
114*25da2beaSAndroid Build Coastguard Worker ret = listen(s0, 128);
115*25da2beaSAndroid Build Coastguard Worker assert(ret != -1);
116*25da2beaSAndroid Build Coastguard Worker
117*25da2beaSAndroid Build Coastguard Worker signal_var(&recv_thread_ready);
118*25da2beaSAndroid Build Coastguard Worker
119*25da2beaSAndroid Build Coastguard Worker sqe = io_uring_get_sqe(&ring);
120*25da2beaSAndroid Build Coastguard Worker assert(sqe != NULL);
121*25da2beaSAndroid Build Coastguard Worker
122*25da2beaSAndroid Build Coastguard Worker io_uring_prep_poll_add(sqe, s0, POLLIN | POLLHUP | POLLERR);
123*25da2beaSAndroid Build Coastguard Worker sqe->flags |= IOSQE_IO_LINK;
124*25da2beaSAndroid Build Coastguard Worker sqe->user_data = 1;
125*25da2beaSAndroid Build Coastguard Worker
126*25da2beaSAndroid Build Coastguard Worker sqe = io_uring_get_sqe(&ring);
127*25da2beaSAndroid Build Coastguard Worker assert(sqe != NULL);
128*25da2beaSAndroid Build Coastguard Worker
129*25da2beaSAndroid Build Coastguard Worker struct __kernel_timespec ts;
130*25da2beaSAndroid Build Coastguard Worker ts.tv_sec = data->timeout / 1000000000;
131*25da2beaSAndroid Build Coastguard Worker ts.tv_nsec = data->timeout % 1000000000;
132*25da2beaSAndroid Build Coastguard Worker io_uring_prep_link_timeout(sqe, &ts, 0);
133*25da2beaSAndroid Build Coastguard Worker sqe->user_data = 2;
134*25da2beaSAndroid Build Coastguard Worker
135*25da2beaSAndroid Build Coastguard Worker ret = io_uring_submit(&ring);
136*25da2beaSAndroid Build Coastguard Worker assert(ret == 2);
137*25da2beaSAndroid Build Coastguard Worker
138*25da2beaSAndroid Build Coastguard Worker for (i = 0; i < 2; i++) {
139*25da2beaSAndroid Build Coastguard Worker struct io_uring_cqe *cqe;
140*25da2beaSAndroid Build Coastguard Worker int idx;
141*25da2beaSAndroid Build Coastguard Worker
142*25da2beaSAndroid Build Coastguard Worker if (io_uring_wait_cqe(&ring, &cqe)) {
143*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "wait cqe failed\n");
144*25da2beaSAndroid Build Coastguard Worker goto err;
145*25da2beaSAndroid Build Coastguard Worker }
146*25da2beaSAndroid Build Coastguard Worker idx = cqe->user_data - 1;
147*25da2beaSAndroid Build Coastguard Worker if (data->is_mask[idx] && !(data->expected[idx] & cqe->res)) {
148*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "cqe %" PRIu64 " got %x, wanted mask %x\n",
149*25da2beaSAndroid Build Coastguard Worker (uint64_t) cqe->user_data, cqe->res,
150*25da2beaSAndroid Build Coastguard Worker data->expected[idx]);
151*25da2beaSAndroid Build Coastguard Worker goto err;
152*25da2beaSAndroid Build Coastguard Worker } else if (!data->is_mask[idx] && cqe->res != data->expected[idx]) {
153*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "cqe %" PRIu64 " got %d, wanted %d\n",
154*25da2beaSAndroid Build Coastguard Worker (uint64_t) cqe->user_data, cqe->res,
155*25da2beaSAndroid Build Coastguard Worker data->expected[idx]);
156*25da2beaSAndroid Build Coastguard Worker goto err;
157*25da2beaSAndroid Build Coastguard Worker }
158*25da2beaSAndroid Build Coastguard Worker io_uring_cqe_seen(&ring, cqe);
159*25da2beaSAndroid Build Coastguard Worker }
160*25da2beaSAndroid Build Coastguard Worker
161*25da2beaSAndroid Build Coastguard Worker out:
162*25da2beaSAndroid Build Coastguard Worker signal_var(&recv_thread_done);
163*25da2beaSAndroid Build Coastguard Worker close(s0);
164*25da2beaSAndroid Build Coastguard Worker io_uring_queue_exit(&ring);
165*25da2beaSAndroid Build Coastguard Worker return NULL;
166*25da2beaSAndroid Build Coastguard Worker err:
167*25da2beaSAndroid Build Coastguard Worker signal_var(&recv_thread_done);
168*25da2beaSAndroid Build Coastguard Worker close(s0);
169*25da2beaSAndroid Build Coastguard Worker io_uring_queue_exit(&ring);
170*25da2beaSAndroid Build Coastguard Worker return (void *) 1;
171*25da2beaSAndroid Build Coastguard Worker }
172*25da2beaSAndroid Build Coastguard Worker
test_poll_timeout(int do_connect,unsigned long timeout)173*25da2beaSAndroid Build Coastguard Worker static int test_poll_timeout(int do_connect, unsigned long timeout)
174*25da2beaSAndroid Build Coastguard Worker {
175*25da2beaSAndroid Build Coastguard Worker pthread_t t1, t2;
176*25da2beaSAndroid Build Coastguard Worker struct data d;
177*25da2beaSAndroid Build Coastguard Worker void *tret;
178*25da2beaSAndroid Build Coastguard Worker int ret = 0;
179*25da2beaSAndroid Build Coastguard Worker
180*25da2beaSAndroid Build Coastguard Worker recv_thread_ready = 0;
181*25da2beaSAndroid Build Coastguard Worker recv_thread_done = 0;
182*25da2beaSAndroid Build Coastguard Worker
183*25da2beaSAndroid Build Coastguard Worker memset(&d, 0, sizeof(d));
184*25da2beaSAndroid Build Coastguard Worker d.timeout = timeout;
185*25da2beaSAndroid Build Coastguard Worker if (!do_connect) {
186*25da2beaSAndroid Build Coastguard Worker d.expected[0] = -ECANCELED;
187*25da2beaSAndroid Build Coastguard Worker d.expected[1] = -ETIME;
188*25da2beaSAndroid Build Coastguard Worker } else {
189*25da2beaSAndroid Build Coastguard Worker d.expected[0] = POLLIN;
190*25da2beaSAndroid Build Coastguard Worker d.is_mask[0] = 1;
191*25da2beaSAndroid Build Coastguard Worker d.expected[1] = -ECANCELED;
192*25da2beaSAndroid Build Coastguard Worker }
193*25da2beaSAndroid Build Coastguard Worker
194*25da2beaSAndroid Build Coastguard Worker pthread_create(&t1, NULL, recv_thread, &d);
195*25da2beaSAndroid Build Coastguard Worker
196*25da2beaSAndroid Build Coastguard Worker if (do_connect)
197*25da2beaSAndroid Build Coastguard Worker pthread_create(&t2, NULL, send_thread, &d);
198*25da2beaSAndroid Build Coastguard Worker
199*25da2beaSAndroid Build Coastguard Worker pthread_join(t1, &tret);
200*25da2beaSAndroid Build Coastguard Worker if (tret)
201*25da2beaSAndroid Build Coastguard Worker ret++;
202*25da2beaSAndroid Build Coastguard Worker
203*25da2beaSAndroid Build Coastguard Worker if (do_connect) {
204*25da2beaSAndroid Build Coastguard Worker pthread_join(t2, &tret);
205*25da2beaSAndroid Build Coastguard Worker if (tret)
206*25da2beaSAndroid Build Coastguard Worker ret++;
207*25da2beaSAndroid Build Coastguard Worker }
208*25da2beaSAndroid Build Coastguard Worker
209*25da2beaSAndroid Build Coastguard Worker return ret;
210*25da2beaSAndroid Build Coastguard Worker }
211*25da2beaSAndroid Build Coastguard Worker
main(int argc,char * argv[])212*25da2beaSAndroid Build Coastguard Worker int main(int argc, char *argv[])
213*25da2beaSAndroid Build Coastguard Worker {
214*25da2beaSAndroid Build Coastguard Worker if (argc > 1)
215*25da2beaSAndroid Build Coastguard Worker return 0;
216*25da2beaSAndroid Build Coastguard Worker
217*25da2beaSAndroid Build Coastguard Worker srand(getpid());
218*25da2beaSAndroid Build Coastguard Worker
219*25da2beaSAndroid Build Coastguard Worker if (test_poll_timeout(0, 200000000)) {
220*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "poll timeout 0 failed\n");
221*25da2beaSAndroid Build Coastguard Worker return 1;
222*25da2beaSAndroid Build Coastguard Worker }
223*25da2beaSAndroid Build Coastguard Worker
224*25da2beaSAndroid Build Coastguard Worker if (test_poll_timeout(1, 1000000000)) {
225*25da2beaSAndroid Build Coastguard Worker fprintf(stderr, "poll timeout 1 failed\n");
226*25da2beaSAndroid Build Coastguard Worker return 1;
227*25da2beaSAndroid Build Coastguard Worker }
228*25da2beaSAndroid Build Coastguard Worker
229*25da2beaSAndroid Build Coastguard Worker return 0;
230*25da2beaSAndroid Build Coastguard Worker }
231