41 lines
638 B
C++
41 lines
638 B
C++
#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");
|
|
}
|