WHILE TRUE GTE 5 Obstacle detected at cm Obstacle detection Create a forward movement to park the robot while avoiding a collision