/*----------------------------------------------------------------------------*/
/* Copyright (c) 2018-2019 FIRST. All Rights Reserved.                        */
/* Open Source Software - may be modified and shared by FRC teams. The code   */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project.                                                               */
/*----------------------------------------------------------------------------*/

package frc4388.utility;

import static org.junit.Assert.*;
import static org.mockito.Mockito.*;
import org.junit.*;

import edu.wpi.first.wpilibj.*;

/**
 * Add your docs here.
 */
public class RobotTimeUtilityTest {
    RobotTime robotTime = RobotTime.getInstance();

    @Test
    public void testUpdateTimes() {
        // SETUP
        long lastTime;
        robotTime.m_deltaTime = 0;
        robotTime.m_robotTime = 0;
        robotTime.m_lastRobotTime = 0;
        robotTime.m_frameNumber = 0;
        robotTime.endMatchTime();
        robotTime.m_lastMatchTime = 0;

        // TEST 1
        assertEquals(0, robotTime.m_deltaTime);
        assertEquals(0, robotTime.m_robotTime);
        assertEquals(0, robotTime.m_lastRobotTime);
        assertEquals(0, robotTime.m_frameNumber);
        lastTime = robotTime.m_robotTime;

        // TEST 2
        wait(1);
        robotTime.updateTimes();
        assertEquals(true, robotTime.m_deltaTime > 0);
        assertEquals(true, robotTime.m_robotTime > 0);
        assertEquals(lastTime, robotTime.m_lastRobotTime);
        assertEquals(1, robotTime.m_frameNumber);
        lastTime = robotTime.m_robotTime;

        // TEST 3
        wait(1);
        robotTime.updateTimes();
        assertEquals(true, robotTime.m_deltaTime > 0);
        assertEquals(true, robotTime.m_robotTime > 0);
        assertEquals(lastTime, robotTime.m_lastRobotTime);
        assertEquals(2, robotTime.m_frameNumber);
    }

    @Test
    public void testMatchTime() {
        // SETUP
        long lastTime;

        // TEST 1
        assertEquals(0, robotTime.m_matchTime);
        assertEquals(0, robotTime.m_lastMatchTime);
        lastTime = robotTime.m_matchTime;

        // TEST 2
        robotTime.startMatchTime();
        wait(1);
        robotTime.updateTimes();
        assertEquals(true, robotTime.m_matchTime > 0);
        assertEquals(lastTime, robotTime.m_lastMatchTime);
        lastTime = robotTime.m_matchTime;
        
        // TEST 3
        wait(1);
        robotTime.updateTimes();
        robotTime.endMatchTime();
        assertEquals(0, robotTime.m_matchTime);
        assertEquals(lastTime, robotTime.m_lastMatchTime);
        lastTime = robotTime.m_matchTime;

        // TEST 4
        wait(1);
        robotTime.updateTimes();
        assertEquals(0, robotTime.m_matchTime);
        assertEquals(lastTime, robotTime.m_lastMatchTime);
    }

    private void wait(int millis) {
        try {
            Thread.sleep(millis);
        } catch (Exception e) {}
    }
}