#include <decoders.h>
#include <globals.h>
#include <unity.h>
#include "FordST170.h"
#include "scheduler.h"
#include "schedule_calcs.h"

extern uint16_t ignition1EndTooth;
extern uint16_t ignition2EndTooth;
extern uint16_t ignition3EndTooth;
extern uint16_t ignition4EndTooth;

void test_fordst170_newIgn_12_trig0_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 12/1
    //Advance: 10
    //triggerAngle=0
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = 0; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);   
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(34, ignition1EndTooth);

    //Test again with 0 degrees advance
    currentStatus.advance = 0;
    calculateIgnitionAngle1(5);
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(35, ignition1EndTooth);

    //Test again with 35 degrees advance
    currentStatus.advance = 35;
    calculateIgnitionAngle1(5);
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(31, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trig90_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 12/1
    //Advance: 10
    //triggerAngle=90
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = 90; //No trigger offset
    currentStatus.advance = 35;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(22, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trig180_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=180
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = 180; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(16, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trig270_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=270
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = 270; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(7, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trig360_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=360
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = 360; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(34, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trigNeg90_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=-90
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = -90; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(7, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trigNeg180_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=-180
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = -180; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(16, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trigNeg270_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=-270
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    currentStatus.advance = 10; //Set 10 degrees advance
    configPage4.triggerAngle = -270; //No trigger offset
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(25, ignition1EndTooth);
}

void test_fordst170_newIgn_12_trigNeg360_1()
{
    //Test the set end tooth function. Conditions:
    //Trigger: 36-1
    //Advance: 10
    //triggerAngle=-360
    triggerSetup_FordST170();
    configPage4.sparkMode = IGN_MODE_WASTED;
    configPage4.triggerAngle = -360; //No trigger offset
    currentStatus.advance = 10;
    calculateIgnitionAngle1(5);
    
    triggerSetEndTeeth_FordST170();
    TEST_ASSERT_EQUAL(34, ignition1EndTooth);
}

void testFordST170()
{
    RUN_TEST(test_fordst170_newIgn_12_trig0_1);
    RUN_TEST(test_fordst170_newIgn_12_trig90_1);
    RUN_TEST(test_fordst170_newIgn_12_trig180_1);
    RUN_TEST(test_fordst170_newIgn_12_trig270_1);
    RUN_TEST(test_fordst170_newIgn_12_trig360_1);
    RUN_TEST(test_fordst170_newIgn_12_trigNeg90_1);
    RUN_TEST(test_fordst170_newIgn_12_trigNeg180_1);
    RUN_TEST(test_fordst170_newIgn_12_trigNeg270_1);
    RUN_TEST(test_fordst170_newIgn_12_trigNeg360_1);
}