Resolve stop bug

Sometimes the robot get stuck in a position because it didn't have enough power