Implementation of visibility-PRM path planner