diff options
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/quatRot.m')
| -rw-r--r-- | SD-VBS/benchmarks/localization/src/matlab/quatRot.m | 24 |
1 files changed, 0 insertions, 24 deletions
diff --git a/SD-VBS/benchmarks/localization/src/matlab/quatRot.m b/SD-VBS/benchmarks/localization/src/matlab/quatRot.m deleted file mode 100644 index 3688172..0000000 --- a/SD-VBS/benchmarks/localization/src/matlab/quatRot.m +++ /dev/null | |||
| @@ -1,24 +0,0 @@ | |||
| 1 | function ret=quatRot(vec, rQuat) | ||
| 2 | nr=size(vec,1); | ||
| 3 | tv = zeros(nr,1); | ||
| 4 | vQuat=[tv, vec]; | ||
| 5 | temp = quatMul(rQuat, vQuat); | ||
| 6 | temp1 = quatConj(rQuat); | ||
| 7 | retVec = quatMul(temp, temp1); | ||
| 8 | %retVec=quatMul(quatMul(rQuat, vQuat),quatConj(rQuat)); | ||
| 9 | %ret=retVec(:,2:4); | ||
| 10 | rows = size(retVec, 1); | ||
| 11 | ret = zeros(rows,3); | ||
| 12 | |||
| 13 | for i=1:rows | ||
| 14 | k =1; | ||
| 15 | for j=2:4 | ||
| 16 | ret(i,k) = retVec(i,j); | ||
| 17 | k = k+1; | ||
| 18 | end | ||
| 19 | end | ||
| 20 | %size(ret) | ||
| 21 | |||
| 22 | |||
| 23 | |||
| 24 | |||
