Simple wall follower planner