programs/ekr_loop_upcall.c - platform/external/usrsctp - Git at Google

 /*
  * Copyright (C) 2011-2013 Michael Tuexen
  * Copyright (C) 2018-2018 Felix Weinrank
  *
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
  * 1. Redistributions of source code must retain the above copyright
  *    notice, this list of conditions and the following disclaimer.
  * 2. Redistributions in binary form must reproduce the above copyright
  *    notice, this list of conditions and the following disclaimer in the
  *    documentation and/or other materials provided with the distribution.
  * 3. Neither the name of the project nor the names of its contributors
  *    may be used to endorse or promote products derived from this software
  *    without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  * ARE DISCLAIMED.	IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  * SUCH DAMAGE.
  */

 #ifdef _WIN32
 #define _CRT_SECURE_NO_WARNINGS
 #endif
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
 #include <stdarg.h>
 #include <sys/types.h>
 #ifndef _WIN32
 #include <sys/socket.h>
 #include <netinet/in.h>
 #include <arpa/inet.h>
 #include <errno.h>
 #include <pthread.h>
 #include <unistd.h>
 #else
 #include <winsock2.h>
 #include <ws2tcpip.h>
 #endif
 #include <usrsctp.h>
 #include "programs_helper.h"

 #define MAX_PACKET_SIZE (1<<16)
 #define LINE_LENGTH (1<<20)
 #define DISCARD_PPID 39
 /* #define DUMP_PKTS_TO_FILE */

 #ifdef _WIN32
 static DWORD WINAPI
 #else
 static void *
 #endif
 handle_packets(void *arg)
 {
 #ifdef _WIN32
 	SOCKET *fdp;
 #else
 	int *fdp;
 #endif
 	char *dump_buf;
 	ssize_t length;
 	char buf[MAX_PACKET_SIZE];

 #ifdef _WIN32
 	fdp = (SOCKET *)arg;
 #else
 	fdp = (int *)arg;
 #endif
 	for (;;) {
 #if defined(__NetBSD__)
 		pthread_testcancel();
 #endif
 		length = recv(*fdp, buf, MAX_PACKET_SIZE, 0);
 		if (length > 0) {
 			if ((dump_buf = usrsctp_dumppacket(buf, (size_t)length, SCTP_DUMP_INBOUND)) != NULL) {
 				/* fprintf(stderr, "%s", dump_buf); */
 				usrsctp_freedumpbuffer(dump_buf);
 			}
 			usrsctp_conninput(fdp, buf, (size_t)length, 0);
 		}
 	}
 #ifdef _WIN32
 	return 0;
 #else
 	return (NULL);
 #endif
 }

 static int
 conn_output(void *addr, void *buf, size_t length, uint8_t tos, uint8_t set_df)
 {
 	char *dump_buf;
 #ifdef _WIN32
 	SOCKET *fdp;
 #else
 	int *fdp;
 #endif

 #ifdef _WIN32
 	fdp = (SOCKET *)addr;
 #else
 	fdp = (int *)addr;
 #endif
 	if ((dump_buf = usrsctp_dumppacket(buf, length, SCTP_DUMP_OUTBOUND)) != NULL) {
 		/* fprintf(stderr, "%s", dump_buf); */
 		usrsctp_freedumpbuffer(dump_buf);
 	}

 #ifdef	DUMP_PKTS_TO_FILE
 	FILE *fp;
 	char fname[128];
 	static int pktnum = 0;
 	if (snprintf(fname, sizeof(fname), "pkt-%d", pktnum++) < 0) {
 		fname[0] = '\0';
 	}
 	fp = fopen(fname, "wb");
 	fwrite((char *)buf + 12, 1, length - 12, fp);
 	fclose(fp);
 #endif

 #ifdef _WIN32
 	if (send(*fdp, buf, (int)length, 0) == SOCKET_ERROR) {
 		return (WSAGetLastError());
 #else
 	if (send(*fdp, buf, length, 0) < 0) {
 		return (errno);
 #endif
 	} else {
 		return (0);
 	}
 }

 static void
 handle_upcall(struct socket *sock, void *data, int flgs)
 {
 	char *buf;
 	int events;

 	buf = malloc(MAX_PACKET_SIZE);

 	while ((events = usrsctp_get_events(sock)) && (events & SCTP_EVENT_READ)) {
 		struct sctp_recvv_rn rn;
 		ssize_t n;
 		union sctp_sockstore addr;
 		int flags = 0;
 		socklen_t len = (socklen_t)sizeof(addr);
 		unsigned int infotype = 0;
 		socklen_t infolen = sizeof(struct sctp_recvv_rn);
 		memset(&rn, 0, sizeof(struct sctp_recvv_rn));
 		n = usrsctp_recvv(sock, buf, MAX_PACKET_SIZE, (struct sockaddr *) &addr, &len, (void *)&rn, &infolen, &infotype, &flags);
 		if (n < 0) {
 			perror("usrsctp_recvv");
 			break;
 		} else if (n > 0) {
 			if (flags & MSG_NOTIFICATION) {
 				printf("Notification of length %d received.\n", (int)n);
 			} else {
 				printf("Message of length %d received via %p:%u on stream %u with SSN %u and TSN %u, PPID %u, context %u, flags %x.\n",
 				       (int)n,
 				       addr.sconn.sconn_addr,
 				       ntohs(addr.sconn.sconn_port),
 				       rn.recvv_rcvinfo.rcv_sid,
 				       rn.recvv_rcvinfo.rcv_ssn,
 				       rn.recvv_rcvinfo.rcv_tsn,
 				       ntohl(rn.recvv_rcvinfo.rcv_ppid),
 				       rn.recvv_rcvinfo.rcv_context,
 				       flags);
 			}
 		} else {
 			usrsctp_deregister_address(data);
 			usrsctp_close(sock);
 			break;
 		}
 	}
 	free(buf);

 	return;
 }

 #if 0
 static void
 print_addresses(struct socket *sock)
 {
 	int i, n;
 	struct sockaddr *addrs, *addr;

 	n = usrsctp_getladdrs(sock, 0, &addrs);
 	addr = addrs;
 	for (i = 0; i < n; i++) {
 		switch (addr->sa_family) {
 		case AF_INET:
 		{
 			struct sockaddr_in *sin;
 			char buf[INET_ADDRSTRLEN];
 			const char *name;

 			sin = (struct sockaddr_in *)addr;
 			name = inet_ntop(AF_INET, &sin->sin_addr, buf, INET_ADDRSTRLEN);
 			printf("%s:%d", name, ntohs(sin->sin_port));
 			break;
 		}
 		case AF_INET6:
 		{
 			struct sockaddr_in6 *sin6;
 			char buf[INET6_ADDRSTRLEN];
 			const char *name;

 			sin6 = (struct sockaddr_in6 *)addr;
 			name = inet_ntop(AF_INET6, &sin6->sin6_addr, buf, INET6_ADDRSTRLEN);
 			printf("%s:%d", name, ntohs(sin6->sin6_port));
 			break;
 		}
 		case AF_CONN:
 		{
 			struct sockaddr_conn *sconn;

 			sconn = (struct sockaddr_conn *)addr;
 			printf("%p:%d", sconn->sconn_addr, ntohs(sconn->sconn_port));
 			break;
 		}
 		default:
 			printf("Unknown family: %d", addr->sa_family);
 			break;
 		}
 		addr = (struct sockaddr *)((caddr_t)addr + addr->sa_len);
 		if (i != n - 1) {
 			printf(",");
 		}
 	}
 	if (n > 0) {
 		usrsctp_freeladdrs(addrs);
 	}
 	printf("<->");
 	n = usrsctp_getpaddrs(sock, 0, &addrs);
 	addr = addrs;
 	for (i = 0; i < n; i++) {
 		switch (addr->sa_family) {
 		case AF_INET:
 		{
 			struct sockaddr_in *sin;
 			char buf[INET_ADDRSTRLEN];
 			const char *name;

 			sin = (struct sockaddr_in *)addr;
 			name = inet_ntop(AF_INET, &sin->sin_addr, buf, INET_ADDRSTRLEN);
 			printf("%s:%d", name, ntohs(sin->sin_port));
 			break;
 		}
 		case AF_INET6:
 		{
 			struct sockaddr_in6 *sin6;
 			char buf[INET6_ADDRSTRLEN];
 			const char *name;

 			sin6 = (struct sockaddr_in6 *)addr;
 			name = inet_ntop(AF_INET6, &sin6->sin6_addr, buf, INET6_ADDRSTRLEN);
 			printf("%s:%d", name, ntohs(sin6->sin6_port));
 			break;
 		}
 		case AF_CONN:
 		{
 			struct sockaddr_conn *sconn;

 			sconn = (struct sockaddr_conn *)addr;
 			printf("%p:%d", sconn->sconn_addr, ntohs(sconn->sconn_port));
 			break;
 		}
 		default:
 			printf("Unknown family: %d", addr->sa_family);
 			break;
 		}
 		addr = (struct sockaddr *)((caddr_t)addr + addr->sa_len);
 		if (i != n - 1) {
 			printf(",");
 		}
 	}
 	if (n > 0) {
 		usrsctp_freepaddrs(addrs);
 	}
 	printf("\n");
 }
 #endif

 int
 main(int argc, char *argv[])
 {
 	struct sockaddr_in sin_s, sin_c;
 	struct sockaddr_conn sconn;
 #ifdef _WIN32
 	SOCKET fd_c, fd_s;
 #else
 	int fd_c, fd_s, rc;
 #endif
 	struct socket *s_c, *s_s, *s_l;
 #ifdef _WIN32
 	HANDLE tid_c, tid_s;
 #else
 	pthread_t tid_c, tid_s;
 #endif
 	int cur_buf_size, snd_buf_size, rcv_buf_size, on;
 	socklen_t opt_len;
 	struct sctp_sndinfo sndinfo;
 	char *line;
 #ifdef _WIN32
 	WSADATA wsaData;
 #endif
 	uint16_t client_port = 9900;
 	uint16_t server_port = 9901;

 	if (argc == 3) {
 		client_port = atoi(argv[1]);
 		server_port = atoi(argv[2]);
 	}

 #ifdef _WIN32
 	if (WSAStartup(MAKEWORD(2,2), &wsaData) != 0) {
 		fprintf(stderr, "WSAStartup failed\n");
 		exit (EXIT_FAILURE);
 	}
 #endif
 	usrsctp_init(0, conn_output, debug_printf_stack);
 	/* set up a connected UDP socket */
 #ifdef _WIN32
 	if ((fd_c = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) == INVALID_SOCKET) {
 		fprintf(stderr, "socket() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 	if ((fd_s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) == INVALID_SOCKET) {
 		fprintf(stderr, "socket() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 #else
 	if ((fd_c = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
 		perror("socket");
 		exit(EXIT_FAILURE);
 	}
 	if ((fd_s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
 		perror("socket");
 		exit(EXIT_FAILURE);
 	}
 #endif
 	memset(&sin_c, 0, sizeof(struct sockaddr_in));
 	sin_c.sin_family = AF_INET;
 #ifdef HAVE_SIN_LEN
 	sin_c.sin_len = sizeof(struct sockaddr_in);
 #endif
 	sin_c.sin_port = htons(client_port);
 	sin_c.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
 	memset(&sin_s, 0, sizeof(struct sockaddr_in));
 	sin_s.sin_family = AF_INET;
 #ifdef HAVE_SIN_LEN
 	sin_s.sin_len = sizeof(struct sockaddr_in);
 #endif
 	sin_s.sin_port = htons(server_port);
 	sin_s.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
 #ifdef _WIN32
 	if (bind(fd_c, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
 		fprintf(stderr, "bind() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 	if (bind(fd_s, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
 		fprintf(stderr, "bind() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 #else
 	if (bind(fd_c, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) < 0) {
 		perror("bind");
 		exit(EXIT_FAILURE);
 	}
 	if (bind(fd_s, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) < 0) {
 		perror("bind");
 		exit(EXIT_FAILURE);
 	}
 #endif
 #ifdef _WIN32
 	if (connect(fd_c, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
 		fprintf(stderr, "connect() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 	if (connect(fd_s, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
 		fprintf(stderr, "connect() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 #else
 	if (connect(fd_c, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) < 0) {
 		perror("connect");
 		exit(EXIT_FAILURE);
 	}
 	if (connect(fd_s, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) < 0) {
 		perror("connect");
 		exit(EXIT_FAILURE);
 	}
 #endif
 #ifdef _WIN32
 	if ((tid_c = CreateThread(NULL, 0, &handle_packets, (void *)&fd_c, 0, NULL)) == NULL) {
 		fprintf(stderr, "CreateThread() failed with error: %d\n", GetLastError());
 		exit(EXIT_FAILURE);
 	}
 	if ((tid_s = CreateThread(NULL, 0, &handle_packets, (void *)&fd_s, 0, NULL)) == NULL) {
 		fprintf(stderr, "CreateThread() failed with error: %d\n", GetLastError());
 		exit(EXIT_FAILURE);
 	}
 #else
 	if ((rc = pthread_create(&tid_c, NULL, &handle_packets, (void *)&fd_c)) != 0) {
 		fprintf(stderr, "pthread_create tid_c: %s\n", strerror(rc));
 		exit(EXIT_FAILURE);
 	}

 	if ((rc = pthread_create(&tid_s, NULL, &handle_packets, (void *)&fd_s)) != 0) {
 		fprintf(stderr, "pthread_create tid_s: %s\n", strerror(rc));
 		exit(EXIT_FAILURE);
 	};
 #endif
 #ifdef SCTP_DEBUG
 	usrsctp_sysctl_set_sctp_debug_on(SCTP_DEBUG_NONE);
 #endif
 	usrsctp_sysctl_set_sctp_ecn_enable(0);
 	usrsctp_register_address((void *)&fd_c);
 	usrsctp_register_address((void *)&fd_s);

 	if ((s_c = usrsctp_socket(AF_CONN, SOCK_STREAM, IPPROTO_SCTP, NULL, NULL, 0, NULL)) == NULL) {
 		perror("usrsctp_socket");
 		exit(EXIT_FAILURE);
 	}
 	usrsctp_set_upcall(s_c, handle_upcall, &fd_c);

 	opt_len = (socklen_t)sizeof(int);
 	cur_buf_size = 0;
 	if (usrsctp_getsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &cur_buf_size, &opt_len) < 0) {
 		perror("usrsctp_getsockopt");
 		exit(EXIT_FAILURE);
 	}
 	printf("Change send socket buffer size from %d ", cur_buf_size);
 	snd_buf_size = 1<<22; /* 4 MB */
 	if (usrsctp_setsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &snd_buf_size, sizeof(int)) < 0) {
 		perror("usrsctp_setsockopt");
 		exit(EXIT_FAILURE);
 	}
 	opt_len = (socklen_t)sizeof(int);
 	cur_buf_size = 0;
 	if (usrsctp_getsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &cur_buf_size, &opt_len) < 0) {
 		perror("usrsctp_getsockopt");
 		exit(EXIT_FAILURE);
 	}
 	printf("to %d.\n", cur_buf_size);
 	if ((s_l = usrsctp_socket(AF_CONN, SOCK_STREAM, IPPROTO_SCTP, NULL, NULL, 0, NULL)) == NULL) {
 		perror("usrsctp_socket");
 		exit(EXIT_FAILURE);
 	}

 	opt_len = (socklen_t)sizeof(int);
 	cur_buf_size = 0;
 	if (usrsctp_getsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &cur_buf_size, &opt_len) < 0) {
 		perror("usrsctp_getsockopt");
 		exit(EXIT_FAILURE);
 	}
 	printf("Change receive socket buffer size from %d ", cur_buf_size);
 	rcv_buf_size = 1<<16; /* 64 KB */
 	if (usrsctp_setsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &rcv_buf_size, sizeof(int)) < 0) {
 		perror("usrsctp_setsockopt");
 		exit(EXIT_FAILURE);
 	}
 	opt_len = (socklen_t)sizeof(int);
 	cur_buf_size = 0;
 	if (usrsctp_getsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &cur_buf_size, &opt_len) < 0) {
 		perror("usrsctp_getsockopt");
 		exit(EXIT_FAILURE);
 	}
 	printf("to %d.\n", cur_buf_size);

 	on = 1;
 	if (usrsctp_setsockopt(s_l, IPPROTO_SCTP, SCTP_RECVRCVINFO, &on, sizeof(int)) < 0) {
 		perror("usrsctp_setsockopt");
 		exit(EXIT_FAILURE);
 	}
 	/* Bind the client side. */
 	memset(&sconn, 0, sizeof(struct sockaddr_conn));
 	sconn.sconn_family = AF_CONN;
 #ifdef HAVE_SCONN_LEN
 	sconn.sconn_len = sizeof(struct sockaddr_conn);
 #endif
 	sconn.sconn_port = htons(5001);
 	sconn.sconn_addr = &fd_c;
 	if (usrsctp_bind(s_c, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
 		perror("usrsctp_bind");
 		exit(EXIT_FAILURE);
 	}
 	/* Bind the server side. */
 	memset(&sconn, 0, sizeof(struct sockaddr_conn));
 	sconn.sconn_family = AF_CONN;
 #ifdef HAVE_SCONN_LEN
 	sconn.sconn_len = sizeof(struct sockaddr_conn);
 #endif
 	sconn.sconn_port = htons(5001);
 	sconn.sconn_addr = &fd_s;
 	if (usrsctp_bind(s_l, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
 		perror("usrsctp_bind");
 		exit(EXIT_FAILURE);
 	}
 	/* Make server side passive... */
 	if (usrsctp_listen(s_l, 1) < 0) {
 		perror("usrsctp_listen");
 		exit(EXIT_FAILURE);
 	}
 	/* Initiate the handshake */
 	memset(&sconn, 0, sizeof(struct sockaddr_conn));
 	sconn.sconn_family = AF_CONN;
 #ifdef HAVE_SCONN_LEN
 	sconn.sconn_len = sizeof(struct sockaddr_conn);
 #endif
 	sconn.sconn_port = htons(5001);
 	sconn.sconn_addr = &fd_c;
 	if (usrsctp_connect(s_c, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
 		perror("usrsctp_connect");
 		exit(EXIT_FAILURE);
 	}

 	if ((s_s = usrsctp_accept(s_l, NULL, NULL)) == NULL) {
 		perror("usrsctp_accept");
 		exit(EXIT_FAILURE);
 	}

 	usrsctp_set_upcall(s_s, handle_upcall, &fd_s);

 	usrsctp_close(s_l);
 	if ((line = malloc(LINE_LENGTH)) == NULL) {
 		exit(EXIT_FAILURE);
 	}
 	memset(line, 'A', LINE_LENGTH);
 	sndinfo.snd_sid = 1;
 	sndinfo.snd_flags = SCTP_UNORDERED;
 	sndinfo.snd_ppid = htonl(DISCARD_PPID);
 	sndinfo.snd_context = 0;
 	sndinfo.snd_assoc_id = 0;
 	/* Send a 1 MB ordered message */
 	if (usrsctp_sendv(s_c, line, LINE_LENGTH, NULL, 0, (void *)&sndinfo,
 	                 (socklen_t)sizeof(struct sctp_sndinfo), SCTP_SENDV_SNDINFO, 0) < 0) {
 		perror("usrsctp_sendv");
 		exit(EXIT_FAILURE);
 	}
 	/* Send a 1 MB ordered message */
 	if (usrsctp_sendv(s_c, line, LINE_LENGTH, NULL, 0, (void *)&sndinfo,
 	                 (socklen_t)sizeof(struct sctp_sndinfo), SCTP_SENDV_SNDINFO, 0) < 0) {
 		perror("usrsctp_sendv");
 		exit(EXIT_FAILURE);
 	}
 	free(line);
 	usrsctp_shutdown(s_c, SHUT_WR);

 	while (usrsctp_finish() != 0) {
 #ifdef _WIN32
 		Sleep(1000);
 #else
 		sleep(1);
 #endif
 	}
 #ifdef _WIN32
 	TerminateThread(tid_c, 0);
 	WaitForSingleObject(tid_c, INFINITE);
 	TerminateThread(tid_s, 0);
 	WaitForSingleObject(tid_s, INFINITE);
 	if (closesocket(fd_c) == SOCKET_ERROR) {
 		fprintf(stderr, "closesocket() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 	if (closesocket(fd_s) == SOCKET_ERROR) {
 		fprintf(stderr, "closesocket() failed with error: %d\n", WSAGetLastError());
 		exit(EXIT_FAILURE);
 	}
 	WSACleanup();
 #else
 	pthread_cancel(tid_c);
 	pthread_join(tid_c, NULL);
 	pthread_cancel(tid_s);
 	pthread_join(tid_s, NULL);
 	if (close(fd_c) < 0) {
 		perror("close");
 		exit(EXIT_FAILURE);
 	}
 	if (close(fd_s) < 0) {
 		perror("close");
 		exit(EXIT_FAILURE);
 	}
 #endif
 	return (0);
 }
	/*
	* Copyright (C) 2011-2013 Michael Tuexen
	* Copyright (C) 2018-2018 Felix Weinrank
	*
	* All rights reserved.
	*
	* Redistribution and use in source and binary forms, with or without
	* modification, are permitted provided that the following conditions
	* are met:
	* 1. Redistributions of source code must retain the above copyright
	* notice, this list of conditions and the following disclaimer.
	* 2. Redistributions in binary form must reproduce the above copyright
	* notice, this list of conditions and the following disclaimer in the
	* documentation and/or other materials provided with the distribution.
	* 3. Neither the name of the project nor the names of its contributors
	* may be used to endorse or promote products derived from this software
	* without specific prior written permission.
	*
	* THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	* ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
	* SUCH DAMAGE.
	*/

	#ifdef _WIN32
	#define _CRT_SECURE_NO_WARNINGS
	#endif
	#include <stdio.h>
	#include <stdlib.h>
	#include <string.h>
	#include <stdarg.h>
	#include <sys/types.h>
	#ifndef _WIN32
	#include <sys/socket.h>
	#include <netinet/in.h>
	#include <arpa/inet.h>
	#include <errno.h>
	#include <pthread.h>
	#include <unistd.h>
	#else
	#include <winsock2.h>
	#include <ws2tcpip.h>
	#endif
	#include <usrsctp.h>
	#include "programs_helper.h"

	#define MAX_PACKET_SIZE (1<<16)
	#define LINE_LENGTH (1<<20)
	#define DISCARD_PPID 39
	/* #define DUMP_PKTS_TO_FILE */

	#ifdef _WIN32
	static DWORD WINAPI
	#else
	static void *
	#endif
	handle_packets(void *arg)
	{
	#ifdef _WIN32
	SOCKET *fdp;
	#else
	int *fdp;
	#endif
	char *dump_buf;
	ssize_t length;
	char buf[MAX_PACKET_SIZE];

	#ifdef _WIN32
	fdp = (SOCKET *)arg;
	#else
	fdp = (int *)arg;
	#endif
	for (;;) {
	#if defined(__NetBSD__)
	pthread_testcancel();
	#endif
	length = recv(*fdp, buf, MAX_PACKET_SIZE, 0);
	if (length > 0) {
	if ((dump_buf = usrsctp_dumppacket(buf, (size_t)length, SCTP_DUMP_INBOUND)) != NULL) {
	/* fprintf(stderr, "%s", dump_buf); */
	usrsctp_freedumpbuffer(dump_buf);
	}
	usrsctp_conninput(fdp, buf, (size_t)length, 0);
	}
	}
	#ifdef _WIN32
	return 0;
	#else
	return (NULL);
	#endif
	}

	static int
	conn_output(void addr, void buf, size_t length, uint8_t tos, uint8_t set_df)
	{
	char *dump_buf;
	#ifdef _WIN32
	SOCKET *fdp;
	#else
	int *fdp;
	#endif

	#ifdef _WIN32
	fdp = (SOCKET *)addr;
	#else
	fdp = (int *)addr;
	#endif
	if ((dump_buf = usrsctp_dumppacket(buf, length, SCTP_DUMP_OUTBOUND)) != NULL) {
	/* fprintf(stderr, "%s", dump_buf); */
	usrsctp_freedumpbuffer(dump_buf);
	}

	#ifdef DUMP_PKTS_TO_FILE
	FILE *fp;
	char fname[128];
	static int pktnum = 0;
	if (snprintf(fname, sizeof(fname), "pkt-%d", pktnum++) < 0) {
	fname[0] = '\0';
	}
	fp = fopen(fname, "wb");
	fwrite((char *)buf + 12, 1, length - 12, fp);
	fclose(fp);
	#endif

	#ifdef _WIN32
	if (send(*fdp, buf, (int)length, 0) == SOCKET_ERROR) {
	return (WSAGetLastError());
	#else
	if (send(*fdp, buf, length, 0) < 0) {
	return (errno);
	#endif
	} else {
	return (0);
	}
	}

	static void
	handle_upcall(struct socket sock, void data, int flgs)
	{
	char *buf;
	int events;

	buf = malloc(MAX_PACKET_SIZE);

	while ((events = usrsctp_get_events(sock)) && (events & SCTP_EVENT_READ)) {
	struct sctp_recvv_rn rn;
	ssize_t n;
	union sctp_sockstore addr;
	int flags = 0;
	socklen_t len = (socklen_t)sizeof(addr);
	unsigned int infotype = 0;
	socklen_t infolen = sizeof(struct sctp_recvv_rn);
	memset(&rn, 0, sizeof(struct sctp_recvv_rn));
	n = usrsctp_recvv(sock, buf, MAX_PACKET_SIZE, (struct sockaddr ) &addr, &len, (void )&rn, &infolen, &infotype, &flags);
	if (n < 0) {
	perror("usrsctp_recvv");
	break;
	} else if (n > 0) {
	if (flags & MSG_NOTIFICATION) {
	printf("Notification of length %d received.\n", (int)n);
	} else {
	printf("Message of length %d received via %p:%u on stream %u with SSN %u and TSN %u, PPID %u, context %u, flags %x.\n",
	(int)n,
	addr.sconn.sconn_addr,
	ntohs(addr.sconn.sconn_port),
	rn.recvv_rcvinfo.rcv_sid,
	rn.recvv_rcvinfo.rcv_ssn,
	rn.recvv_rcvinfo.rcv_tsn,
	ntohl(rn.recvv_rcvinfo.rcv_ppid),
	rn.recvv_rcvinfo.rcv_context,
	flags);
	}
	} else {
	usrsctp_deregister_address(data);
	usrsctp_close(sock);
	break;
	}
	}
	free(buf);

	return;
	}

	#if 0
	static void
	print_addresses(struct socket *sock)
	{
	int i, n;
	struct sockaddr addrs, addr;

	n = usrsctp_getladdrs(sock, 0, &addrs);
	addr = addrs;
	for (i = 0; i < n; i++) {
	switch (addr->sa_family) {
	case AF_INET:
	{
	struct sockaddr_in *sin;
	char buf[INET_ADDRSTRLEN];
	const char *name;

	sin = (struct sockaddr_in *)addr;
	name = inet_ntop(AF_INET, &sin->sin_addr, buf, INET_ADDRSTRLEN);
	printf("%s:%d", name, ntohs(sin->sin_port));
	break;
	}
	case AF_INET6:
	{
	struct sockaddr_in6 *sin6;
	char buf[INET6_ADDRSTRLEN];
	const char *name;

	sin6 = (struct sockaddr_in6 *)addr;
	name = inet_ntop(AF_INET6, &sin6->sin6_addr, buf, INET6_ADDRSTRLEN);
	printf("%s:%d", name, ntohs(sin6->sin6_port));
	break;
	}
	case AF_CONN:
	{
	struct sockaddr_conn *sconn;

	sconn = (struct sockaddr_conn *)addr;
	printf("%p:%d", sconn->sconn_addr, ntohs(sconn->sconn_port));
	break;
	}
	default:
	printf("Unknown family: %d", addr->sa_family);
	break;
	}
	addr = (struct sockaddr *)((caddr_t)addr + addr->sa_len);
	if (i != n - 1) {
	printf(",");
	}
	}
	if (n > 0) {
	usrsctp_freeladdrs(addrs);
	}
	printf("<->");
	n = usrsctp_getpaddrs(sock, 0, &addrs);
	addr = addrs;
	for (i = 0; i < n; i++) {
	switch (addr->sa_family) {
	case AF_INET:
	{
	struct sockaddr_in *sin;
	char buf[INET_ADDRSTRLEN];
	const char *name;

	sin = (struct sockaddr_in *)addr;
	name = inet_ntop(AF_INET, &sin->sin_addr, buf, INET_ADDRSTRLEN);
	printf("%s:%d", name, ntohs(sin->sin_port));
	break;
	}
	case AF_INET6:
	{
	struct sockaddr_in6 *sin6;
	char buf[INET6_ADDRSTRLEN];
	const char *name;

	sin6 = (struct sockaddr_in6 *)addr;
	name = inet_ntop(AF_INET6, &sin6->sin6_addr, buf, INET6_ADDRSTRLEN);
	printf("%s:%d", name, ntohs(sin6->sin6_port));
	break;
	}
	case AF_CONN:
	{
	struct sockaddr_conn *sconn;

	sconn = (struct sockaddr_conn *)addr;
	printf("%p:%d", sconn->sconn_addr, ntohs(sconn->sconn_port));
	break;
	}
	default:
	printf("Unknown family: %d", addr->sa_family);
	break;
	}
	addr = (struct sockaddr *)((caddr_t)addr + addr->sa_len);
	if (i != n - 1) {
	printf(",");
	}
	}
	if (n > 0) {
	usrsctp_freepaddrs(addrs);
	}
	printf("\n");
	}
	#endif

	int
	main(int argc, char *argv[])
	{
	struct sockaddr_in sin_s, sin_c;
	struct sockaddr_conn sconn;
	#ifdef _WIN32
	SOCKET fd_c, fd_s;
	#else
	int fd_c, fd_s, rc;
	#endif
	struct socket s_c, s_s, *s_l;
	#ifdef _WIN32
	HANDLE tid_c, tid_s;
	#else
	pthread_t tid_c, tid_s;
	#endif
	int cur_buf_size, snd_buf_size, rcv_buf_size, on;
	socklen_t opt_len;
	struct sctp_sndinfo sndinfo;
	char *line;
	#ifdef _WIN32
	WSADATA wsaData;
	#endif
	uint16_t client_port = 9900;
	uint16_t server_port = 9901;

	if (argc == 3) {
	client_port = atoi(argv[1]);
	server_port = atoi(argv[2]);
	}

	#ifdef _WIN32
	if (WSAStartup(MAKEWORD(2,2), &wsaData) != 0) {
	fprintf(stderr, "WSAStartup failed\n");
	exit (EXIT_FAILURE);
	}
	#endif
	usrsctp_init(0, conn_output, debug_printf_stack);
	/* set up a connected UDP socket */
	#ifdef _WIN32
	if ((fd_c = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) == INVALID_SOCKET) {
	fprintf(stderr, "socket() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	if ((fd_s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) == INVALID_SOCKET) {
	fprintf(stderr, "socket() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	#else
	if ((fd_c = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
	perror("socket");
	exit(EXIT_FAILURE);
	}
	if ((fd_s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
	perror("socket");
	exit(EXIT_FAILURE);
	}
	#endif
	memset(&sin_c, 0, sizeof(struct sockaddr_in));
	sin_c.sin_family = AF_INET;
	#ifdef HAVE_SIN_LEN
	sin_c.sin_len = sizeof(struct sockaddr_in);
	#endif
	sin_c.sin_port = htons(client_port);
	sin_c.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
	memset(&sin_s, 0, sizeof(struct sockaddr_in));
	sin_s.sin_family = AF_INET;
	#ifdef HAVE_SIN_LEN
	sin_s.sin_len = sizeof(struct sockaddr_in);
	#endif
	sin_s.sin_port = htons(server_port);
	sin_s.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
	#ifdef _WIN32
	if (bind(fd_c, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
	fprintf(stderr, "bind() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	if (bind(fd_s, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
	fprintf(stderr, "bind() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	#else
	if (bind(fd_c, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) < 0) {
	perror("bind");
	exit(EXIT_FAILURE);
	}
	if (bind(fd_s, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) < 0) {
	perror("bind");
	exit(EXIT_FAILURE);
	}
	#endif
	#ifdef _WIN32
	if (connect(fd_c, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
	fprintf(stderr, "connect() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	if (connect(fd_s, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) == SOCKET_ERROR) {
	fprintf(stderr, "connect() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	#else
	if (connect(fd_c, (struct sockaddr *)&sin_s, sizeof(struct sockaddr_in)) < 0) {
	perror("connect");
	exit(EXIT_FAILURE);
	}
	if (connect(fd_s, (struct sockaddr *)&sin_c, sizeof(struct sockaddr_in)) < 0) {
	perror("connect");
	exit(EXIT_FAILURE);
	}
	#endif
	#ifdef _WIN32
	if ((tid_c = CreateThread(NULL, 0, &handle_packets, (void *)&fd_c, 0, NULL)) == NULL) {
	fprintf(stderr, "CreateThread() failed with error: %d\n", GetLastError());
	exit(EXIT_FAILURE);
	}
	if ((tid_s = CreateThread(NULL, 0, &handle_packets, (void *)&fd_s, 0, NULL)) == NULL) {
	fprintf(stderr, "CreateThread() failed with error: %d\n", GetLastError());
	exit(EXIT_FAILURE);
	}
	#else
	if ((rc = pthread_create(&tid_c, NULL, &handle_packets, (void *)&fd_c)) != 0) {
	fprintf(stderr, "pthread_create tid_c: %s\n", strerror(rc));
	exit(EXIT_FAILURE);
	}

	if ((rc = pthread_create(&tid_s, NULL, &handle_packets, (void *)&fd_s)) != 0) {
	fprintf(stderr, "pthread_create tid_s: %s\n", strerror(rc));
	exit(EXIT_FAILURE);
	};
	#endif
	#ifdef SCTP_DEBUG
	usrsctp_sysctl_set_sctp_debug_on(SCTP_DEBUG_NONE);
	#endif
	usrsctp_sysctl_set_sctp_ecn_enable(0);
	usrsctp_register_address((void *)&fd_c);
	usrsctp_register_address((void *)&fd_s);

	if ((s_c = usrsctp_socket(AF_CONN, SOCK_STREAM, IPPROTO_SCTP, NULL, NULL, 0, NULL)) == NULL) {
	perror("usrsctp_socket");
	exit(EXIT_FAILURE);
	}
	usrsctp_set_upcall(s_c, handle_upcall, &fd_c);

	opt_len = (socklen_t)sizeof(int);
	cur_buf_size = 0;
	if (usrsctp_getsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &cur_buf_size, &opt_len) < 0) {
	perror("usrsctp_getsockopt");
	exit(EXIT_FAILURE);
	}
	printf("Change send socket buffer size from %d ", cur_buf_size);
	snd_buf_size = 1<<22; /* 4 MB */
	if (usrsctp_setsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &snd_buf_size, sizeof(int)) < 0) {
	perror("usrsctp_setsockopt");
	exit(EXIT_FAILURE);
	}
	opt_len = (socklen_t)sizeof(int);
	cur_buf_size = 0;
	if (usrsctp_getsockopt(s_c, SOL_SOCKET, SO_SNDBUF, &cur_buf_size, &opt_len) < 0) {
	perror("usrsctp_getsockopt");
	exit(EXIT_FAILURE);
	}
	printf("to %d.\n", cur_buf_size);
	if ((s_l = usrsctp_socket(AF_CONN, SOCK_STREAM, IPPROTO_SCTP, NULL, NULL, 0, NULL)) == NULL) {
	perror("usrsctp_socket");
	exit(EXIT_FAILURE);
	}

	opt_len = (socklen_t)sizeof(int);
	cur_buf_size = 0;
	if (usrsctp_getsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &cur_buf_size, &opt_len) < 0) {
	perror("usrsctp_getsockopt");
	exit(EXIT_FAILURE);
	}
	printf("Change receive socket buffer size from %d ", cur_buf_size);
	rcv_buf_size = 1<<16; /* 64 KB */
	if (usrsctp_setsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &rcv_buf_size, sizeof(int)) < 0) {
	perror("usrsctp_setsockopt");
	exit(EXIT_FAILURE);
	}
	opt_len = (socklen_t)sizeof(int);
	cur_buf_size = 0;
	if (usrsctp_getsockopt(s_l, SOL_SOCKET, SO_RCVBUF, &cur_buf_size, &opt_len) < 0) {
	perror("usrsctp_getsockopt");
	exit(EXIT_FAILURE);
	}
	printf("to %d.\n", cur_buf_size);

	on = 1;
	if (usrsctp_setsockopt(s_l, IPPROTO_SCTP, SCTP_RECVRCVINFO, &on, sizeof(int)) < 0) {
	perror("usrsctp_setsockopt");
	exit(EXIT_FAILURE);
	}
	/* Bind the client side. */
	memset(&sconn, 0, sizeof(struct sockaddr_conn));
	sconn.sconn_family = AF_CONN;
	#ifdef HAVE_SCONN_LEN
	sconn.sconn_len = sizeof(struct sockaddr_conn);
	#endif
	sconn.sconn_port = htons(5001);
	sconn.sconn_addr = &fd_c;
	if (usrsctp_bind(s_c, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
	perror("usrsctp_bind");
	exit(EXIT_FAILURE);
	}
	/* Bind the server side. */
	memset(&sconn, 0, sizeof(struct sockaddr_conn));
	sconn.sconn_family = AF_CONN;
	#ifdef HAVE_SCONN_LEN
	sconn.sconn_len = sizeof(struct sockaddr_conn);
	#endif
	sconn.sconn_port = htons(5001);
	sconn.sconn_addr = &fd_s;
	if (usrsctp_bind(s_l, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
	perror("usrsctp_bind");
	exit(EXIT_FAILURE);
	}
	/* Make server side passive... */
	if (usrsctp_listen(s_l, 1) < 0) {
	perror("usrsctp_listen");
	exit(EXIT_FAILURE);
	}
	/* Initiate the handshake */
	memset(&sconn, 0, sizeof(struct sockaddr_conn));
	sconn.sconn_family = AF_CONN;
	#ifdef HAVE_SCONN_LEN
	sconn.sconn_len = sizeof(struct sockaddr_conn);
	#endif
	sconn.sconn_port = htons(5001);
	sconn.sconn_addr = &fd_c;
	if (usrsctp_connect(s_c, (struct sockaddr *)&sconn, sizeof(struct sockaddr_conn)) < 0) {
	perror("usrsctp_connect");
	exit(EXIT_FAILURE);
	}

	if ((s_s = usrsctp_accept(s_l, NULL, NULL)) == NULL) {
	perror("usrsctp_accept");
	exit(EXIT_FAILURE);
	}

	usrsctp_set_upcall(s_s, handle_upcall, &fd_s);

	usrsctp_close(s_l);
	if ((line = malloc(LINE_LENGTH)) == NULL) {
	exit(EXIT_FAILURE);
	}
	memset(line, 'A', LINE_LENGTH);
	sndinfo.snd_sid = 1;
	sndinfo.snd_flags = SCTP_UNORDERED;
	sndinfo.snd_ppid = htonl(DISCARD_PPID);
	sndinfo.snd_context = 0;
	sndinfo.snd_assoc_id = 0;
	/* Send a 1 MB ordered message */
	if (usrsctp_sendv(s_c, line, LINE_LENGTH, NULL, 0, (void *)&sndinfo,
	(socklen_t)sizeof(struct sctp_sndinfo), SCTP_SENDV_SNDINFO, 0) < 0) {
	perror("usrsctp_sendv");
	exit(EXIT_FAILURE);
	}
	/* Send a 1 MB ordered message */
	if (usrsctp_sendv(s_c, line, LINE_LENGTH, NULL, 0, (void *)&sndinfo,
	(socklen_t)sizeof(struct sctp_sndinfo), SCTP_SENDV_SNDINFO, 0) < 0) {
	perror("usrsctp_sendv");
	exit(EXIT_FAILURE);
	}
	free(line);
	usrsctp_shutdown(s_c, SHUT_WR);

	while (usrsctp_finish() != 0) {
	#ifdef _WIN32
	Sleep(1000);
	#else
	sleep(1);
	#endif
	}
	#ifdef _WIN32
	TerminateThread(tid_c, 0);
	WaitForSingleObject(tid_c, INFINITE);
	TerminateThread(tid_s, 0);
	WaitForSingleObject(tid_s, INFINITE);
	if (closesocket(fd_c) == SOCKET_ERROR) {
	fprintf(stderr, "closesocket() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	if (closesocket(fd_s) == SOCKET_ERROR) {
	fprintf(stderr, "closesocket() failed with error: %d\n", WSAGetLastError());
	exit(EXIT_FAILURE);
	}
	WSACleanup();
	#else
	pthread_cancel(tid_c);
	pthread_join(tid_c, NULL);
	pthread_cancel(tid_s);
	pthread_join(tid_s, NULL);
	if (close(fd_c) < 0) {
	perror("close");
	exit(EXIT_FAILURE);
	}
	if (close(fd_s) < 0) {
	perror("close");
	exit(EXIT_FAILURE);
	}
	#endif
	return (0);
	}