diff --git a/Main.ino b/Main.ino index 3f5e5f8..1d19e74 100644 --- a/Main.ino +++ b/Main.ino @@ -118,7 +118,7 @@ void loop() case State::ForwardToRamp: my_IO.motorControlOn(); - my_IO.setSpeed(2048.0f); + my_IO.setSpeed(2000.0f); if(my_IO.getAngle(Axes::Y) < -5.0f) { @@ -127,10 +127,11 @@ void loop() break; case State::ForwardToScene: - my_IO.setSpeed(2048.0f); + my_IO.setSpeed(2000.0f); if(my_IO.getAngle(Axes::Y) > -5.0f) { + my_IO.setSpeed(1300.0f); actual_state = my_IO.isSelectedColorBlue() ? State::Turn90Blue : State::Turn90Yellow; //actual_state = State::Dancing; } @@ -155,9 +156,9 @@ void loop() break; case State::ForwardToSceneEdge: - my_IO.setSpeed(1200.0f); + 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; }