Change the mapping starting condition

Now the mapping starts only when the robot is facing the corect direction and not when is a cardinal point