summaryrefslogtreecommitdiffstats
path: root/SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m
diff options
context:
space:
mode:
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m')
-rw-r--r--SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m12
1 files changed, 0 insertions, 12 deletions
diff --git a/SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m b/SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m
deleted file mode 100644
index 3d2ac76..0000000
--- a/SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m
+++ /dev/null
@@ -1,12 +0,0 @@
1function retQuat=addEulNoise(quat, STD)
2n=size(quat,1);
3
4% KVS: replacing randnWrapper(n,3) with rand(n,3)
5gyro=randnWrapper(n,3)*STD;
6
7norm_gyro=sqrt(sum(gyro.^2,2));
8angleAlpha=norm_gyro;
9quatDelta=[cos(angleAlpha/2), gyro./(norm_gyro*ones(1,3)).*(sin(angleAlpha/2)*ones(1,3))];
10
11retQuat=quatMul(quat, quatDelta);
12