Mercurial > octave-nkf

annotate scripts/quaternion/qtransvmat.m @ 7125:f084ba47812b

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
[project @ 2007-11-08 02:29:23 by jwe]
author jwe
date Thu, 08 Nov 2007 02:29:24 +0000
parents a1dbe9d80eee
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
7017
a1dbe9d80eee [project @ 2007-10-12 21:27:11 by jwe]
jwe
parents: 7016
diff changeset
1 ## Copyright (C) 1998, 2000, 2002, 2004, 2005, 2007
a1dbe9d80eee [project @ 2007-10-12 21:27:11 by jwe]
jwe
parents: 7016
diff changeset
2 ## Auburn University. All rights reserved.
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
3 ##
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
4 ## This file is part of Octave.
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
5 ##
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
6 ## Octave is free software; you can redistribute it and/or modify it
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
7 ## under the terms of the GNU General Public License as published by
7016
93c65f2a5668 [project @ 2007-10-12 06:40:56 by jwe]
jwe
parents: 5307
diff changeset
8 ## the Free Software Foundation; either version 3 of the License, or (at
93c65f2a5668 [project @ 2007-10-12 06:40:56 by jwe]
jwe
parents: 5307
diff changeset
9 ## your option) any later version.
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
10 ##
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
11 ## Octave is distributed in the hope that it will be useful, but
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
12 ## WITHOUT ANY WARRANTY; without even the implied warranty of
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
13 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
14 ## General Public License for more details.
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
15 ##
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
16 ## You should have received a copy of the GNU General Public License
7016
93c65f2a5668 [project @ 2007-10-12 06:40:56 by jwe]
jwe
parents: 5307
diff changeset
17 ## along with Octave; see the file COPYING. If not, see
93c65f2a5668 [project @ 2007-10-12 06:40:56 by jwe]
jwe
parents: 5307
diff changeset
18 ## <http://www.gnu.org/licenses/>.
3224
1e7532b9173b [project @ 1998-12-04 22:08:23 by jwe]
jwe
parents:
diff changeset
19
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
20 ## -*- texinfo -*-
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
21 ## @deftypefn {Function File} {} qtransvmat (@var{qib})
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
22 ## Construct a 3x3 transformation matrix from quaternion @var{qib} that
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
23 ## is equivalent to rotation of th radians about axis @var{vv}, where
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
24 ## @code{[@var{vv}, @var{th}] = quaternion (@var{qib})}.
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
25 ## @end deftypefn
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
26
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
27 ## Author: A. S. Hodel <a.s.hodel@eng.auburn.edu>
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
28 ## Adapted-By: jwe
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
29
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
30 function Aib = qtransvmat (qib)
3224
1e7532b9173b [project @ 1998-12-04 22:08:23 by jwe]
jwe
parents:
diff changeset
31
7125
f084ba47812b [project @ 2007-11-08 02:29:23 by jwe]
jwe
parents: 7017
diff changeset
32 if (nargin != 1)
f084ba47812b [project @ 2007-11-08 02:29:23 by jwe]
jwe
parents: 7017
diff changeset
33 print_usage ();
f084ba47812b [project @ 2007-11-08 02:29:23 by jwe]
jwe
parents: 7017
diff changeset
34 endif
f084ba47812b [project @ 2007-11-08 02:29:23 by jwe]
jwe
parents: 7017
diff changeset
35
4030
22bd65326ec1 [project @ 2002-08-09 18:58:13 by jwe]
jwe
parents: 3458
diff changeset
36 if (! isvector(qib) || length (qib) != 4)
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
37 error ("qtransvmat: q(%d,%d) must be a quaternion", rows (qib), \
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
38 columns (qib));
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
39 elseif (max (abs (imag (qib))) != 0)
3458
d25bc039237b [project @ 2000-01-19 09:36:14 by jwe]
jwe
parents: 3452
diff changeset
40 error ("qtransvmat: input values must be real");
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
41 endif
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
42
4877
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
43
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
44 Aib = [(2.*(qib(1)^2 + qib(4)^2) -1.), ...
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
45 (2.*(qib(1)*qib(2)-qib(3)*qib(4))), ...
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
46 (2.*(qib(1)*qib(3)+qib(2)*qib(4)));
4877
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
47 (2.*(qib(1)*qib(2)+qib(3)*qib(4))), ...
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
48 (2.*(qib(2)*qib(2)+qib(4)*qib(4))-1.), ...
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
49 (2.*(qib(2)*qib(3)-qib(1)*qib(4)));
4877
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
50 (2.*(qib(1)*qib(3)-qib(2)*qib(4))), ...
0ab4fd8ded30 [project @ 2004-04-22 19:59:44 by jwe]
jwe
parents: 4030
diff changeset
51 (2.*(qib(2)*qib(3)+qib(1)*qib(4))), ...
3452
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
52 (2.*(qib(3)*qib(3)+qib(4)*qib(4))-1.)];
a892190f4977 [project @ 2000-01-18 06:00:57 by jwe]
jwe
parents: 3224
diff changeset
53
3224
1e7532b9173b [project @ 1998-12-04 22:08:23 by jwe]
jwe
parents:
diff changeset
54 endfunction