feat(slam): add rtabmap_ros

This commit is contained in:
X-lanni
2025-07-14 11:34:38 +08:00
parent 3b6641c1fb
commit 943ce5b06f
1635 changed files with 603092 additions and 0 deletions
@@ -0,0 +1,10 @@
close all
clear all
% Test AvpdCore::BayesFilter::adjustLikelihood()
likelihood = [0 0 0 0];
adjustLikelihoodResult1 = adjustLikelihood(likelihood)
likelihood = [0.3 0.4 0.2 0.9];
theMean = mean(likelihood)
theSdtDev = std(likelihood)
adjustLikelihoodResult2 = floor(adjustLikelihood(likelihood)*1000)