// SPDX-License-Identifier: GPL-2.0
/* Copyright (C) 2023. Huawei Technologies Co., Ltd */
#define _GNU_SOURCE
#include <sched.h>
#include <pthread.h>
#include <stdbool.h>
#include <test_progs.h>

#include "preempted_bpf_ma_op.skel.h"

#define ALLOC_THREAD_NR 4
#define ALLOC_LOOP_NR 512

struct alloc_ctx {
        /* output */
        int run_err;
        /* input */
        int fd;
        bool *nomem_err;
};

static void *run_alloc_prog(void *data)
{
        struct alloc_ctx *ctx = data;
        cpu_set_t cpu_set;
        int i;

        CPU_ZERO(&cpu_set);
        CPU_SET(0, &cpu_set);
        pthread_setaffinity_np(pthread_self(), sizeof(cpu_set), &cpu_set);

        for (i = 0; i < ALLOC_LOOP_NR && !*ctx->nomem_err; i++) {
                LIBBPF_OPTS(bpf_test_run_opts, topts);
                int err;

                err = bpf_prog_test_run_opts(ctx->fd, &topts);
                ctx->run_err |= err | topts.retval;
        }

        return NULL;
}

void test_preempted_bpf_ma_op(void)
{
        struct alloc_ctx ctx[ALLOC_THREAD_NR];
        struct preempted_bpf_ma_op *skel;
        pthread_t tid[ALLOC_THREAD_NR];
        int i, err;

        skel = preempted_bpf_ma_op__open_and_load();
        if (!ASSERT_OK_PTR(skel, "open_and_load"))
                return;

        err = preempted_bpf_ma_op__attach(skel);
        if (!ASSERT_OK(err, "attach"))
                goto out;

        for (i = 0; i < ARRAY_SIZE(ctx); i++) {
                struct bpf_program *prog;
                char name[8];

                snprintf(name, sizeof(name), "test%d", i);
                prog = bpf_object__find_program_by_name(skel->obj, name);
                if (!ASSERT_OK_PTR(prog, "no test prog"))
                        goto out;

                ctx[i].run_err = 0;
                ctx[i].fd = bpf_program__fd(prog);
                ctx[i].nomem_err = &skel->bss->nomem_err;
        }

        memset(tid, 0, sizeof(tid));
        for (i = 0; i < ARRAY_SIZE(tid); i++) {
                err = pthread_create(&tid[i], NULL, run_alloc_prog, &ctx[i]);
                if (!ASSERT_OK(err, "pthread_create"))
                        break;
        }

        for (i = 0; i < ARRAY_SIZE(tid); i++) {
                if (!tid[i])
                        break;
                pthread_join(tid[i], NULL);
                ASSERT_EQ(ctx[i].run_err, 0, "run prog err");
        }

        ASSERT_FALSE(skel->bss->nomem_err, "ENOMEM");
out:
        preempted_bpf_ma_op__destroy(skel);
}