refactoring gazebo to become more tas like.  ompl now encapsulated by planner class