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 | |||