Lagað sameinaða kóða eftir merge. Muna fokkin kommur!!

src/main.cpp

@@ -33,7 +33,8 @@ MotorController motor_controller(
     motor,
     controller,
     initialization_state,
-    operational_state
+    operational_state,
+    stopped_state
 );
 
 
@@ -53,11 +54,11 @@ int main()
     sei();
 
 
-    motor_controller.set_states(
-        &initialization_state,
-        &operational_state,
-        &stopped_state
-    );
+    // motor_controller.set_states(
+    //     &initialization_state,
+    //     &operational_state,
+    //     &stopped_state
+    // );
 
 
     motor_controller.begin();

src/motor_controller.cpp

@@ -9,33 +9,35 @@ MotorController::MotorController(
     MotorDriver& motor,
     P_controller& controller,
     State& initialization,
-    State& operational
+    State& operational,
+    State& stopped
 )
     : current_state(nullptr),
-      initialization_state(nullptr),
-      operational_state(nullptr),
-      stopped_state(nullptr),
+      initialization_state(initialization),
+      operational_state(operational),
+      stopped_state(stopped),
       encoder(encoder),
       motor(motor),
       controller(controller),
       led(LED_PIN),
       reference_rpm(DEFAULT_REFERENCE_RPM)
 {
+    initialization_state.set_context(this);
+    operational_state.set_context(this);
+    stopped_state.set_context(this);
 }
 
 
-void MotorController::set_states(
-    State* initialization,
-    State* operational,
-    State* stopped
-)
-{
-    initialization_state = initialization;
-    operational_state = operational;
-    stopped_state = stopped;
-    //initialization_state.set_context(this);
-    //operational_state.set_context(this);
-}
+// void MotorController::set_states(
+//     State* initialization,
+//     State* operational,
+//     State* stopped
+// )
+
+    // initialization_state = initialization;
+    // operational_state = operational;
+    // stopped_state = stopped;
+
 
 
 void MotorController::begin()
@@ -128,13 +130,13 @@ bool MotorController::fault_active()
     return motor.fault_active();
 }
 
-//void MotorController::led_on()
-//{
-//    led.set_hi();
-//}
+void MotorController::led_on()
+{
+   led.set_hi();
+}
 
 
-//void MotorController::led_off()
-//{
-//    led.set_lo();
-//}
+void MotorController::led_off()
+{
+   led.set_lo();
+}

src/motor_driver.cpp

@@ -126,5 +126,5 @@ void MotorDriver::set(double pwm)
 
 bool MotorDriver::fault_active()
 {
-    return !(PIND & (1 << PIND4));p
+    return !(PIND & (1 << PIND4));
 }