/*      $NetBSD: t_cop.c,v 1.4 2014/07/13 21:35:33 alnsn Exp $ */

/*-
 * Copyright (c) 2013-2014 Alexander Nasonov.
 * 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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
 * COPYRIGHT HOLDERS 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/cdefs.h>
__RCSID("$NetBSD: t_cop.c,v 1.4 2014/07/13 21:35:33 alnsn Exp $");

#include <atf-c.h>
#include <stdint.h>
#include <string.h>

#define __BPF_PRIVATE
#include <net/bpf.h>
#include <net/bpfjit.h>

static uint32_t retA(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A);
static uint32_t retBL(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A);
static uint32_t retWL(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A);
static uint32_t retNF(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A);
static uint32_t setARG(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A);

static const bpf_copfunc_t copfuncs[] = {
        &retA,
        &retBL,
        &retWL,
        &retNF,
        &setARG
};

static const bpf_ctx_t ctx = {
        .copfuncs = copfuncs,
        .nfuncs = sizeof(copfuncs) / sizeof(copfuncs[0]),
        .extwords = 0
};

static uint32_t
retA(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A)
{

        return A;
}

static uint32_t
retBL(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A)
{

        return args->buflen;
}

static uint32_t
retWL(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A)
{

        return args->wirelen;
}

static uint32_t
retNF(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A)
{

        return bc->nfuncs;
}

/*
 * COP function with a side effect.
 */
static uint32_t
setARG(const bpf_ctx_t *bc, bpf_args_t *args, uint32_t A)
{
        bool *arg = (bool *)args->arg;
        bool old = *arg;

        *arg = true;
        return old;
}

ATF_TC(libbpfjit_cop_no_ctx);
ATF_TC_HEAD(libbpfjit_cop_no_ctx, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test that bpf program with BPF_COP "
            "instruction isn't valid without a context");
}

ATF_TC_BODY(libbpfjit_cop_no_ctx, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_MISC+BPF_COP, 0),
                BPF_STMT(BPF_RET+BPF_K, 7)
        };

        bpfjit_func_t code;

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        ATF_CHECK(!bpf_validate(insns, insn_count));

        code = bpfjit_generate_code(NULL, insns, insn_count);
        ATF_CHECK(code == NULL);
}

ATF_TC(libbpfjit_cop_ret_A);
ATF_TC_HEAD(libbpfjit_cop_ret_A, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns a content of the A register");
}

ATF_TC_BODY(libbpfjit_cop_ret_A, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COP, 0), // retA
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 13);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_ret_buflen);
ATF_TC_HEAD(libbpfjit_cop_ret_buflen, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns the buflen argument");
}

ATF_TC_BODY(libbpfjit_cop_ret_buflen, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COP, 1), // retBL
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == sizeof(pkt));

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_ret_wirelen);
ATF_TC_HEAD(libbpfjit_cop_ret_wirelen, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns the wirelen argument");
}

ATF_TC_BODY(libbpfjit_cop_ret_wirelen, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COP, 2), // retWL
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == sizeof(pkt));

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_ret_nfuncs);
ATF_TC_HEAD(libbpfjit_cop_ret_nfuncs, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns nfuncs member of the context argument");
}

ATF_TC_BODY(libbpfjit_cop_ret_nfuncs, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COP, 3), // retNF
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == ctx.nfuncs);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_side_effect);
ATF_TC_HEAD(libbpfjit_cop_side_effect, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test that ABC optimization doesn't skip BPF_COP call");
}

ATF_TC_BODY(libbpfjit_cop_side_effect, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 0),
                BPF_STMT(BPF_MISC+BPF_COP, 4), // setARG
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 99999),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        bool arg = false;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
                .mem = NULL,
                .arg = &arg
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 0);
        ATF_CHECK(arg == true);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_copx);
ATF_TC_HEAD(libbpfjit_cop_copx, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test BPF_COP call followed by BPF_COPX call");
}

ATF_TC_BODY(libbpfjit_cop_copx, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 1),         /* A <- 1    */
                BPF_STMT(BPF_MISC+BPF_COP, 0),       /* retA      */
                BPF_STMT(BPF_MISC+BPF_TAX, 0),       /* X <- A    */
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 0),   /* A = P[0]  */
                BPF_STMT(BPF_ALU+BPF_ADD+BPF_X, 1),  /* A = A + X */
                BPF_STMT(BPF_MISC+BPF_TAX, 0),       /* X <- A    */
                BPF_STMT(BPF_MISC+BPF_COPX, 0),      /* retNF     */
                BPF_STMT(BPF_ALU+BPF_ADD+BPF_X, 1),  /* A = A + X */
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 2 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 3 + ctx.nfuncs);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_cop_invalid_index);
ATF_TC_HEAD(libbpfjit_cop_invalid_index, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test that out-of-range coprocessor function fails validation");
}

ATF_TC_BODY(libbpfjit_cop_invalid_index, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COP, 6), // invalid index
                BPF_STMT(BPF_RET+BPF_K, 27)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        ATF_CHECK(bpfjit_generate_code(&ctx, insns, insn_count) == NULL);
}

ATF_TC(libbpfjit_copx_no_ctx);
ATF_TC_HEAD(libbpfjit_copx_no_ctx, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test that bpf program with BPF_COPX "
            "instruction isn't valid without a context");
}

ATF_TC_BODY(libbpfjit_copx_no_ctx, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_MISC+BPF_COP, 0),
                BPF_STMT(BPF_RET+BPF_K, 7)
        };

        bpfjit_func_t code;

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        ATF_CHECK(!bpf_validate(insns, insn_count));

        code = bpfjit_generate_code(NULL, insns, insn_count);
        ATF_CHECK(code == NULL);
}

ATF_TC(libbpfjit_copx_ret_A);
ATF_TC_HEAD(libbpfjit_copx_ret_A, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns a content of the A register");
}

ATF_TC_BODY(libbpfjit_copx_ret_A, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_LDX+BPF_IMM, 0), // retA
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 13);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_ret_buflen);
ATF_TC_HEAD(libbpfjit_copx_ret_buflen, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns the buflen argument");
}

ATF_TC_BODY(libbpfjit_copx_ret_buflen, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_LDX+BPF_IMM, 1), // retBL
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == sizeof(pkt));

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_ret_wirelen);
ATF_TC_HEAD(libbpfjit_copx_ret_wirelen, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns the wirelen argument");
}

ATF_TC_BODY(libbpfjit_copx_ret_wirelen, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LDX+BPF_IMM, 2), // retWL
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == sizeof(pkt));

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_ret_nfuncs);
ATF_TC_HEAD(libbpfjit_copx_ret_nfuncs, tc)
{
        atf_tc_set_md_var(tc, "descr", "Test coprocessor function "
            "that returns nfuncs member of the context argument");
}

ATF_TC_BODY(libbpfjit_copx_ret_nfuncs, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_LDX+BPF_IMM, 3), // retNF
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == ctx.nfuncs);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_side_effect);
ATF_TC_HEAD(libbpfjit_copx_side_effect, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test that ABC optimization doesn't skip BPF_COPX call");
}

ATF_TC_BODY(libbpfjit_copx_side_effect, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LD+BPF_IMM, 13),
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 0),
                BPF_STMT(BPF_LDX+BPF_IMM, 4), // setARG
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 99999),
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        bool arg = false;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
                .mem = NULL,
                .arg = &arg
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 0);
        ATF_CHECK(arg == true);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_cop);
ATF_TC_HEAD(libbpfjit_copx_cop, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test BPF_COPX call followed by BPF_COP call");
}

ATF_TC_BODY(libbpfjit_copx_cop, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LDX+BPF_IMM, 2),        /* X <- 2    */
                BPF_STMT(BPF_MISC+BPF_COPX, 0),      /* retWL     */
                BPF_STMT(BPF_ALU+BPF_ADD+BPF_X, 1),  /* A = A + X */
                BPF_STMT(BPF_MISC+BPF_TAX, 0),       /* X <- A    */
                BPF_STMT(BPF_LD+BPF_B+BPF_ABS, 0),   /* A = P[0]  */
                BPF_STMT(BPF_ALU+BPF_ADD+BPF_X, 1),  /* A = A + X */
                BPF_STMT(BPF_MISC+BPF_TAX, 0),       /* X <- A    */
                BPF_STMT(BPF_MISC+BPF_COP, 3),      /* retNF     */
                BPF_STMT(BPF_ALU+BPF_ADD+BPF_X, 1),  /* A = A + X */
                BPF_STMT(BPF_RET+BPF_A, 0)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 2 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt),
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 5 + ctx.nfuncs);

        bpfjit_free_code(code);
}

ATF_TC(libbpfjit_copx_invalid_index);
ATF_TC_HEAD(libbpfjit_copx_invalid_index, tc)
{
        atf_tc_set_md_var(tc, "descr",
            "Test that out-of-range BPF_COPX call fails at runtime");
}

ATF_TC_BODY(libbpfjit_copx_invalid_index, tc)
{
        static struct bpf_insn insns[] = {
                BPF_STMT(BPF_LDX+BPF_IMM, 5), // invalid index
                BPF_STMT(BPF_MISC+BPF_COPX, 0),
                BPF_STMT(BPF_RET+BPF_K, 27)
        };

        bpfjit_func_t code;
        uint8_t pkt[1] = { 0 };
        bpf_args_t args = {
                .pkt = pkt,
                .buflen = sizeof(pkt),
                .wirelen = sizeof(pkt)
        };

        size_t insn_count = sizeof(insns) / sizeof(insns[0]);

        code = bpfjit_generate_code(&ctx, insns, insn_count);
        ATF_REQUIRE(code != NULL);

        ATF_CHECK(code(&ctx, &args) == 0);

        bpfjit_free_code(code);
}

ATF_TP_ADD_TCS(tp)
{

        /*
         * For every new test please also add a similar test
         * to ../../net/bpfjit/t_cop.c
         */
        ATF_TP_ADD_TC(tp, libbpfjit_cop_no_ctx);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_ret_A);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_ret_buflen);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_ret_wirelen);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_ret_nfuncs);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_side_effect);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_copx);
        ATF_TP_ADD_TC(tp, libbpfjit_cop_invalid_index);

        ATF_TP_ADD_TC(tp, libbpfjit_copx_no_ctx);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_ret_A);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_ret_buflen);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_ret_wirelen);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_ret_nfuncs);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_side_effect);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_cop);
        ATF_TP_ADD_TC(tp, libbpfjit_copx_invalid_index);

        return atf_no_error();
}