// SPDX-License-Identifier: GPL-2.0
/* Copyright Amazon.com Inc. or its affiliates. */

#define _GNU_SOURCE
#include <sched.h>

#include <unistd.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <linux/sock_diag.h>
#include <linux/unix_diag.h>
#include <sys/socket.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/un.h>

#include "../../kselftest_harness.h"

FIXTURE(diag_uid)
{
	int netlink_fd;
	int unix_fd;
	__u32 inode;
	__u64 cookie;
};

FIXTURE_VARIANT(diag_uid)
{
	int unshare;
	int udiag_show;
};

FIXTURE_VARIANT_ADD(diag_uid, uid)
{
	.unshare = 0,
	.udiag_show = UDIAG_SHOW_UID
};

FIXTURE_VARIANT_ADD(diag_uid, uid_unshare)
{
	.unshare = CLONE_NEWUSER,
	.udiag_show = UDIAG_SHOW_UID
};

FIXTURE_SETUP(diag_uid)
{
	struct stat file_stat;
	socklen_t optlen;
	int ret;

	if (variant->unshare)
		ASSERT_EQ(unshare(variant->unshare), 0);

	self->netlink_fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_SOCK_DIAG);
	ASSERT_NE(self->netlink_fd, -1);

	self->unix_fd = socket(AF_UNIX, SOCK_STREAM, 0);
	ASSERT_NE(self->unix_fd, -1);

	ret = fstat(self->unix_fd, &file_stat);
	ASSERT_EQ(ret, 0);

	self->inode = file_stat.st_ino;

	optlen = sizeof(self->cookie);
	ret = getsockopt(self->unix_fd, SOL_SOCKET, SO_COOKIE, &self->cookie, &optlen);
	ASSERT_EQ(ret, 0);
}

FIXTURE_TEARDOWN(diag_uid)
{
	close(self->netlink_fd);
	close(self->unix_fd);
}

int send_request(struct __test_metadata *_metadata,
		 FIXTURE_DATA(diag_uid) *self,
		 const FIXTURE_VARIANT(diag_uid) *variant)
{
	struct {
		struct nlmsghdr nlh;
		struct unix_diag_req udr;
	} req = {
		.nlh = {
			.nlmsg_len = sizeof(req),
			.nlmsg_type = SOCK_DIAG_BY_FAMILY,
			.nlmsg_flags = NLM_F_REQUEST
		},
		.udr = {
			.sdiag_family = AF_UNIX,
			.udiag_ino = self->inode,
			.udiag_cookie = {
				(__u32)self->cookie,
				(__u32)(self->cookie >> 32)
			},
			.udiag_show = variant->udiag_show
		}
	};
	struct sockaddr_nl nladdr = {
		.nl_family = AF_NETLINK
	};
	struct iovec iov = {
		.iov_base = &req,
		.iov_len = sizeof(req)
	};
	struct msghdr msg = {
		.msg_name = &nladdr,
		.msg_namelen = sizeof(nladdr),
		.msg_iov = &iov,
		.msg_iovlen = 1
	};

	return sendmsg(self->netlink_fd, &msg, 0);
}

void render_response(struct __test_metadata *_metadata,
		     struct unix_diag_req *udr, __u32 len)
{
	unsigned int rta_len = len - NLMSG_LENGTH(sizeof(*udr));
	struct rtattr *attr;
	uid_t uid;

	ASSERT_GT(len, sizeof(*udr));
	ASSERT_EQ(udr->sdiag_family, AF_UNIX);

	attr = (struct rtattr *)(udr + 1);
	ASSERT_NE(RTA_OK(attr, rta_len), 0);
	ASSERT_EQ(attr->rta_type, UNIX_DIAG_UID);

	uid = *(uid_t *)RTA_DATA(attr);
	ASSERT_EQ(uid, getuid());
}

void receive_response(struct __test_metadata *_metadata,
		      FIXTURE_DATA(diag_uid) *self)
{
	long buf[8192 / sizeof(long)];
	struct sockaddr_nl nladdr = {
		.nl_family = AF_NETLINK
	};
	struct iovec iov = {
		.iov_base = buf,
		.iov_len = sizeof(buf)
	};
	struct msghdr msg = {
		.msg_name = &nladdr,
		.msg_namelen = sizeof(nladdr),
		.msg_iov = &iov,
		.msg_iovlen = 1
	};
	struct unix_diag_req *udr;
	struct nlmsghdr *nlh;
	int ret;

	ret = recvmsg(self->netlink_fd, &msg, 0);
	ASSERT_GT(ret, 0);

	nlh = (struct nlmsghdr *)buf;
	ASSERT_NE(NLMSG_OK(nlh, ret), 0);
	ASSERT_EQ(nlh->nlmsg_type, SOCK_DIAG_BY_FAMILY);

	render_response(_metadata, NLMSG_DATA(nlh), nlh->nlmsg_len);

	nlh = NLMSG_NEXT(nlh, ret);
	ASSERT_EQ(NLMSG_OK(nlh, ret), 0);
}

TEST_F(diag_uid, 1)
{
	int ret;

	ret = send_request(_metadata, self, variant);
	ASSERT_GT(ret, 0);

	receive_response(_metadata, self);
}

TEST_HARNESS_MAIN
