diff options
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m')
| -rw-r--r-- | SD-VBS/benchmarks/localization/src/matlab/addEulNoise.m | 12 |
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 @@ | |||
| 1 | function retQuat=addEulNoise(quat, STD) | ||
| 2 | n=size(quat,1); | ||
| 3 | |||
| 4 | % KVS: replacing randnWrapper(n,3) with rand(n,3) | ||
| 5 | gyro=randnWrapper(n,3)*STD; | ||
| 6 | |||
| 7 | norm_gyro=sqrt(sum(gyro.^2,2)); | ||
| 8 | angleAlpha=norm_gyro; | ||
| 9 | quatDelta=[cos(angleAlpha/2), gyro./(norm_gyro*ones(1,3)).*(sin(angleAlpha/2)*ones(1,3))]; | ||
| 10 | |||
| 11 | retQuat=quatMul(quat, quatDelta); | ||
| 12 | |||
