Last change
on this file since 177 was
37,
checked in by (none), 15 years ago
|
Added original make3d
|
-
Property svn:executable set to
*
|
File size:
578 bytes
|
Line | |
---|
1 | function R = vgg_quat_rotation_matrix(q)
|
---|
2 | % vgg_quat_rotation_matrix Generates rotation matrix from quaternion
|
---|
3 | % R = vgg_quat_rotation_matrix(q)
|
---|
4 |
|
---|
5 | q00 = q(1)*q(1);
|
---|
6 | q0x = q(1)*q(2);
|
---|
7 | q0y = q(1)*q(3);
|
---|
8 | q0z = q(1)*q(4);
|
---|
9 | qxx = q(2)*q(2);
|
---|
10 | qxy = q(2)*q(3);
|
---|
11 | qxz = q(2)*q(4);
|
---|
12 | qyy = q(3)*q(3);
|
---|
13 | qyz = q(3)*q(4);
|
---|
14 | qzz = q(4)*q(4);
|
---|
15 |
|
---|
16 | R = [ q00 + qxx - qyy - qzz 2*(qxy - q0z) 2*(qxz + q0y)
|
---|
17 | 2*(qxy + q0z) q00 - qxx + qyy - qzz 2*(qyz - q0x)
|
---|
18 | 2*(qxz - q0y) 2*(qyz + q0x) q00 - qxx - qyy + qzz ];
|
---|
Note: See
TracBrowser
for help on using the repository browser.