Added PathPlan skeleton