diff options
| author | leochanj105 <leochanj@live.unc.edu> | 2020-10-19 23:09:30 -0400 |
|---|---|---|
| committer | leochanj105 <leochanj@live.unc.edu> | 2020-10-20 02:40:39 -0400 |
| commit | f618466c25d43f3bae9e40920273bf77de1e1149 (patch) | |
| tree | 460e739e2165b8a9c37a9c7ab1b60f5874903543 /SD-VBS/benchmarks/localization/src/matlab/eul2quat.m | |
| parent | 47ced4e96bbb782b9e780e8f2cfc637b2c21ff44 (diff) | |
initial sd-vbs
initial sd-vbs
add sd-vbs
sd-vbs
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/eul2quat.m')
| -rw-r--r-- | SD-VBS/benchmarks/localization/src/matlab/eul2quat.m | 9 |
1 files changed, 9 insertions, 0 deletions
diff --git a/SD-VBS/benchmarks/localization/src/matlab/eul2quat.m b/SD-VBS/benchmarks/localization/src/matlab/eul2quat.m new file mode 100644 index 0000000..57001a8 --- /dev/null +++ b/SD-VBS/benchmarks/localization/src/matlab/eul2quat.m | |||
| @@ -0,0 +1,9 @@ | |||
| 1 | function retQuat=eul2quat(eulAngle) | ||
| 2 | x=eulAngle(:,1); | ||
| 3 | y=eulAngle(:,2); | ||
| 4 | z=eulAngle(:,3); | ||
| 5 | retQuat=[cos(x/2).*cos(y/2).*cos(z/2)+sin(x/2).*sin(y/2).*sin(z/2) ... | ||
| 6 | sin(x/2).*cos(y/2).*cos(z/2)-cos(x/2).*sin(y/2).*sin(z/2) ... | ||
| 7 | cos(x/2).*sin(y/2).*cos(z/2)+sin(x/2).*cos(y/2).*sin(z/2) ... | ||
| 8 | cos(x/2).*cos(y/2).*sin(z/2)-sin(x/2).*sin(y/2).*cos(z/2)]; | ||
| 9 | |||