Bætti við input fyrir p í stopped fyrir fault og samhliða uppfærði UML fyrir það

docs/diagrams/src/motor_state.wsd

@@ -43,5 +43,6 @@ Operational --> Stopped : fault detected
 
 Stopped --> Initialization : reset [r]
 Stopped --> Operational : set operational [o]
+Stopped --> PreOperational : set pre-operational [p]
 
 @enduml

src/stopped_state.cpp

@@ -61,6 +61,13 @@ void StoppedState::command(char c)
 
         context->to_operational();
     }
+
+    else if (c == 'p' || c == 'P')
+    {
+        Serial.println("Command: set pre-operational");
+
+        context->to_pre_operational();
+    }
 }