1*4f1223e8SApple OSS Distributions /*
2*4f1223e8SApple OSS Distributions * Copyright (c) 2021-2022 Apple Inc. All rights reserved.
3*4f1223e8SApple OSS Distributions *
4*4f1223e8SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*4f1223e8SApple OSS Distributions *
6*4f1223e8SApple OSS Distributions * This file contains Original Code and/or Modifications of Original Code
7*4f1223e8SApple OSS Distributions * as defined in and that are subject to the Apple Public Source License
8*4f1223e8SApple OSS Distributions * Version 2.0 (the 'License'). You may not use this file except in
9*4f1223e8SApple OSS Distributions * compliance with the License. The rights granted to you under the License
10*4f1223e8SApple OSS Distributions * may not be used to create, or enable the creation or redistribution of,
11*4f1223e8SApple OSS Distributions * unlawful or unlicensed copies of an Apple operating system, or to
12*4f1223e8SApple OSS Distributions * circumvent, violate, or enable the circumvention or violation of, any
13*4f1223e8SApple OSS Distributions * terms of an Apple operating system software license agreement.
14*4f1223e8SApple OSS Distributions *
15*4f1223e8SApple OSS Distributions * Please obtain a copy of the License at
16*4f1223e8SApple OSS Distributions * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*4f1223e8SApple OSS Distributions *
18*4f1223e8SApple OSS Distributions * The Original Code and all software distributed under the License are
19*4f1223e8SApple OSS Distributions * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*4f1223e8SApple OSS Distributions * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*4f1223e8SApple OSS Distributions * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*4f1223e8SApple OSS Distributions * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*4f1223e8SApple OSS Distributions * Please see the License for the specific language governing rights and
24*4f1223e8SApple OSS Distributions * limitations under the License.
25*4f1223e8SApple OSS Distributions *
26*4f1223e8SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*4f1223e8SApple OSS Distributions */
28*4f1223e8SApple OSS Distributions
29*4f1223e8SApple OSS Distributions #define __APPLE_USE_RFC_3542 1
30*4f1223e8SApple OSS Distributions #include <stdio.h>
31*4f1223e8SApple OSS Distributions #include <stdlib.h>
32*4f1223e8SApple OSS Distributions #include <string.h>
33*4f1223e8SApple OSS Distributions #include <sys/types.h>
34*4f1223e8SApple OSS Distributions #include <sys/errno.h>
35*4f1223e8SApple OSS Distributions #include <sys/socket.h>
36*4f1223e8SApple OSS Distributions #include <sys/sysctl.h>
37*4f1223e8SApple OSS Distributions #include <sys/event.h>
38*4f1223e8SApple OSS Distributions #include <sys/time.h>
39*4f1223e8SApple OSS Distributions #include <arpa/inet.h>
40*4f1223e8SApple OSS Distributions #include <netdb.h>
41*4f1223e8SApple OSS Distributions #include <semaphore.h>
42*4f1223e8SApple OSS Distributions #include <darwintest.h>
43*4f1223e8SApple OSS Distributions
44*4f1223e8SApple OSS Distributions #define LOGSOCKOPT(x) { \
45*4f1223e8SApple OSS Distributions int __retv = (x); \
46*4f1223e8SApple OSS Distributions if (__retv == -1) { \
47*4f1223e8SApple OSS Distributions T_LOG("[:(] SETSOCKOPT FAILED: %s = -1, errno = %d\n", #x, errno); \
48*4f1223e8SApple OSS Distributions } \
49*4f1223e8SApple OSS Distributions }
50*4f1223e8SApple OSS Distributions
51*4f1223e8SApple OSS Distributions #define LISTENER_PORT 9999
52*4f1223e8SApple OSS Distributions
53*4f1223e8SApple OSS Distributions void do_kqueue(int kq, int sockfd);
54*4f1223e8SApple OSS Distributions void handle_recv(struct msghdr *recvmsghdr, int packet_len);
55*4f1223e8SApple OSS Distributions
56*4f1223e8SApple OSS Distributions sem_t mutex;
57*4f1223e8SApple OSS Distributions
58*4f1223e8SApple OSS Distributions static void *
listener_thread(void * unused)59*4f1223e8SApple OSS Distributions listener_thread(void *unused)
60*4f1223e8SApple OSS Distributions {
61*4f1223e8SApple OSS Distributions int sockfd;
62*4f1223e8SApple OSS Distributions int clientlen;
63*4f1223e8SApple OSS Distributions struct sockaddr_in serveraddr;
64*4f1223e8SApple OSS Distributions struct sockaddr_in clientaddr;
65*4f1223e8SApple OSS Distributions struct hostent *hostp;
66*4f1223e8SApple OSS Distributions char *buf;
67*4f1223e8SApple OSS Distributions char *hostaddrp;
68*4f1223e8SApple OSS Distributions int optval;
69*4f1223e8SApple OSS Distributions int n;
70*4f1223e8SApple OSS Distributions
71*4f1223e8SApple OSS Distributions sockfd = socket(AF_INET, SOCK_DGRAM, 0);
72*4f1223e8SApple OSS Distributions if (sockfd < 0) {
73*4f1223e8SApple OSS Distributions T_SKIP("cannot open listener sock");
74*4f1223e8SApple OSS Distributions }
75*4f1223e8SApple OSS Distributions
76*4f1223e8SApple OSS Distributions bzero((char *)&serveraddr, sizeof(serveraddr));
77*4f1223e8SApple OSS Distributions serveraddr.sin_family = AF_INET;
78*4f1223e8SApple OSS Distributions serveraddr.sin_addr.s_addr = htonl(INADDR_ANY);
79*4f1223e8SApple OSS Distributions serveraddr.sin_port = htons((unsigned short)LISTENER_PORT);
80*4f1223e8SApple OSS Distributions serveraddr.sin_len = sizeof(struct sockaddr_in);
81*4f1223e8SApple OSS Distributions
82*4f1223e8SApple OSS Distributions if (bind(sockfd, (struct sockaddr *)&serveraddr,
83*4f1223e8SApple OSS Distributions sizeof(serveraddr)) < 0) {
84*4f1223e8SApple OSS Distributions T_SKIP("ERROR on binding");
85*4f1223e8SApple OSS Distributions }
86*4f1223e8SApple OSS Distributions
87*4f1223e8SApple OSS Distributions clientlen = sizeof(clientaddr);
88*4f1223e8SApple OSS Distributions buf = malloc(5);
89*4f1223e8SApple OSS Distributions T_LOG("listener started \n");
90*4f1223e8SApple OSS Distributions sem_post(&mutex);
91*4f1223e8SApple OSS Distributions
92*4f1223e8SApple OSS Distributions while (1) {
93*4f1223e8SApple OSS Distributions n = recvfrom(sockfd, buf, 5, 0,
94*4f1223e8SApple OSS Distributions (struct sockaddr *)&clientaddr, &clientlen);
95*4f1223e8SApple OSS Distributions if (n < 0) {
96*4f1223e8SApple OSS Distributions T_SKIP("ERROR in recvfrom");
97*4f1223e8SApple OSS Distributions }
98*4f1223e8SApple OSS Distributions T_LOG("received from sender: %.5s", buf);
99*4f1223e8SApple OSS Distributions
100*4f1223e8SApple OSS Distributions
101*4f1223e8SApple OSS Distributions hostp = gethostbyaddr((const char *)&clientaddr.sin_addr.s_addr,
102*4f1223e8SApple OSS Distributions sizeof(clientaddr.sin_addr.s_addr),
103*4f1223e8SApple OSS Distributions AF_INET);
104*4f1223e8SApple OSS Distributions if (hostp == NULL) {
105*4f1223e8SApple OSS Distributions T_SKIP("ERROR on gethostbyaddr");
106*4f1223e8SApple OSS Distributions }
107*4f1223e8SApple OSS Distributions hostaddrp = inet_ntoa(clientaddr.sin_addr);
108*4f1223e8SApple OSS Distributions if (hostaddrp == NULL) {
109*4f1223e8SApple OSS Distributions T_SKIP("ERROR on inet_ntoa\n");
110*4f1223e8SApple OSS Distributions }
111*4f1223e8SApple OSS Distributions
112*4f1223e8SApple OSS Distributions n = sendto(sockfd, buf, n, 0,
113*4f1223e8SApple OSS Distributions (struct sockaddr *)&clientaddr, clientlen);
114*4f1223e8SApple OSS Distributions if (n < 0) {
115*4f1223e8SApple OSS Distributions T_SKIP("ERROR in sendto");
116*4f1223e8SApple OSS Distributions }
117*4f1223e8SApple OSS Distributions T_LOG("sent response to sender");
118*4f1223e8SApple OSS Distributions }
119*4f1223e8SApple OSS Distributions }
120*4f1223e8SApple OSS Distributions
121*4f1223e8SApple OSS Distributions T_DECL(v4mappedv6_recvpktinfo, "Test setting and using IPV6_RECVPKTINFO on a v4-mapped-v6 address socket", T_META_TAG_VM_PREFERRED)
122*4f1223e8SApple OSS Distributions {
123*4f1223e8SApple OSS Distributions pthread_t t;
124*4f1223e8SApple OSS Distributions sem_init(&mutex, 0, 1);
125*4f1223e8SApple OSS Distributions int error = pthread_create(&t, NULL, &listener_thread, NULL);
126*4f1223e8SApple OSS Distributions if (error != 0) {
127*4f1223e8SApple OSS Distributions T_SKIP("cannot start listener thread");
128*4f1223e8SApple OSS Distributions }
129*4f1223e8SApple OSS Distributions
130*4f1223e8SApple OSS Distributions sem_wait(&mutex);
131*4f1223e8SApple OSS Distributions
132*4f1223e8SApple OSS Distributions struct sockaddr_in6 local_addr = { .sin6_family = AF_INET6, .sin6_len = sizeof(struct sockaddr_in6) };
133*4f1223e8SApple OSS Distributions struct sockaddr_in6 remote_addr = { };
134*4f1223e8SApple OSS Distributions
135*4f1223e8SApple OSS Distributions int sockfd = socket(AF_INET6, SOCK_DGRAM, 0);
136*4f1223e8SApple OSS Distributions if (sockfd == -1) {
137*4f1223e8SApple OSS Distributions T_SKIP("Couldn't create socket. errno = %d\n", errno);
138*4f1223e8SApple OSS Distributions }
139*4f1223e8SApple OSS Distributions
140*4f1223e8SApple OSS Distributions int Option = 0;
141*4f1223e8SApple OSS Distributions LOGSOCKOPT(setsockopt(sockfd, IPPROTO_IPV6, IPV6_V6ONLY, &Option, sizeof(Option)));
142*4f1223e8SApple OSS Distributions
143*4f1223e8SApple OSS Distributions Option = 1;
144*4f1223e8SApple OSS Distributions LOGSOCKOPT(setsockopt(sockfd, IPPROTO_IPV6, IPV6_RECVPKTINFO, &Option, sizeof(Option)));
145*4f1223e8SApple OSS Distributions
146*4f1223e8SApple OSS Distributions int ret = bind(sockfd, (const struct sockaddr *)&local_addr, sizeof(local_addr));
147*4f1223e8SApple OSS Distributions if (ret == -1) {
148*4f1223e8SApple OSS Distributions T_SKIP("Couldn't bind. errno = %d\n", ret);
149*4f1223e8SApple OSS Distributions }
150*4f1223e8SApple OSS Distributions
151*4f1223e8SApple OSS Distributions struct in_addr v4addr = {
152*4f1223e8SApple OSS Distributions .s_addr = htonl(INADDR_LOOPBACK)
153*4f1223e8SApple OSS Distributions };
154*4f1223e8SApple OSS Distributions
155*4f1223e8SApple OSS Distributions // map v4 to v6
156*4f1223e8SApple OSS Distributions remote_addr.sin6_family = AF_INET6;
157*4f1223e8SApple OSS Distributions remote_addr.sin6_port = htons(LISTENER_PORT);
158*4f1223e8SApple OSS Distributions remote_addr.sin6_len = sizeof(struct sockaddr_in6);
159*4f1223e8SApple OSS Distributions memset(&(remote_addr.sin6_addr.s6_addr[10]), 0xff, 2);
160*4f1223e8SApple OSS Distributions memcpy(&(remote_addr.sin6_addr.s6_addr[12]), &v4addr.s_addr, 4);
161*4f1223e8SApple OSS Distributions
162*4f1223e8SApple OSS Distributions // now remote_addr is a v4-mapped v6 address
163*4f1223e8SApple OSS Distributions ret = connect(sockfd, (const struct sockaddr *)&remote_addr, sizeof(remote_addr));
164*4f1223e8SApple OSS Distributions
165*4f1223e8SApple OSS Distributions if (ret == -1) {
166*4f1223e8SApple OSS Distributions T_SKIP("Couldn't connect. ret = %d, errno = %d\n", ret, errno);
167*4f1223e8SApple OSS Distributions }
168*4f1223e8SApple OSS Distributions
169*4f1223e8SApple OSS Distributions T_LOG("Socket established. Binded & connected.\n");
170*4f1223e8SApple OSS Distributions
171*4f1223e8SApple OSS Distributions int kq = kqueue();
172*4f1223e8SApple OSS Distributions
173*4f1223e8SApple OSS Distributions if (kq == -1) {
174*4f1223e8SApple OSS Distributions T_SKIP("Failed to kqueue. errno = %d\n", errno);
175*4f1223e8SApple OSS Distributions }
176*4f1223e8SApple OSS Distributions
177*4f1223e8SApple OSS Distributions // add fd to kqueue
178*4f1223e8SApple OSS Distributions struct kevent evSet = { };
179*4f1223e8SApple OSS Distributions EV_SET(&evSet, sockfd, EVFILT_READ, EV_ADD | EV_CLEAR, 0, 0, (void *)NULL);
180*4f1223e8SApple OSS Distributions if (kevent(kq, &evSet, 1, NULL, 0, NULL) < 0) {
181*4f1223e8SApple OSS Distributions T_SKIP("kevent failed??\n");
182*4f1223e8SApple OSS Distributions }
183*4f1223e8SApple OSS Distributions
184*4f1223e8SApple OSS Distributions // send pkt to notify remote
185*4f1223e8SApple OSS Distributions sendto(sockfd, "ping", 4, 0, NULL, 0);
186*4f1223e8SApple OSS Distributions do_kqueue(kq, sockfd);
187*4f1223e8SApple OSS Distributions }
188*4f1223e8SApple OSS Distributions
189*4f1223e8SApple OSS Distributions void
do_kqueue(int kq,int sockfd)190*4f1223e8SApple OSS Distributions do_kqueue(int kq, int sockfd)
191*4f1223e8SApple OSS Distributions {
192*4f1223e8SApple OSS Distributions int ret = 0;
193*4f1223e8SApple OSS Distributions
194*4f1223e8SApple OSS Distributions char control_space[CMSG_SPACE(8192)] = {};
195*4f1223e8SApple OSS Distributions struct msghdr recvmsghdr = {};
196*4f1223e8SApple OSS Distributions char packet_space[1500] = {};
197*4f1223e8SApple OSS Distributions
198*4f1223e8SApple OSS Distributions struct iovec recv_iov;
199*4f1223e8SApple OSS Distributions recv_iov.iov_len = 1200; // just a safe buffer from the 1500 mut
200*4f1223e8SApple OSS Distributions recv_iov.iov_base = &packet_space;
201*4f1223e8SApple OSS Distributions
202*4f1223e8SApple OSS Distributions recvmsghdr.msg_iov = &recv_iov;
203*4f1223e8SApple OSS Distributions recvmsghdr.msg_iovlen = 1;
204*4f1223e8SApple OSS Distributions recvmsghdr.msg_control = &control_space;
205*4f1223e8SApple OSS Distributions recvmsghdr.msg_controllen = sizeof(control_space);
206*4f1223e8SApple OSS Distributions recvmsghdr.msg_flags = 0;
207*4f1223e8SApple OSS Distributions
208*4f1223e8SApple OSS Distributions struct kevent evSet;
209*4f1223e8SApple OSS Distributions struct kevent evList[32];
210*4f1223e8SApple OSS Distributions
211*4f1223e8SApple OSS Distributions struct timespec timeout;
212*4f1223e8SApple OSS Distributions timeout.tv_sec = 10;
213*4f1223e8SApple OSS Distributions timeout.tv_nsec = 0;
214*4f1223e8SApple OSS Distributions
215*4f1223e8SApple OSS Distributions int nev = kevent(kq, NULL, 0, evList, 32, &timeout);
216*4f1223e8SApple OSS Distributions
217*4f1223e8SApple OSS Distributions for (int i = 0; i < nev; i++) {
218*4f1223e8SApple OSS Distributions T_LOG("[kevent] ident = %zd, filter = %hu, flags = %hd, fflags = %d, data = %zd, udata = %p\n",
219*4f1223e8SApple OSS Distributions evList[i].ident, evList[i].filter, evList[i].flags, evList[i].fflags, evList[i].data, evList[i].udata);
220*4f1223e8SApple OSS Distributions
221*4f1223e8SApple OSS Distributions if (evList[i].filter == EVFILT_READ) {
222*4f1223e8SApple OSS Distributions ret = recvmsg(sockfd, &recvmsghdr, 0);
223*4f1223e8SApple OSS Distributions if (ret != -1) {
224*4f1223e8SApple OSS Distributions handle_recv(&recvmsghdr, ret);
225*4f1223e8SApple OSS Distributions } else {
226*4f1223e8SApple OSS Distributions T_SKIP("sender recv failed");
227*4f1223e8SApple OSS Distributions }
228*4f1223e8SApple OSS Distributions return;
229*4f1223e8SApple OSS Distributions }
230*4f1223e8SApple OSS Distributions }
231*4f1223e8SApple OSS Distributions
232*4f1223e8SApple OSS Distributions T_SKIP("timeout after 10s");
233*4f1223e8SApple OSS Distributions }
234*4f1223e8SApple OSS Distributions
235*4f1223e8SApple OSS Distributions void
handle_recv(struct msghdr * recvmsghdr,int packet_len)236*4f1223e8SApple OSS Distributions handle_recv(struct msghdr *recvmsghdr, int packet_len)
237*4f1223e8SApple OSS Distributions {
238*4f1223e8SApple OSS Distributions T_LOG("[!!] Received %d bytes...", packet_len);
239*4f1223e8SApple OSS Distributions
240*4f1223e8SApple OSS Distributions for (int i = 0; i < MIN(packet_len, 5); i++) {
241*4f1223e8SApple OSS Distributions T_LOG("%02x ", ((char *)recvmsghdr->msg_iov->iov_base)[i]);
242*4f1223e8SApple OSS Distributions }
243*4f1223e8SApple OSS Distributions
244*4f1223e8SApple OSS Distributions T_LOG("\n");
245*4f1223e8SApple OSS Distributions
246*4f1223e8SApple OSS Distributions struct cmsghdr *cmsg;
247*4f1223e8SApple OSS Distributions int received_cmsg_header = 0;
248*4f1223e8SApple OSS Distributions for (cmsg = CMSG_FIRSTHDR(recvmsghdr); cmsg != NULL; cmsg = CMSG_NXTHDR(recvmsghdr, cmsg)) {
249*4f1223e8SApple OSS Distributions // this never gets hit
250*4f1223e8SApple OSS Distributions T_LOG("cmsg_level: %d, cmsg_type: %d\n", cmsg->cmsg_level, cmsg->cmsg_type);
251*4f1223e8SApple OSS Distributions received_cmsg_header = 1;
252*4f1223e8SApple OSS Distributions }
253*4f1223e8SApple OSS Distributions
254*4f1223e8SApple OSS Distributions T_EXPECT_TRUE(received_cmsg_header == 1, "recved cmsg hdr");
255*4f1223e8SApple OSS Distributions T_PASS("Recvd cmsg hdr");
256*4f1223e8SApple OSS Distributions }
257