Progress towards a better application FSM, testing

firmware/main_mcu/lib/generic_lib/src/Fsm.cpp

@@ -0,0 +1,15 @@
+#include "Fsm.h"
+
+Fsm::Fsm(State &initialState) :
+    current_state(&initialState)
+{}
+
+void Fsm::transition(State &state) {
+    current_state->onExit();
+    current_state = &state;
+    current_state->onEntry();
+}
+
+void Fsm::step() {
+    current_state->step();
+}