// SPDX-License-Identifier: GPL-2.0

#define _GNU_SOURCE
#include <sched.h>
#include <test_progs.h>
#include <pthread.h>
#include <network_helpers.h>
#include <sys/sysinfo.h>

#include "timer_lockup.skel.h"

static long cpu;
static int *timer1_err;
static int *timer2_err;
static bool skip;

volatile int k = 0;

static void *timer_lockup_thread(void *arg)
{
        LIBBPF_OPTS(bpf_test_run_opts, opts,
                .data_in        = &pkt_v4,
                .data_size_in   = sizeof(pkt_v4),
                .repeat         = 1000,
        );
        int i, prog_fd = *(int *)arg;
        cpu_set_t cpuset;

        CPU_ZERO(&cpuset);
        CPU_SET(__sync_fetch_and_add(&cpu, 1), &cpuset);
        ASSERT_OK(pthread_setaffinity_np(pthread_self(), sizeof(cpuset),
                                         &cpuset),
                  "cpu affinity");

        for (i = 0; !READ_ONCE(*timer1_err) && !READ_ONCE(*timer2_err); i++) {
                bpf_prog_test_run_opts(prog_fd, &opts);
                /* Skip the test if we can't reproduce the race in a reasonable
                 * amount of time.
                 */
                if (i > 50) {
                        WRITE_ONCE(skip, true);
                        break;
                }
        }

        return NULL;
}

void test_timer_lockup(void)
{
        int timer1_prog, timer2_prog;
        struct timer_lockup *skel;
        pthread_t thrds[2];
        void *ret;

        if (get_nprocs() < 2) {
                test__skip();
                return;
        }

        skel = timer_lockup__open_and_load();
        if (!skel && errno == EOPNOTSUPP) {
                test__skip();
                return;
        }
        if (!ASSERT_OK_PTR(skel, "timer_lockup__open_and_load"))
                return;

        timer1_prog = bpf_program__fd(skel->progs.timer1_prog);
        timer2_prog = bpf_program__fd(skel->progs.timer2_prog);

        timer1_err = &skel->bss->timer1_err;
        timer2_err = &skel->bss->timer2_err;

        if (!ASSERT_OK(pthread_create(&thrds[0], NULL, timer_lockup_thread,
                                      &timer1_prog),
                       "pthread_create thread1"))
                goto out;
        if (!ASSERT_OK(pthread_create(&thrds[1], NULL, timer_lockup_thread,
                                      &timer2_prog),
                       "pthread_create thread2")) {
                pthread_exit(&thrds[0]);
                goto out;
        }

        pthread_join(thrds[1], &ret);
        pthread_join(thrds[0], &ret);

        if (skip) {
                test__skip();
                goto out;
        }

        if (*timer1_err != -EDEADLK && *timer1_err != 0)
                ASSERT_FAIL("timer1_err bad value");
        if (*timer2_err != -EDEADLK && *timer2_err != 0)
                ASSERT_FAIL("timer2_err bad value");
out:
        timer_lockup__destroy(skel);
        return;
}