1 files changed, 11 insertions, 0 deletions

diff --git a/SD-VBS/benchmarks/localization/src/matlab/calculate3DGaussian.m b/SD-VBS/benchmarks/localization/src/matlab/calculate3DGaussian.m
new file mode 100644
index 0000000..060713a
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/src/matlab/calculate3DGaussian.m
@@ -0,0 +1,11 @@
+function [meanColor A]=calculate3DGaussian(data)
+n_data=size(data,1);
+n_channel=size(data,2);
+meanColor=mean(data);
+diff=double(data)-ones(n_data,1)*meanColor;
+diifTr = transpose(diff);
+Ainv=(diffTr*diff/n_data);
+AinvTr = transpose(Ainv);
+A=inv(AinvTr);
+
+