Renamed ompl_plugin.cpp to correct file name
Changed OMPL SimpleSetup member variable to shared pointer, passed MotionPlanningRequest to child function
Debug