source: trunk/MagicSoft/slalib/dav2m.c@ 733

Last change on this file since 733 was 731, checked in by tbretz, 24 years ago
*** empty log message ***
  • Property svn:executable set to *
File size: 1.7 KB
Line 
1#include "slalib.h"
2#include "slamac.h"
3void slaDav2m ( double axvec[3], double rmat[3][3] )
4/*
5** - - - - - - - - -
6** s l a D a v 2 m
7** - - - - - - - - -
8**
9** Form the rotation matrix corresponding to a given axial vector.
10**
11** (double precision)
12**
13** A rotation matrix describes a rotation about some arbitrary axis.
14** The axis is called the Euler axis, and the angle through which the
15** reference frame rotates is called the Euler angle. The axial
16** vector supplied to this routine has the same direction as the
17** Euler axis, and its magnitude is the Euler angle in radians.
18**
19** Given:
20** axvec double[3] axial vector (radians)
21**
22** Returned:
23** rmat double[3][3] rotation matrix
24**
25** If axvec is null, the unit matrix is returned.
26**
27** The reference frame rotates clockwise as seen looking along
28** the axial vector from the origin.
29**
30** Last revision: 25 July 1993
31**
32** Copyright P.T.Wallace. All rights reserved.
33*/
34{
35 double x, y, z, phi, s, c, w;
36
37/* Euler angle - magnitude of axial vector - and functions */
38 x = axvec[0];
39 y = axvec[1];
40 z = axvec[2];
41 phi = sqrt ( x * x + y * y + z * z );
42 s = sin ( phi );
43 c = cos ( phi );
44 w = 1.0 - c;
45
46/* Euler axis - direction of axial vector (perhaps null) */
47 if ( phi != 0.0 ) {
48 x = x / phi;
49 y = y / phi;
50 z = z / phi;
51 }
52
53/* Compute the rotation matrix */
54 rmat[0][0] = x * x * w + c;
55 rmat[0][1] = x * y * w + z * s;
56 rmat[0][2] = x * z * w - y * s;
57 rmat[1][0] = x * y * w - z * s;
58 rmat[1][1] = y * y * w + c;
59 rmat[1][2] = y * z * w + x * s;
60 rmat[2][0] = x * z * w + y * s;
61 rmat[2][1] = y * z * w - x * s;
62 rmat[2][2] = z * z * w + c;
63}
Note: See TracBrowser for help on using the repository browser.