mahalanobis.m

移动机器人同时定位与地图创建最前沿技术

function d2 = mahalanobis (z, P)
global calculations;
%-------------------------------------------------------
% 
%-------------------------------------------------------

Cp = chol(P);
y = Cp'\z;
d2 = full(y'*y);