summaryrefslogtreecommitdiffstats
path: root/SD-VBS/benchmarks/localization/src/matlab/mclWhole.m
diff options
context:
space:
mode:
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/mclWhole.m')
-rw-r--r--SD-VBS/benchmarks/localization/src/matlab/mclWhole.m18
1 files changed, 0 insertions, 18 deletions
diff --git a/SD-VBS/benchmarks/localization/src/matlab/mclWhole.m b/SD-VBS/benchmarks/localization/src/matlab/mclWhole.m
deleted file mode 100644
index 4e78b8f..0000000
--- a/SD-VBS/benchmarks/localization/src/matlab/mclWhole.m
+++ /dev/null
@@ -1,18 +0,0 @@
1function retW=mclWhole(quat, Ovel, STDDEV_GPSVel, accl, STDDEV_ACCL)
2n=size(quat,1);
3OvelNorm=norm(Ovel);
4if (OvelNorm>0.5)
5 Ovel=Ovel/norm(Ovel);
6 %trick
7 %quat=addEulNoise(quat, STDDEV_GPSVel);
8 orgWorld=quatRot([1 0 0],quatConj(quat));
9 p1=get3DGaussianProb(orgWorld, Ovel, eye(3)./STDDEV_GPSVel);
10else
11 p1=zeros(n,1);
12end
13
14gravity=quatRot(ones(n,1)*[0 0 -9.8], quat);
15p2=get3DGaussianProb(gravity, accl, eye(3)./(STDDEV_ACCL));
16retW=p1+p2;
17retW=retW/sum(retW);
18 \ No newline at end of file