/*
 * @file test_symmetrical_crank.cpp
 *
 * @date Feb 14, 2020
 * @author Andrey Belomutskiy, (c) 2012-2020
 */

#include "engine_test_helper.h"

static void postFourEvents(EngineTestHelper *eth, float mult) {
	eth->fireFall(mult * 384);
	eth->fireRise(mult * 16);
	eth->fireFall(mult * 304);
	eth->fireRise(mult * 16);
}

TEST(engine, testAngleLogicInSymmetricalCrankIssue2980) {
	WITH_ENGINE_TEST_HELPER(MAZDA_MIATA_2003);

	TriggerFormDetails *triggerForm = &ENGINE(triggerCentral.triggerFormDetails);

	TriggerWaveform * form = &ENGINE(triggerCentral.triggerShape);

	#define EXPECT_FINDANGLE(angle, idx) EXPECT_EQ(form->findAngleIndex(triggerForm, angle) & 0xFFFF'FFFE, idx);

	// Check one angle just after every trigger tooth, for two full revolutions (720 degrees, one engine cycle, 4 loops of the trigger)

	// First quarter
	EXPECT_FINDANGLE(0 * 180 + 5, 0);		// 5
	EXPECT_FINDANGLE(0 * 180 + 115, 2);		// 115

	// Second quarter
	EXPECT_FINDANGLE(1 * 180 + 5, 4);		// 180+5 = 185
	EXPECT_FINDANGLE(1 * 180 + 115, 6);		// 180+115 = 295

	// Third quarter
	EXPECT_FINDANGLE(2 * 180 + 5, 8);		// 360+5 = 365
	EXPECT_FINDANGLE(2 * 180 + 115, 10);	// 360+115 = 475

	// Fourth quarter
	EXPECT_FINDANGLE(3 * 180 + 5, 12);		// 540+5 = 545
	EXPECT_FINDANGLE(3 * 180 + 115, 14);	// 540+115 = 655
}

TEST(engine, testSymmetricalCrank) {

	WITH_ENGINE_TEST_HELPER(MAZDA_MIATA_2003);

	// this test is not about isFasterEngineSpinUpEnabled so let's disable it to simplify things
	CONFIG(isFasterEngineSpinUpEnabled) = false;


	ASSERT_EQ(FOUR_STROKE_SYMMETRICAL_CRANK_SENSOR, engine->getOperationMode(PASS_ENGINE_PARAMETER_SIGNATURE));

	float mult = 0.02;

	ASSERT_EQ( 0,  GET_RPM()) << "RPM#0";

	postFourEvents(&eth, mult);
	ASSERT_EQ( 0,  GET_RPM()) << "RPM#0";

	eth.fireFall(mult * 384);
	eth.fireRise(mult * 16);
	eth.fireFall(mult * 304);
	ASSERT_FALSE(engine->triggerCentral.triggerState.getShaftSynchronized());
	eth.fireRise(mult * 16);
	ASSERT_TRUE(engine->triggerCentral.triggerState.getShaftSynchronized());

	ASSERT_EQ( 0,  GET_RPM()) << "RPM#0";



	for (int i = 0; i < 6 ; i++) {
		postFourEvents(&eth, mult);
		ASSERT_EQ( 0,  GET_RPM()) << "RPM#0";
	}

	mult = 0.1;
	postFourEvents(&eth, mult);
	ASSERT_EQ( 1042,  GET_RPM()) << "RPM#11";

	postFourEvents(&eth, mult);
	ASSERT_EQ( 1042,  GET_RPM()) << "RPM#11";

	postFourEvents(&eth, mult);
	ASSERT_EQ( 1042,  GET_RPM()) << "RPM#11";
}