diff --git a/Main.ino b/Main.ino index fb80311..47768dd 100644 --- a/Main.ino +++ b/Main.ino @@ -123,6 +123,7 @@ void loop() case State::ForwardToRamp: my_IO.motorControlOn(); my_IO.setSpeed(NORMAL_SPEED); + my_IO.setSpeed(2000.0f); if(my_IO.getAngle(Axes::Y) < -5.0f) { @@ -131,9 +132,11 @@ void loop() break; case State::ForwardToScene: + my_IO.setSpeed(2000.0f); if(my_IO.getAngle(Axes::Y) > -5.0f) { my_IO.setSpeed(ON_STAGE_SPEED); + my_IO.setSpeed(1300.0f); actual_state = my_IO.isSelectedColorBlue() ? State::Turn90Blue : State::Turn90Yellow; //actual_state = State::Dancing; } @@ -159,8 +162,9 @@ void loop() case State::ForwardToSceneEdge: my_IO.setSpeed(ON_STAGE_SPEED); + my_IO.setSpeed(1100.0f); - if(my_IO.getAngle(Axes::Y) > 5.0f) + if(my_IO.getAngle(Axes::Y) > 3.0f) { actual_state = State::Dancing; }