// SPDX-License-Identifier: GPL-2.0
/*
 * Test for sockmap/sockhash redirection.
 *
 * BPF_MAP_TYPE_SOCKMAP
 * BPF_MAP_TYPE_SOCKHASH
 *	x
 * sk_msg-to-egress
 * sk_msg-to-ingress
 * sk_skb-to-egress
 * sk_skb-to-ingress
 *	x
 * AF_INET, SOCK_STREAM
 * AF_INET6, SOCK_STREAM
 * AF_INET, SOCK_DGRAM
 * AF_INET6, SOCK_DGRAM
 * AF_UNIX, SOCK_STREAM
 * AF_UNIX, SOCK_DGRAM
 * AF_VSOCK, SOCK_STREAM
 * AF_VSOCK, SOCK_SEQPACKET
 */

#include <errno.h>
#include <error.h>
#include <sched.h>
#include <stdio.h>
#include <unistd.h>

#include <netinet/in.h>
#include <sys/socket.h>
#include <sys/types.h>
#include <sys/un.h>
#include <linux/string.h>
#include <linux/vm_sockets.h>

#include <bpf/bpf.h>
#include <bpf/libbpf.h>

#include "linux/const.h"
#include "test_progs.h"
#include "sockmap_helpers.h"
#include "test_sockmap_redir.skel.h"

/* The meaning of SUPPORTED is "will redirect packet as expected".
 */
#define SUPPORTED		_BITUL(0)

/* Note on sk_skb-to-ingress ->af_vsock:
 *
 * Peer socket may receive the packet some time after the return from sendmsg().
 * In a typical usage scenario, recvmsg() will block until the redirected packet
 * appears in the destination queue, or timeout if the packet was dropped. By
 * that point, the verdict map has already been updated to reflect what has
 * happened.
 *
 * But sk_skb-to-ingress/af_vsock is an unsupported combination, so no recvmsg()
 * takes place. Which means we may race the execution of the verdict logic and
 * read map_verd before it has been updated, i.e. we might observe
 * map_verd[SK_DROP]=0 instead of map_verd[SK_DROP]=1.
 *
 * This confuses the selftest logic: if there was no packet dropped, where's the
 * packet? So here's a heuristic: on map_verd[SK_DROP]=map_verd[SK_PASS]=0
 * (which implies the verdict program has not been ran) just re-read the verdict
 * map again.
 */
#define UNSUPPORTED_RACY_VERD	_BITUL(1)

enum prog_type {
	SK_MSG_EGRESS,
	SK_MSG_INGRESS,
	SK_SKB_EGRESS,
	SK_SKB_INGRESS,
};

enum {
	SEND_INNER = 0,
	SEND_OUTER,
};

enum {
	RECV_INNER = 0,
	RECV_OUTER,
};

struct maps {
	int in;
	int out;
	int verd;
};

struct combo_spec {
	enum prog_type prog_type;
	const char *in, *out;
};

struct redir_spec {
	const char *name;
	int idx_send;
	int idx_recv;
	enum prog_type prog_type;
};

struct socket_spec {
	int family;
	int sotype;
	int send_flags;
	int in[2];
	int out[2];
};

static int socket_spec_pairs(struct socket_spec *s)
{
	return create_socket_pairs(s->family, s->sotype,
				   &s->in[0], &s->out[0],
				   &s->in[1], &s->out[1]);
}

static void socket_spec_close(struct socket_spec *s)
{
	xclose(s->in[0]);
	xclose(s->in[1]);
	xclose(s->out[0]);
	xclose(s->out[1]);
}

static void get_redir_params(struct redir_spec *redir,
			     struct test_sockmap_redir *skel, int *prog_fd,
			     enum bpf_attach_type *attach_type,
			     int *redirect_flags)
{
	enum prog_type type = redir->prog_type;
	struct bpf_program *prog;
	bool sk_msg;

	sk_msg = type == SK_MSG_INGRESS || type == SK_MSG_EGRESS;
	prog = sk_msg ? skel->progs.prog_msg_verdict : skel->progs.prog_skb_verdict;

	*prog_fd = bpf_program__fd(prog);
	*attach_type = sk_msg ? BPF_SK_MSG_VERDICT : BPF_SK_SKB_VERDICT;

	if (type == SK_MSG_INGRESS || type == SK_SKB_INGRESS)
		*redirect_flags = BPF_F_INGRESS;
	else
		*redirect_flags = 0;
}

static void try_recv(const char *prefix, int fd, int flags, bool expect_success)
{
	ssize_t n;
	char buf;

	errno = 0;
	n = recv(fd, &buf, 1, flags);
	if (n < 0 && expect_success)
		FAIL_ERRNO("%s: unexpected failure: retval=%zd", prefix, n);
	if (!n && !expect_success)
		FAIL("%s: expected failure: retval=%zd", prefix, n);
}

static void handle_unsupported(int sd_send, int sd_peer, int sd_in, int sd_out,
			       int sd_recv, int map_verd, int status)
{
	unsigned int drop, pass;
	char recv_buf;
	ssize_t n;

get_verdict:
	if (xbpf_map_lookup_elem(map_verd, &u32(SK_DROP), &drop) ||
	    xbpf_map_lookup_elem(map_verd, &u32(SK_PASS), &pass))
		return;

	if (pass == 0 && drop == 0 && (status & UNSUPPORTED_RACY_VERD)) {
		sched_yield();
		goto get_verdict;
	}

	if (pass != 0) {
		FAIL("unsupported: wanted verdict pass 0, have %u", pass);
		return;
	}

	/* If nothing was dropped, packet should have reached the peer */
	if (drop == 0) {
		errno = 0;
		n = recv_timeout(sd_peer, &recv_buf, 1, 0, IO_TIMEOUT_SEC);
		if (n != 1)
			FAIL_ERRNO("unsupported: packet missing, retval=%zd", n);
	}

	/* Ensure queues are empty */
	try_recv("bpf.recv(sd_send)", sd_send, MSG_DONTWAIT, false);
	if (sd_in != sd_send)
		try_recv("bpf.recv(sd_in)", sd_in, MSG_DONTWAIT, false);

	try_recv("bpf.recv(sd_out)", sd_out, MSG_DONTWAIT, false);
	if (sd_recv != sd_out)
		try_recv("bpf.recv(sd_recv)", sd_recv, MSG_DONTWAIT, false);
}

static void test_send_redir_recv(int sd_send, int send_flags, int sd_peer,
				 int sd_in, int sd_out, int sd_recv,
				 struct maps *maps, int status)
{
	unsigned int drop, pass;
	char *send_buf = "ab";
	char recv_buf = '\0';
	ssize_t n, len = 1;

	/* Zero out the verdict map */
	if (xbpf_map_update_elem(maps->verd, &u32(SK_DROP), &u32(0), BPF_ANY) ||
	    xbpf_map_update_elem(maps->verd, &u32(SK_PASS), &u32(0), BPF_ANY))
		return;

	if (xbpf_map_update_elem(maps->in, &u32(0), &u64(sd_in), BPF_NOEXIST))
		return;

	if (xbpf_map_update_elem(maps->out, &u32(0), &u64(sd_out), BPF_NOEXIST))
		goto del_in;

	/* Last byte is OOB data when send_flags has MSG_OOB bit set */
	if (send_flags & MSG_OOB)
		len++;
	n = send(sd_send, send_buf, len, send_flags);
	if (n >= 0 && n < len)
		FAIL("incomplete send");
	if (n < 0) {
		/* sk_msg redirect combo not supported? */
		if (status & SUPPORTED || errno != EACCES)
			FAIL_ERRNO("send");
		goto out;
	}

	if (!(status & SUPPORTED)) {
		handle_unsupported(sd_send, sd_peer, sd_in, sd_out, sd_recv,
				   maps->verd, status);
		goto out;
	}

	errno = 0;
	n = recv_timeout(sd_recv, &recv_buf, 1, 0, IO_TIMEOUT_SEC);
	if (n != 1) {
		FAIL_ERRNO("recv_timeout()");
		goto out;
	}

	/* Check verdict _after_ recv(); af_vsock may need time to catch up */
	if (xbpf_map_lookup_elem(maps->verd, &u32(SK_DROP), &drop) ||
	    xbpf_map_lookup_elem(maps->verd, &u32(SK_PASS), &pass))
		goto out;

	if (drop != 0 || pass != 1)
		FAIL("unexpected verdict drop/pass: wanted 0/1, have %u/%u",
		     drop, pass);

	if (recv_buf != send_buf[0])
		FAIL("recv(): payload check, %02x != %02x", recv_buf, send_buf[0]);

	if (send_flags & MSG_OOB) {
		/* Fail reading OOB while in sockmap */
		try_recv("bpf.recv(sd_out, MSG_OOB)", sd_out,
			 MSG_OOB | MSG_DONTWAIT, false);

		/* Remove sd_out from sockmap */
		xbpf_map_delete_elem(maps->out, &u32(0));

		/* Check that OOB was dropped on redirect */
		try_recv("recv(sd_out, MSG_OOB)", sd_out,
			 MSG_OOB | MSG_DONTWAIT, false);

		goto del_in;
	}
out:
	xbpf_map_delete_elem(maps->out, &u32(0));
del_in:
	xbpf_map_delete_elem(maps->in, &u32(0));
}

static int is_redir_supported(enum prog_type type, const char *in,
			      const char *out)
{
	/* Matching based on strings returned by socket_kind_to_str():
	 * tcp4, udp4, tcp6, udp6, u_str, u_dgr, v_str, v_seq
	 * Plus a wildcard: any
	 * Not in use: u_seq, v_dgr
	 */
	struct combo_spec *c, combos[] = {
		/* Send to local: TCP -> any, but vsock */
		{ SK_MSG_INGRESS,	"tcp",	"tcp"	},
		{ SK_MSG_INGRESS,	"tcp",	"udp"	},
		{ SK_MSG_INGRESS,	"tcp",	"u_str"	},
		{ SK_MSG_INGRESS,	"tcp",	"u_dgr"	},

		/* Send to egress: TCP -> TCP */
		{ SK_MSG_EGRESS,	"tcp",	"tcp"	},

		/* Ingress to egress: any -> any */
		{ SK_SKB_EGRESS,	"any",	"any"	},

		/* Ingress to local: any -> any, but vsock */
		{ SK_SKB_INGRESS,	"any",	"tcp"	},
		{ SK_SKB_INGRESS,	"any",	"udp"	},
		{ SK_SKB_INGRESS,	"any",	"u_str"	},
		{ SK_SKB_INGRESS,	"any",	"u_dgr"	},
	};

	for (c = combos; c < combos + ARRAY_SIZE(combos); c++) {
		if (c->prog_type == type &&
		    (!strcmp(c->in, "any") || strstarts(in, c->in)) &&
		    (!strcmp(c->out, "any") || strstarts(out, c->out)))
			return SUPPORTED;
	}

	return 0;
}

static int get_support_status(enum prog_type type, const char *in,
			      const char *out)
{
	int status = is_redir_supported(type, in, out);

	if (type == SK_SKB_INGRESS && strstarts(out, "v_"))
		status |= UNSUPPORTED_RACY_VERD;

	return status;
}

static void test_socket(enum bpf_map_type type, struct redir_spec *redir,
			struct maps *maps, struct socket_spec *s_in,
			struct socket_spec *s_out)
{
	int fd_in, fd_out, fd_send, fd_peer, fd_recv, flags, status;
	const char *in_str, *out_str;
	char s[MAX_TEST_NAME];

	fd_in = s_in->in[0];
	fd_out = s_out->out[0];
	fd_send = s_in->in[redir->idx_send];
	fd_peer = s_in->in[redir->idx_send ^ 1];
	fd_recv = s_out->out[redir->idx_recv];
	flags = s_in->send_flags;

	in_str = socket_kind_to_str(fd_in);
	out_str = socket_kind_to_str(fd_out);
	status = get_support_status(redir->prog_type, in_str, out_str);

	snprintf(s, sizeof(s),
		 "%-4s %-17s %-5s %s %-5s%6s",
		 /* hash sk_skb-to-ingress u_str → v_str (OOB) */
		 type == BPF_MAP_TYPE_SOCKMAP ? "map" : "hash",
		 redir->name,
		 in_str,
		 status & SUPPORTED ? "→" : " ",
		 out_str,
		 (flags & MSG_OOB) ? "(OOB)" : "");

	if (!test__start_subtest(s))
		return;

	test_send_redir_recv(fd_send, flags, fd_peer, fd_in, fd_out, fd_recv,
			     maps, status);
}

static void test_redir(enum bpf_map_type type, struct redir_spec *redir,
		       struct maps *maps)
{
	struct socket_spec *s, sockets[] = {
		{ AF_INET, SOCK_STREAM },
		// { AF_INET, SOCK_STREAM, MSG_OOB }, /* Known to be broken */
		{ AF_INET6, SOCK_STREAM },
		{ AF_INET, SOCK_DGRAM },
		{ AF_INET6, SOCK_DGRAM },
		{ AF_UNIX, SOCK_STREAM },
		{ AF_UNIX, SOCK_STREAM, MSG_OOB },
		{ AF_UNIX, SOCK_DGRAM },
		// { AF_UNIX, SOCK_SEQPACKET},	/* Unsupported BPF_MAP_UPDATE_ELEM */
		{ AF_VSOCK, SOCK_STREAM },
		// { AF_VSOCK, SOCK_DGRAM },	/* Unsupported socket() */
		{ AF_VSOCK, SOCK_SEQPACKET },
	};

	for (s = sockets; s < sockets + ARRAY_SIZE(sockets); s++)
		if (socket_spec_pairs(s))
			goto out;

	/* Intra-proto */
	for (s = sockets; s < sockets + ARRAY_SIZE(sockets); s++)
		test_socket(type, redir, maps, s, s);

	/* Cross-proto */
	for (int i = 0; i < ARRAY_SIZE(sockets); i++) {
		for (int j = 0; j < ARRAY_SIZE(sockets); j++) {
			struct socket_spec *out = &sockets[j];
			struct socket_spec *in = &sockets[i];

			/* Skip intra-proto and between variants */
			if (out->send_flags ||
			    (in->family == out->family &&
			     in->sotype == out->sotype))
				continue;

			test_socket(type, redir, maps, in, out);
		}
	}
out:
	while (--s >= sockets)
		socket_spec_close(s);
}

static void test_map(enum bpf_map_type type)
{
	struct redir_spec *r, redirs[] = {
		{ "sk_msg-to-ingress", SEND_INNER, RECV_INNER, SK_MSG_INGRESS },
		{ "sk_msg-to-egress", SEND_INNER, RECV_OUTER, SK_MSG_EGRESS },
		{ "sk_skb-to-egress", SEND_OUTER, RECV_OUTER, SK_SKB_EGRESS },
		{ "sk_skb-to-ingress", SEND_OUTER, RECV_INNER, SK_SKB_INGRESS },
	};

	for (r = redirs; r < redirs + ARRAY_SIZE(redirs); r++) {
		enum bpf_attach_type attach_type;
		struct test_sockmap_redir *skel;
		struct maps maps;
		int prog_fd;

		skel = test_sockmap_redir__open_and_load();
		if (!skel) {
			FAIL("open_and_load");
			return;
		}

		switch (type) {
		case BPF_MAP_TYPE_SOCKMAP:
			maps.in = bpf_map__fd(skel->maps.nop_map);
			maps.out = bpf_map__fd(skel->maps.sock_map);
			break;
		case BPF_MAP_TYPE_SOCKHASH:
			maps.in = bpf_map__fd(skel->maps.nop_hash);
			maps.out = bpf_map__fd(skel->maps.sock_hash);
			break;
		default:
			FAIL("Unsupported bpf_map_type");
			return;
		}

		skel->bss->redirect_type = type;
		maps.verd = bpf_map__fd(skel->maps.verdict_map);
		get_redir_params(r, skel, &prog_fd, &attach_type,
				 &skel->bss->redirect_flags);

		if (xbpf_prog_attach(prog_fd, maps.in, attach_type, 0))
			return;

		test_redir(type, r, &maps);

		if (xbpf_prog_detach2(prog_fd, maps.in, attach_type))
			return;

		test_sockmap_redir__destroy(skel);
	}
}

void serial_test_sockmap_redir(void)
{
	test_map(BPF_MAP_TYPE_SOCKMAP);
	test_map(BPF_MAP_TYPE_SOCKHASH);
}