mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-01 17:10:26 +08:00
17 lines
387 B
Mathematica
17 lines
387 B
Mathematica
|
function LN = adjustLikelihood(L)
|
||
|
|
%ADJUSTLIKELIHOOD Adjust the likelihood with std dev and mean.
|
||
|
|
% LN = adjustLikelihood(L)
|
||
|
|
%
|
||
|
|
% L the likelihood (m,1)
|
||
|
|
% LN the likelihood normalized (m,1)
|
||
|
|
|
||
|
|
m = mean(L); % Calcul mean
|
||
|
|
s = std(L); % Calcul std dev
|
||
|
|
LN = zeros(size(L));
|
||
|
|
for i=1:length(L)
|
||
|
|
if L(i) > m + s
|
||
|
|
LN(i) = (L(i)-s)/m;
|
||
|
|
else
|
||
|
|
LN(i) = 1;
|
||
|
|
end
|
||
|
|
end
|