Two new planning groups added to ompl config