diff options
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/mclWhole.m')
| -rw-r--r-- | SD-VBS/benchmarks/localization/src/matlab/mclWhole.m | 18 |
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 @@ | |||
| 1 | function retW=mclWhole(quat, Ovel, STDDEV_GPSVel, accl, STDDEV_ACCL) | ||
| 2 | n=size(quat,1); | ||
| 3 | OvelNorm=norm(Ovel); | ||
| 4 | if (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); | ||
| 10 | else | ||
| 11 | p1=zeros(n,1); | ||
| 12 | end | ||
| 13 | |||
| 14 | gravity=quatRot(ones(n,1)*[0 0 -9.8], quat); | ||
| 15 | p2=get3DGaussianProb(gravity, accl, eye(3)./(STDDEV_ACCL)); | ||
| 16 | retW=p1+p2; | ||
| 17 | retW=retW/sum(retW); | ||
| 18 | \ No newline at end of file | ||
