Resolve unfinnished turn

Sometimes the robot was blocked when he was doing a turn, now it behaive corectly