// SPDX-License-Identifier: GPL-2.0
#include <test_progs.h>
#include <network_helpers.h>
#include <net/if.h>
#include "test_xdp.skel.h"
#include "test_xdp_bpf2bpf.skel.h"

struct meta {
 int ifindex;
 int pkt_len;
};

struct test_ctx_s {
 bool passed;
 int pkt_size;
};

struct test_ctx_s test_ctx;

static void on_sample(void *ctx, int cpu, void *data, __u32 size)
{
 struct meta *meta = (struct meta *)data;
 struct ipv4_packet *trace_pkt_v4 = data + sizeof(*meta);
 unsigned char *raw_pkt = data + sizeof(*meta);
 struct test_ctx_s *tst_ctx = ctx;

 ASSERT_GE(size, sizeof(pkt_v4) + sizeof(*meta), "check_size");
 ASSERT_EQ(meta->ifindex, if_nametoindex("lo"), "check_meta_ifindex");
 ASSERT_EQ(meta->pkt_len, tst_ctx->pkt_size, "check_meta_pkt_len");
 ASSERT_EQ(memcmp(trace_pkt_v4, &pkt_v4, sizeof(pkt_v4)), 0,
    "check_packet_content");

 if (meta->pkt_len > sizeof(pkt_v4)) {
  for (int i = 0; i < meta->pkt_len - sizeof(pkt_v4); i++)
   ASSERT_EQ(raw_pkt[i + sizeof(pkt_v4)], (unsigned char)i,
      "check_packet_content");
 }

 tst_ctx->passed = true;
}

#define BUF_SZ 9000

static void run_xdp_bpf2bpf_pkt_size(int pkt_fd, struct perf_buffer *pb,
         struct test_xdp_bpf2bpf *ftrace_skel,
         int pkt_size)
{
 __u8 *buf, *buf_in;
 int err;
 LIBBPF_OPTS(bpf_test_run_opts, topts);

 if (!ASSERT_LE(pkt_size, BUF_SZ, "pkt_size") ||
     !ASSERT_GE(pkt_size, sizeof(pkt_v4), "pkt_size"))
  return;

 buf_in = malloc(BUF_SZ);
 if (!ASSERT_OK_PTR(buf_in, "buf_in malloc()"))
  return;

 buf = malloc(BUF_SZ);
 if (!ASSERT_OK_PTR(buf, "buf malloc()")) {
  free(buf_in);
  return;
 }

 test_ctx.passed = false;
 test_ctx.pkt_size = pkt_size;

 memcpy(buf_in, &pkt_v4, sizeof(pkt_v4));
 if (pkt_size > sizeof(pkt_v4)) {
  for (int i = 0; i < (pkt_size - sizeof(pkt_v4)); i++)
   buf_in[i + sizeof(pkt_v4)] = i;
 }

 /* Run test program */
 topts.data_in = buf_in;
 topts.data_size_in = pkt_size;
 topts.data_out = buf;
 topts.data_size_out = BUF_SZ;

 err = bpf_prog_test_run_opts(pkt_fd, &topts);

 ASSERT_OK(err, "ipv4");
 ASSERT_EQ(topts.retval, XDP_PASS, "ipv4 retval");
 ASSERT_EQ(topts.data_size_out, pkt_size, "ipv4 size");

 /* Make sure bpf_xdp_output() was triggered and it sent the expected
 * data to the perf ring buffer.
 */
 err = perf_buffer__poll(pb, 100);

 ASSERT_GE(err, 0, "perf_buffer__poll");
 ASSERT_TRUE(test_ctx.passed, "test passed");
 /* Verify test results */
 ASSERT_EQ(ftrace_skel->bss->test_result_fentry, if_nametoindex("lo"),
    "fentry result");
 ASSERT_EQ(ftrace_skel->bss->test_result_fexit, XDP_PASS, "fexit result");

 free(buf);
 free(buf_in);
}

void test_xdp_bpf2bpf(void)
{
 int err, pkt_fd, map_fd;
 int pkt_sizes[] = {sizeof(pkt_v4), 1024, 4100, 8200};
 struct iptnl_info value4 = {.family = AF_INET6};
 struct test_xdp *pkt_skel = NULL;
 struct test_xdp_bpf2bpf *ftrace_skel = NULL;
 struct vip key4 = {.protocol = 6, .family = AF_INET};
 struct bpf_program *prog;
 struct perf_buffer *pb = NULL;

 /* Load XDP program to introspect */
 pkt_skel = test_xdp__open_and_load();
 if (!ASSERT_OK_PTR(pkt_skel, "test_xdp__open_and_load"))
  return;

 pkt_fd = bpf_program__fd(pkt_skel->progs._xdp_tx_iptunnel);

 map_fd = bpf_map__fd(pkt_skel->maps.vip2tnl);
 bpf_map_update_elem(map_fd, &key4, &value4, 0);

 /* Load trace program */
 ftrace_skel = test_xdp_bpf2bpf__open();
 if (!ASSERT_OK_PTR(ftrace_skel, "test_xdp_bpf2bpf__open"))
  goto out;

 /* Demonstrate the bpf_program__set_attach_target() API rather than
 * the load with options, i.e. opts.attach_prog_fd.
 */
 prog = ftrace_skel->progs.trace_on_entry;
 bpf_program__set_expected_attach_type(prog, BPF_TRACE_FENTRY);
 bpf_program__set_attach_target(prog, pkt_fd, "_xdp_tx_iptunnel");

 prog = ftrace_skel->progs.trace_on_exit;
 bpf_program__set_expected_attach_type(prog, BPF_TRACE_FEXIT);
 bpf_program__set_attach_target(prog, pkt_fd, "_xdp_tx_iptunnel");

 err = test_xdp_bpf2bpf__load(ftrace_skel);
 if (!ASSERT_OK(err, "test_xdp_bpf2bpf__load"))
  goto out;

 err = test_xdp_bpf2bpf__attach(ftrace_skel);
 if (!ASSERT_OK(err, "test_xdp_bpf2bpf__attach"))
  goto out;

 /* Set up perf buffer */
 pb = perf_buffer__new(bpf_map__fd(ftrace_skel->maps.perf_buf_map), 8,
         on_sample, NULL, &test_ctx, NULL);
 if (!ASSERT_OK_PTR(pb, "perf_buf__new"))
  goto out;

 for (int i = 0; i < ARRAY_SIZE(pkt_sizes); i++)
  run_xdp_bpf2bpf_pkt_size(pkt_fd, pb, ftrace_skel,
      pkt_sizes[i]);
out:
 perf_buffer__free(pb);
 test_xdp__destroy(pkt_skel);
 test_xdp_bpf2bpf__destroy(ftrace_skel);
}