/*
 * Copyright (c) 2020 Stephanos Ioannidis <root@stephanos.io>
 * Copyright (C) 2010-2020 ARM Limited or its affiliates. All rights reserved.
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#include <ztest.h>
#include <zephyr.h>
#include <stdlib.h>
#include <arm_math.h>
#include <arm_const_structs.h>
#include "../../common/test_common.h"

#include "cq31.pat"

#define SNR_ERROR_THRESH	((float32_t)90)

static void test_arm_cfft_q31(
	const arm_cfft_instance_q31 * inst,
	const q31_t *input, const q31_t *ref, size_t length)
{
	q31_t *output;

	/* Allocate output buffer */
	output = malloc(length * sizeof(q31_t));
	zassert_not_null(output, ASSERT_MSG_BUFFER_ALLOC_FAILED);

	/* Load data in place */
	memcpy(output, input, length * sizeof(q31_t));

	/* Run test function */
	arm_cfft_q31(inst, output, false, true);

	/* Validate output */
	zassert_true(
		test_snr_error_q31(length, output, ref, SNR_ERROR_THRESH),
		ASSERT_MSG_SNR_LIMIT_EXCEED);

	/* Free output buffer */
	free(output);
}

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_16, &arm_cfft_sR_q31_len16,
	in_cfft_noisy_16, ref_cfft_noisy_16, 32);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_32, &arm_cfft_sR_q31_len32,
	in_cfft_noisy_32, ref_cfft_noisy_32, 64);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_64, &arm_cfft_sR_q31_len64,
	in_cfft_noisy_64, ref_cfft_noisy_64, 128);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_128, &arm_cfft_sR_q31_len128,
	in_cfft_noisy_128, ref_cfft_noisy_128, 256);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_256, &arm_cfft_sR_q31_len256,
	in_cfft_noisy_256, ref_cfft_noisy_256, 512);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_512, &arm_cfft_sR_q31_len512,
	in_cfft_noisy_512, ref_cfft_noisy_512, 1024);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_1024, &arm_cfft_sR_q31_len1024,
	in_cfft_noisy_1024, ref_cfft_noisy_1024, 2048);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_2048, &arm_cfft_sR_q31_len2048,
	in_cfft_noisy_2048, ref_cfft_noisy_2048, 4096);

DEFINE_TEST_VARIANT4(arm_cfft_q31, noisy_4096, &arm_cfft_sR_q31_len4096,
	in_cfft_noisy_4096, ref_cfft_noisy_4096, 8192);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_16, &arm_cfft_sR_q31_len16,
	in_cfft_step_16, ref_cfft_step_16, 32);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_32, &arm_cfft_sR_q31_len32,
	in_cfft_step_32, ref_cfft_step_32, 64);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_64, &arm_cfft_sR_q31_len64,
	in_cfft_step_64, ref_cfft_step_64, 128);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_128, &arm_cfft_sR_q31_len128,
	in_cfft_step_128, ref_cfft_step_128, 256);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_256, &arm_cfft_sR_q31_len256,
	in_cfft_step_256, ref_cfft_step_256, 512);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_512, &arm_cfft_sR_q31_len512,
	in_cfft_step_512, ref_cfft_step_512, 1024);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_1024, &arm_cfft_sR_q31_len1024,
	in_cfft_step_1024, ref_cfft_step_1024, 2048);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_2048, &arm_cfft_sR_q31_len2048,
	in_cfft_step_2048, ref_cfft_step_2048, 4096);

DEFINE_TEST_VARIANT4(arm_cfft_q31, step_4096, &arm_cfft_sR_q31_len4096,
	in_cfft_step_4096, ref_cfft_step_4096, 8192);

static void test_arm_cifft_q31(
	const arm_cfft_instance_q31 * inst, int scale_factor,
	const q31_t *input, const q31_t *ref, size_t length)
{
	size_t index;
	q31_t *output, *scaled_ref;

	/* Allocate buffers */
	output = malloc(length * sizeof(q31_t));
	zassert_not_null(output, ASSERT_MSG_BUFFER_ALLOC_FAILED);

	scaled_ref = malloc(length * sizeof(q31_t));
	zassert_not_null(scaled_ref, ASSERT_MSG_BUFFER_ALLOC_FAILED);

	/* Load data in place */
	memcpy(output, input, length * sizeof(q31_t));

	/* Run test function */
	arm_cfft_q31(inst, output, true, true);

	/* Scale reference data */
	for (index = 0; index < length; index++) {
		scaled_ref[index] = ref[index] >> scale_factor;
	}

	/* Validate output */
	zassert_true(
		test_snr_error_q31(length, output, scaled_ref,
			SNR_ERROR_THRESH),
		ASSERT_MSG_SNR_LIMIT_EXCEED);

	/* Free output buffer */
	free(output);
	free(scaled_ref);
}

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_16, &arm_cfft_sR_q31_len16, 4,
	in_cifft_noisy_16, in_cfft_noisy_16, 32);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_32, &arm_cfft_sR_q31_len32, 5,
	in_cifft_noisy_32, in_cfft_noisy_32, 64);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_64, &arm_cfft_sR_q31_len64, 6,
	in_cifft_noisy_64, in_cfft_noisy_64, 128);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_128, &arm_cfft_sR_q31_len128, 7,
	in_cifft_noisy_128, in_cfft_noisy_128, 256);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_256, &arm_cfft_sR_q31_len256, 8,
	in_cifft_noisy_256, in_cfft_noisy_256, 512);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_512, &arm_cfft_sR_q31_len512, 9,
	in_cifft_noisy_512, in_cfft_noisy_512, 1024);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_1024, &arm_cfft_sR_q31_len1024, 10,
	in_cifft_noisy_1024, in_cfft_noisy_1024, 2048);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_2048, &arm_cfft_sR_q31_len2048, 11,
	in_cifft_noisy_2048, in_cfft_noisy_2048, 4096);

DEFINE_TEST_VARIANT5(arm_cifft_q31, noisy_4096, &arm_cfft_sR_q31_len4096, 12,
	in_cifft_noisy_4096, in_cfft_noisy_4096, 8192);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_16, &arm_cfft_sR_q31_len16, 4,
	in_cifft_step_16, in_cfft_step_16, 32);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_32, &arm_cfft_sR_q31_len32, 5,
	in_cifft_step_32, in_cfft_step_32, 64);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_64, &arm_cfft_sR_q31_len64, 6,
	in_cifft_step_64, in_cfft_step_64, 128);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_128, &arm_cfft_sR_q31_len128, 7,
	in_cifft_step_128, in_cfft_step_128, 256);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_256, &arm_cfft_sR_q31_len256, 8,
	in_cifft_step_256, in_cfft_step_256, 512);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_512, &arm_cfft_sR_q31_len512, 9,
	in_cifft_step_512, in_cfft_step_512, 1024);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_1024, &arm_cfft_sR_q31_len1024, 10,
	in_cifft_step_1024, in_cfft_step_1024, 2048);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_2048, &arm_cfft_sR_q31_len2048, 11,
	in_cifft_step_2048, in_cfft_step_2048, 4096);

DEFINE_TEST_VARIANT5(arm_cifft_q31, step_4096, &arm_cfft_sR_q31_len4096, 12,
	in_cifft_step_4096, in_cfft_step_4096, 8192);

void test_transform_cq31(void)
{
	ztest_test_suite(transform_cq31,
		ztest_unit_test(test_arm_cfft_q31_noisy_16),
		ztest_unit_test(test_arm_cifft_q31_noisy_16),
		ztest_unit_test(test_arm_cfft_q31_noisy_32),
		ztest_unit_test(test_arm_cifft_q31_noisy_32),
		ztest_unit_test(test_arm_cfft_q31_noisy_64),
		ztest_unit_test(test_arm_cifft_q31_noisy_64),
		ztest_unit_test(test_arm_cfft_q31_noisy_128),
		ztest_unit_test(test_arm_cifft_q31_noisy_128),
		ztest_unit_test(test_arm_cfft_q31_noisy_256),
		ztest_unit_test(test_arm_cifft_q31_noisy_256),
		ztest_unit_test(test_arm_cfft_q31_noisy_512),
		ztest_unit_test(test_arm_cifft_q31_noisy_512),
		ztest_unit_test(test_arm_cfft_q31_noisy_1024),
		ztest_unit_test(test_arm_cifft_q31_noisy_1024),
		ztest_unit_test(test_arm_cfft_q31_noisy_2048),
		ztest_unit_test(test_arm_cifft_q31_noisy_2048),
		ztest_unit_test(test_arm_cfft_q31_noisy_4096),
		ztest_unit_test(test_arm_cifft_q31_noisy_4096),
		ztest_unit_test(test_arm_cfft_q31_step_16),
		ztest_unit_test(test_arm_cifft_q31_step_16),
		ztest_unit_test(test_arm_cfft_q31_step_32),
		ztest_unit_test(test_arm_cifft_q31_step_32),
		ztest_unit_test(test_arm_cfft_q31_step_64),
		ztest_unit_test(test_arm_cifft_q31_step_64),
		ztest_unit_test(test_arm_cfft_q31_step_128),
		ztest_unit_test(test_arm_cifft_q31_step_128),
		ztest_unit_test(test_arm_cfft_q31_step_256),
		ztest_unit_test(test_arm_cifft_q31_step_256),
		ztest_unit_test(test_arm_cfft_q31_step_512),
		ztest_unit_test(test_arm_cifft_q31_step_512),
		ztest_unit_test(test_arm_cfft_q31_step_1024),
		ztest_unit_test(test_arm_cifft_q31_step_1024),
		ztest_unit_test(test_arm_cfft_q31_step_2048),
		ztest_unit_test(test_arm_cifft_q31_step_2048),
		ztest_unit_test(test_arm_cfft_q31_step_4096),
		ztest_unit_test(test_arm_cifft_q31_step_4096)
		);

	ztest_run_test_suite(transform_cq31);
}