Add interface for pfAuxiliaryPFStandard.

Logrus · May 8, 2016 · 2ab542a · 2ab542a
1 parent 8402281
commit 2ab542a
Show file tree

Hide file tree

Showing 2 changed files with 15 additions and 0 deletions.
diff --git a/libs/slam/include/mrpt/maps/CMultiMetricMapPDF.h b/libs/slam/include/mrpt/maps/CMultiMetricMapPDF.h
@@ -91,6 +91,10 @@ namespace maps
 			const mrpt::obs::CActionCollection	* action,
 			const mrpt::obs::CSensoryFrame		* observation,
 			const bayes::CParticleFilter::TParticleFilterOptions &PF_options );
+		void  prediction_and_update_pfAuxiliaryPFStandard(
+			const mrpt::obs::CActionCollection	* action,
+			const mrpt::obs::CSensoryFrame		* observation,
+			const bayes::CParticleFilter::TParticleFilterOptions &PF_options );
 
 
 	private:

diff --git a/libs/slam/src/slam/CMultiMetricMapPDF_RBPF.cpp b/libs/slam/src/slam/CMultiMetricMapPDF_RBPF.cpp
@@ -148,6 +148,17 @@ void  CMultiMetricMapPDF::prediction_and_update_pfAuxiliaryPFOptimal(
 	MRPT_END
 }
 
+void  CMultiMetricMapPDF::prediction_and_update_pfAuxiliaryPFStandard(
+	const mrpt::obs::CActionCollection	* actions,
+	const mrpt::obs::CSensoryFrame		* sf,
+	const bayes::CParticleFilter::TParticleFilterOptions &PF_options )
+{
+	MRPT_START
+
+	PF_SLAM_implementation_pfAuxiliaryPFStandard<mrpt::slam::detail::TPoseBin2D>( actions, sf, PF_options,options.KLD_params);
+
+	MRPT_END
+}
 
 
 /*----------------------------------------------------------------------------------