Updated to OMPL 0.14.2