source: branches/FACT++_lidctrl_usb/erfa/src/rv2m.c@ 18729

Last change on this file since 18729 was 18711, checked in by tbretz, 8 years ago
Updated to ERFA 1.3.0 (no relevant code change except the leap second at the beginning of 2017)
File size: 4.4 KB
Line 
1#include "erfa.h"
2
3void eraRv2m(double w[3], double r[3][3])
4/*
5** - - - - - - - -
6** e r a R v 2 m
7** - - - - - - - -
8**
9** Form the r-matrix corresponding to a given r-vector.
10**
11** Given:
12** w double[3] rotation vector (Note 1)
13**
14** Returned:
15** r double[3][3] rotation matrix
16**
17** Notes:
18**
19** 1) A rotation matrix describes a rotation through some angle about
20** some arbitrary axis called the Euler axis. The "rotation vector"
21** supplied to This function has the same direction as the Euler
22** axis, and its magnitude is the angle in radians.
23**
24** 2) If w is null, the unit matrix is returned.
25**
26** 3) The reference frame rotates clockwise as seen looking along the
27** rotation vector from the origin.
28**
29** Copyright (C) 2013-2016, NumFOCUS Foundation.
30** Derived, with permission, from the SOFA library. See notes at end of file.
31*/
32{
33 double x, y, z, phi, s, c, f;
34
35
36/* Euler angle (magnitude of rotation vector) and functions. */
37 x = w[0];
38 y = w[1];
39 z = w[2];
40 phi = sqrt(x*x + y*y + z*z);
41 s = sin(phi);
42 c = cos(phi);
43 f = 1.0 - c;
44
45/* Euler axis (direction of rotation vector), perhaps null. */
46 if (phi > 0.0) {
47 x /= phi;
48 y /= phi;
49 z /= phi;
50 }
51
52/* Form the rotation matrix. */
53 r[0][0] = x*x*f + c;
54 r[0][1] = x*y*f + z*s;
55 r[0][2] = x*z*f - y*s;
56 r[1][0] = y*x*f - z*s;
57 r[1][1] = y*y*f + c;
58 r[1][2] = y*z*f + x*s;
59 r[2][0] = z*x*f + y*s;
60 r[2][1] = z*y*f - x*s;
61 r[2][2] = z*z*f + c;
62
63 return;
64
65}
66/*----------------------------------------------------------------------
67**
68**
69** Copyright (C) 2013-2016, NumFOCUS Foundation.
70** All rights reserved.
71**
72** This library is derived, with permission, from the International
73** Astronomical Union's "Standards of Fundamental Astronomy" library,
74** available from http://www.iausofa.org.
75**
76** The ERFA version is intended to retain identical functionality to
77** the SOFA library, but made distinct through different function and
78** file names, as set out in the SOFA license conditions. The SOFA
79** original has a role as a reference standard for the IAU and IERS,
80** and consequently redistribution is permitted only in its unaltered
81** state. The ERFA version is not subject to this restriction and
82** therefore can be included in distributions which do not support the
83** concept of "read only" software.
84**
85** Although the intent is to replicate the SOFA API (other than
86** replacement of prefix names) and results (with the exception of
87** bugs; any that are discovered will be fixed), SOFA is not
88** responsible for any errors found in this version of the library.
89**
90** If you wish to acknowledge the SOFA heritage, please acknowledge
91** that you are using a library derived from SOFA, rather than SOFA
92** itself.
93**
94**
95** TERMS AND CONDITIONS
96**
97** Redistribution and use in source and binary forms, with or without
98** modification, are permitted provided that the following conditions
99** are met:
100**
101** 1 Redistributions of source code must retain the above copyright
102** notice, this list of conditions and the following disclaimer.
103**
104** 2 Redistributions in binary form must reproduce the above copyright
105** notice, this list of conditions and the following disclaimer in
106** the documentation and/or other materials provided with the
107** distribution.
108**
109** 3 Neither the name of the Standards Of Fundamental Astronomy Board,
110** the International Astronomical Union nor the names of its
111** contributors may be used to endorse or promote products derived
112** from this software without specific prior written permission.
113**
114** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
115** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
116** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
117** FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
118** COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
119** INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
120** BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
121** LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
122** CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
123** LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
124** ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
125** POSSIBILITY OF SUCH DAMAGE.
126**
127*/
Note: See TracBrowser for help on using the repository browser.