#include "initialization_state.h"
#include "motor_controller.h"

#include <Arduino.h>


void InitializationState::enter()
{
    Serial.println();
    Serial.println("State: Initialization");

    context->led_off();

    context->stop_motor();

    context->reset_speed_measurement();

    enter_time_ms = millis();
}


void InitializationState::update()
{
    // Non-blocking bið svo aðallykkjan haldi áfram að keyra
    if (millis() - enter_time_ms >= WAIT_MS)
    {
        context->to_pre_operational();
    }
}


void InitializationState::command(char c)
{
}


void InitializationState::exit()
{
    Serial.println("Boot-up");
}