/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2022 Alexander V. Chernikov
 *
 * 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
 */

#include <sys/param.h>
#include <sys/errno.h>
#include <sys/ktrace.h>
#include <sys/socket.h>
#include <sys/un.h>

#include <netinet/in.h>

#include <fcntl.h>
#include <poll.h>
#include <stdio.h>
#include <stdlib.h>

#include <atf-c.h>

static void
check_recvmsg(int cs, int ss, struct sockaddr *sa, const size_t sizes[],
    size_t nsizes)
{
        char buf[9000];

        memset(buf, 0xFF, sizeof(buf));
        for (size_t i = 0; i < nsizes; i++) {
                ssize_t rc;
                size_t sz = sizes[i];
                char tbuf[1];

                ATF_REQUIRE(sz <= sizeof(buf));

                rc = sendto(cs, buf, sz, 0, sa, sa->sa_len);
                ATF_REQUIRE_MSG(rc != -1, "sendto failed: %s", strerror(errno));
                ATF_REQUIRE((size_t)rc == sz);

                rc = recv(ss, NULL, 0, MSG_PEEK | MSG_TRUNC);
                ATF_REQUIRE_MSG(rc >= 0, "recv failed: %s", strerror(errno));
                ATF_REQUIRE((size_t)rc == sz);

                rc = recv(ss, tbuf, sizeof(tbuf), MSG_PEEK | MSG_TRUNC);
                ATF_REQUIRE_MSG(rc >= 0, "recv failed: %s", strerror(errno));
                ATF_REQUIRE((size_t)rc == sz);

                rc = recv(ss, tbuf, sizeof(tbuf), MSG_TRUNC);
                ATF_REQUIRE_MSG(rc >= 0, "recv failed: %s", strerror(errno));
                ATF_REQUIRE((size_t)rc == sz);
        }

        ATF_REQUIRE(close(cs) == 0);
        ATF_REQUIRE(close(ss) == 0);
}

ATF_TC_WITHOUT_HEAD(recv_trunc_afinet_udp);
ATF_TC_BODY(recv_trunc_afinet_udp, tc)
{
        struct sockaddr_in sin;
        struct sockaddr *sa;
        int ss, cs, rc;

        ss = socket(PF_INET, SOCK_DGRAM, 0);
        ATF_REQUIRE(ss >= 0);

        memset(&sin, 0, sizeof(sin));
        sin.sin_family = AF_INET;
        sin.sin_len = sizeof(sin);
        sin.sin_port = htons(6666);
        sin.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
        sa = (struct sockaddr *)&sin;
        rc = bind(ss, sa, sa->sa_len);
        ATF_REQUIRE_MSG(rc == 0, "bind failed: %s", strerror(errno));

        cs = socket(PF_INET, SOCK_DGRAM, 0);
        ATF_REQUIRE(cs >= 0);

        size_t sizes[] = {80, 255, 256, 1024, 4096, 9000};
        check_recvmsg(cs, ss, sa, sizes, nitems(sizes));
}

ATF_TC_WITHOUT_HEAD(recv_trunc_afinet6_udp);
ATF_TC_BODY(recv_trunc_afinet6_udp, tc)
{
        struct sockaddr_in6 sin6;
        struct sockaddr *sa;
        int cs, ss, rc;

        ss = socket(PF_INET6, SOCK_DGRAM, 0);
        ATF_REQUIRE(ss >= 0);

        memset(&sin6, 0, sizeof(sin6));
        sin6.sin6_family = AF_INET6;
        sin6.sin6_len = sizeof(sin6);
        sin6.sin6_port = htons(6666);
        const struct in6_addr in6loopback = IN6ADDR_LOOPBACK_INIT;
        sin6.sin6_addr = in6loopback;
        sa = (struct sockaddr *)&sin6;
        rc = bind(ss, sa, sa->sa_len);
        ATF_REQUIRE_MSG(rc == 0, "bind failed: %s", strerror(errno));

        cs = socket(PF_INET6, SOCK_DGRAM, 0);
        ATF_REQUIRE(cs >= 0);

        size_t sizes[] = {80, 255, 256, 1024, 4096, 9000};
        check_recvmsg(cs, ss, sa, sizes, nitems(sizes));
}

ATF_TC_WITHOUT_HEAD(recv_trunc_afunix_dgram);
ATF_TC_BODY(recv_trunc_afunix_dgram, tc)
{
        struct sockaddr_un sun;
        struct sockaddr *sa;
        int ss, cs, rc;

        ss = socket(PF_UNIX, SOCK_DGRAM, 0);
        ATF_REQUIRE(ss >= 0);

        bzero(&sun, sizeof(sun));
        sun.sun_family = AF_UNIX;
        strlcpy(sun.sun_path, "test_check_recvmsg_socket", sizeof(sun.sun_path));
        sun.sun_len = sizeof(sun);
        sa = (struct sockaddr *)&sun;
        rc = bind(ss, sa, sa->sa_len);
        ATF_REQUIRE_MSG(rc == 0, "bind failed: %s", strerror(errno));

        cs = socket(PF_UNIX, SOCK_DGRAM, 0);
        ATF_REQUIRE(cs >= 0);

        size_t sizes[] = {80, 255, 256, 1024, 2000};
        check_recvmsg(cs, ss, sa, sizes, nitems(sizes));
}

/*
 * Exercise the case where ktrace was used to dump a truncated buffer.
 */
ATF_TC_WITHOUT_HEAD(recvmsg_trunc_ktrace_uio);
ATF_TC_BODY(recvmsg_trunc_ktrace_uio, tc)
{
        struct ktr_header ktr;
        struct msghdr msg;
        struct iovec iov;
        const char *tracepath;
        char buf[128];
        ssize_t nbytes;
        int error, fd, sd[2];

        tracepath = "ktrace";

        error = socketpair(AF_UNIX, SOCK_DGRAM, 0, sd);
        ATF_REQUIRE(error == 0);

        memset(buf, 0, sizeof(buf));
        nbytes = send(sd[0], buf, sizeof(buf), 0);
        ATF_REQUIRE_MSG(nbytes >= 0, "send failed: %s", strerror(errno));
        ATF_REQUIRE((size_t)nbytes == sizeof(buf));

        fd = open(tracepath, O_RDWR | O_CREAT | O_TRUNC, 0644);
        ATF_REQUIRE_MSG(fd >= 0, "open failed: %s", strerror(errno));
        error = ktrace(tracepath, KTROP_SET, KTRFAC_GENIO, getpid());
        ATF_REQUIRE_MSG(error == 0,
            "ktrace(SET) failed: %s", strerror(errno));

        iov.iov_base = buf;
        iov.iov_len = sizeof(buf) - 1; /* truncate */
        memset(&msg, 0, sizeof(msg));
        msg.msg_iov = &iov;
        msg.msg_iovlen = 1;
        nbytes = recvmsg(sd[1], &msg, MSG_TRUNC);
        ATF_REQUIRE_MSG(nbytes >= 0, "recvmsg failed: %s", strerror(errno));
        ATF_REQUIRE((size_t)nbytes == sizeof(buf));
        ATF_REQUIRE((msg.msg_flags & MSG_TRUNC) != 0);

        error = ktrace(tracepath, KTROP_CLEARFILE, 0, getpid());
        ATF_REQUIRE_MSG(error == 0,
            "ktrace(CLEARFILE) failed: %s", strerror(errno));

        nbytes = read(fd, &ktr, sizeof(ktr));
        ATF_REQUIRE_MSG(nbytes >= 0, "read failed: %s", strerror(errno));
        ATF_REQUIRE((size_t)nbytes == sizeof(ktr));
        ATF_REQUIRE((ktr.ktr_type & ~KTR_TYPE) == KTR_GENIO);

        ATF_REQUIRE(close(fd) == 0);
        ATF_REQUIRE(close(sd[0]) == 0);
        ATF_REQUIRE(close(sd[1]) == 0);
}

ATF_TP_ADD_TCS(tp)
{
        ATF_TP_ADD_TC(tp, recv_trunc_afinet_udp);
        ATF_TP_ADD_TC(tp, recv_trunc_afinet6_udp);
        ATF_TP_ADD_TC(tp, recv_trunc_afunix_dgram);
        ATF_TP_ADD_TC(tp, recvmsg_trunc_ktrace_uio);

        return (atf_no_error());
}