Fix for getMeasure() virtual function OMPL change