Added test movement script

firmware/cute_useless_robot/logics.ino

@@ -0,0 +1,8 @@
+/*
+  Main logic handlers
+
+  This file store the behavior of the robot
+  when the switch is pressed
+
+*/
+

firmware/cute_useless_robot/servo.ino

@@ -24,6 +24,19 @@ void pushSwitchDelayed(int coverDelay, int pusherDelay) {
   servoSwitchPusher.write(0);
 }
 
+//Push with a pause before the switch is pushed
+void pushWithHesitation(){
+  servoCoverPusher.write(90);
+  delay(1000);
+  servoSwitchPusher.write(90 + servoAlignmentOffset);
+  delay(2000);
+  servoSwitchPusher.write(130 + servoAlignmentOffset);
+  delay(2500);
+  servoCoverPusher.write(0);
+  servoSwitchPusher.write(0);
+}
+
+
 //Set the pusher servo to arm installation position
 void setSwitchToInstallPosition(){
   servoSwitchPusher.write(125 + servoAlignmentOffset);

firmware/cute_useless_robot/tasks.ino

@@ -108,7 +108,12 @@ void PrimaryController( void * pvParameters ) {
       setAnimationCode('a');
       delay(4000);
       Serial.println("ON");
-      pushSwitchNow();
+      rotateAntiClockwise(50);
+      rotateClockwise(100);
+      rotateAntiClockwise(100);
+      rotateClockwise(50);
+      delay(2000);
+      pushWithHesitation();
       clearFrame();
       delay(3000);
     }else{