// SPDX-License-Identifier: GPL-2.0

#include <errno.h>
#include <netdb.h>
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <linux/types.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>

#ifndef SO_RCVPRIORITY
#define SO_RCVPRIORITY 82
#endif

struct options {
	__u32 val;
	int name;
	int rcvname;
	const char *host;
	const char *service;
} opt;

static void __attribute__((noreturn)) usage(const char *bin)
{
	printf("Usage: %s [opts] <dst host> <dst port / service>\n", bin);
	printf("Options:\n"
		"\t\t-M val  Test SO_RCVMARK\n"
		"\t\t-P val  Test SO_RCVPRIORITY\n"
		"");
	exit(EXIT_FAILURE);
}

static void parse_args(int argc, char *argv[])
{
	int o;

	while ((o = getopt(argc, argv, "M:P:")) != -1) {
		switch (o) {
		case 'M':
			opt.val = atoi(optarg);
			opt.name = SO_MARK;
			opt.rcvname = SO_RCVMARK;
			break;
		case 'P':
			opt.val = atoi(optarg);
			opt.name = SO_PRIORITY;
			opt.rcvname = SO_RCVPRIORITY;
			break;
		default:
			usage(argv[0]);
			break;
		}
	}

	if (optind != argc - 2)
		usage(argv[0]);

	opt.host = argv[optind];
	opt.service = argv[optind + 1];
}

int main(int argc, char *argv[])
{
	int err = 0;
	int recv_fd = -1;
	int ret_value = 0;
	__u32 recv_val;
	struct cmsghdr *cmsg;
	char cbuf[CMSG_SPACE(sizeof(__u32))];
	char recv_buf[CMSG_SPACE(sizeof(__u32))];
	struct iovec iov[1];
	struct msghdr msg;
	struct sockaddr_in recv_addr4;
	struct sockaddr_in6 recv_addr6;

	parse_args(argc, argv);

	int family = strchr(opt.host, ':') ? AF_INET6 : AF_INET;

	recv_fd = socket(family, SOCK_DGRAM, IPPROTO_UDP);
	if (recv_fd < 0) {
		perror("Can't open recv socket");
		ret_value = -errno;
		goto cleanup;
	}

	err = setsockopt(recv_fd, SOL_SOCKET, opt.rcvname, &opt.val, sizeof(opt.val));
	if (err < 0) {
		perror("Recv setsockopt error");
		ret_value = -errno;
		goto cleanup;
	}

	if (family == AF_INET) {
		memset(&recv_addr4, 0, sizeof(recv_addr4));
		recv_addr4.sin_family = family;
		recv_addr4.sin_port = htons(atoi(opt.service));

		if (inet_pton(family, opt.host, &recv_addr4.sin_addr) <= 0) {
			perror("Invalid IPV4 address");
			ret_value = -errno;
			goto cleanup;
		}

		err = bind(recv_fd, (struct sockaddr *)&recv_addr4, sizeof(recv_addr4));
	} else {
		memset(&recv_addr6, 0, sizeof(recv_addr6));
		recv_addr6.sin6_family = family;
		recv_addr6.sin6_port = htons(atoi(opt.service));

		if (inet_pton(family, opt.host, &recv_addr6.sin6_addr) <= 0) {
			perror("Invalid IPV6 address");
			ret_value = -errno;
			goto cleanup;
		}

		err = bind(recv_fd, (struct sockaddr *)&recv_addr6, sizeof(recv_addr6));
	}

	if (err < 0) {
		perror("Recv bind error");
		ret_value = -errno;
		goto cleanup;
	}

	iov[0].iov_base = recv_buf;
	iov[0].iov_len = sizeof(recv_buf);

	memset(&msg, 0, sizeof(msg));
	msg.msg_iov = iov;
	msg.msg_iovlen = 1;
	msg.msg_control = cbuf;
	msg.msg_controllen = sizeof(cbuf);

	err = recvmsg(recv_fd, &msg, 0);
	if (err < 0) {
		perror("Message receive error");
		ret_value = -errno;
		goto cleanup;
	}

	for (cmsg = CMSG_FIRSTHDR(&msg); cmsg != NULL; cmsg = CMSG_NXTHDR(&msg, cmsg)) {
		if (cmsg->cmsg_level == SOL_SOCKET && cmsg->cmsg_type == opt.name) {
			recv_val = *(__u32 *)CMSG_DATA(cmsg);
			printf("Received value: %u\n", recv_val);

			if (recv_val != opt.val) {
				fprintf(stderr, "Error: expected value: %u, got: %u\n",
					opt.val, recv_val);
				ret_value = -EINVAL;
			}
			goto cleanup;
		}
	}

	fprintf(stderr, "Error: No matching cmsg received\n");
	ret_value = -ENOMSG;

cleanup:
	if (recv_fd >= 0)
		close(recv_fd);

	return ret_value;
}