// SPDX-License-Identifier: GPL-2.0
/* Copyright (c) 2024 Meta Platforms, Inc. and affiliates. */

#include <argp.h>
#include "bench.h"
#include "crypto_bench.skel.h"

#define MAX_CIPHER_LEN 32
static char *input;
static struct crypto_ctx {
	struct crypto_bench *skel;
	int pfd;
} ctx;

static struct crypto_args {
	u32 crypto_len;
	char *crypto_cipher;
} args = {
	.crypto_len = 16,
	.crypto_cipher = "ecb(aes)",
};

enum {
	ARG_CRYPTO_LEN = 5000,
	ARG_CRYPTO_CIPHER = 5001,
};

static const struct argp_option opts[] = {
	{ "crypto-len", ARG_CRYPTO_LEN, "CRYPTO_LEN", 0,
	  "Set the length of crypto buffer" },
	{ "crypto-cipher", ARG_CRYPTO_CIPHER, "CRYPTO_CIPHER", 0,
	  "Set the cipher to use (default:ecb(aes))" },
	{},
};

static error_t crypto_parse_arg(int key, char *arg, struct argp_state *state)
{
	switch (key) {
	case ARG_CRYPTO_LEN:
		args.crypto_len = strtoul(arg, NULL, 10);
		if (!args.crypto_len ||
		    args.crypto_len > sizeof(ctx.skel->bss->dst)) {
			fprintf(stderr, "Invalid crypto buffer len (limit %zu)\n",
				sizeof(ctx.skel->bss->dst));
			argp_usage(state);
		}
		break;
	case ARG_CRYPTO_CIPHER:
		args.crypto_cipher = strdup(arg);
		if (!strlen(args.crypto_cipher) ||
		    strlen(args.crypto_cipher) > MAX_CIPHER_LEN) {
			fprintf(stderr, "Invalid crypto cipher len (limit %d)\n",
				MAX_CIPHER_LEN);
			argp_usage(state);
		}
		break;
	default:
		return ARGP_ERR_UNKNOWN;
	}

	return 0;
}

const struct argp bench_crypto_argp = {
	.options = opts,
	.parser = crypto_parse_arg,
};

static void crypto_validate(void)
{
	if (env.consumer_cnt != 0) {
		fprintf(stderr, "bpf crypto benchmark doesn't support consumer!\n");
		exit(1);
	}
}

static void crypto_setup(void)
{
	LIBBPF_OPTS(bpf_test_run_opts, opts);

	int err, pfd;
	size_t i, sz;

	sz = args.crypto_len;
	if (!sz || sz > sizeof(ctx.skel->bss->dst)) {
		fprintf(stderr, "invalid encrypt buffer size (source %zu, target %zu)\n",
			sz, sizeof(ctx.skel->bss->dst));
		exit(1);
	}

	setup_libbpf();

	ctx.skel = crypto_bench__open();
	if (!ctx.skel) {
		fprintf(stderr, "failed to open skeleton\n");
		exit(1);
	}

	snprintf(ctx.skel->bss->cipher, 128, "%s", args.crypto_cipher);
	memcpy(ctx.skel->bss->key, "12345678testtest", 16);
	ctx.skel->bss->key_len = 16;
	ctx.skel->bss->authsize = 0;

	srandom(time(NULL));
	input = malloc(sz);
	for (i = 0; i < sz - 1; i++)
		input[i] = '1' + random() % 9;
	input[sz - 1] = '\0';

	ctx.skel->rodata->len = args.crypto_len;

	err = crypto_bench__load(ctx.skel);
	if (err) {
		fprintf(stderr, "failed to load skeleton\n");
		crypto_bench__destroy(ctx.skel);
		exit(1);
	}

	pfd = bpf_program__fd(ctx.skel->progs.crypto_setup);
	if (pfd < 0) {
		fprintf(stderr, "failed to get fd for setup prog\n");
		crypto_bench__destroy(ctx.skel);
		exit(1);
	}

	err = bpf_prog_test_run_opts(pfd, &opts);
	if (err || ctx.skel->bss->status) {
		fprintf(stderr, "failed to run setup prog: err %d, status %d\n",
			err, ctx.skel->bss->status);
		crypto_bench__destroy(ctx.skel);
		exit(1);
	}
}

static void crypto_encrypt_setup(void)
{
	crypto_setup();
	ctx.pfd = bpf_program__fd(ctx.skel->progs.crypto_encrypt);
}

static void crypto_decrypt_setup(void)
{
	crypto_setup();
	ctx.pfd = bpf_program__fd(ctx.skel->progs.crypto_decrypt);
}

static void crypto_measure(struct bench_res *res)
{
	res->hits = atomic_swap(&ctx.skel->bss->hits, 0);
}

static void *crypto_producer(void *unused)
{
	LIBBPF_OPTS(bpf_test_run_opts, opts,
		.repeat = 64,
		.data_in = input,
		.data_size_in = args.crypto_len,
	);

	while (true)
		(void)bpf_prog_test_run_opts(ctx.pfd, &opts);
	return NULL;
}

const struct bench bench_crypto_encrypt = {
	.name = "crypto-encrypt",
	.argp = &bench_crypto_argp,
	.validate = crypto_validate,
	.setup = crypto_encrypt_setup,
	.producer_thread = crypto_producer,
	.measure = crypto_measure,
	.report_progress = hits_drops_report_progress,
	.report_final = hits_drops_report_final,
};

const struct bench bench_crypto_decrypt = {
	.name = "crypto-decrypt",
	.argp = &bench_crypto_argp,
	.validate = crypto_validate,
	.setup = crypto_decrypt_setup,
	.producer_thread = crypto_producer,
	.measure = crypto_measure,
	.report_progress = hits_drops_report_progress,
	.report_final = hits_drops_report_final,
};