File: rotmatrix.h

package info (click to toggle)
healpix-cxx 3.50.0-3
  • links: PTS, VCS
  • area: main
  • in suites: bullseye, sid
  • size: 3,008 kB
  • sloc: cpp: 13,882; ansic: 5,930; sh: 4,451; makefile: 216
file content (134 lines) | stat: -rw-r--r-- 4,796 bytes parent folder | download | duplicates (7)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
/*
 *  This file is part of libcxxsupport.
 *
 *  libcxxsupport is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  libcxxsupport is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with libcxxsupport; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 */

/*
 *  libcxxsupport is being developed at the Max-Planck-Institut fuer Astrophysik
 *  and financially supported by the Deutsches Zentrum fuer Luft- und Raumfahrt
 *  (DLR).
 */

/*! \file rotmatrix.h
 *  Class for rotation transforms in 3D space
 *
 *  Copyright (C) 2003-2011 Max-Planck-Society
 *  \author Martin Reinecke
 */

#ifndef PLANCK_ROTMATRIX_H
#define PLANCK_ROTMATRIX_H

#include <iostream>
#include "vec3.h"

/*! \defgroup rotmatrixgroup Rotation matrices */
/*! \{ */

/*! Class for rotation transforms in 3D space */
class rotmatrix
  {
  public:
    double entry[3][3];

    rotmatrix () {}

    /*! Constructs a rotation matrix from its nine entries */
    rotmatrix (double a00, double a01, double a02,
               double a10, double a11, double a12,
               double a20, double a21, double a22)
      {
      entry[0][0]=a00; entry[0][1]=a01; entry[0][2]=a02;
      entry[1][0]=a10; entry[1][1]=a11; entry[1][2]=a12;
      entry[2][0]=a20; entry[2][1]=a21; entry[2][2]=a22;
      }

    /*! Constructs a rotation matrix so that \a a is the first column,
        \a b is the second column and \a c is the third column.
        \note The vectors \a a, \a b and \a c must form an orthonormal system!
     */
    rotmatrix (const vec3 &a, const vec3 &b, const vec3 &c);

    /*! Sets the matrix to the identity matrix. */
    void SetToIdentity ();
    /*! Sets all matrix elements to zero. */
    void SetToZero ();
    /*! Transposes the matrix. */
    void Transpose ();

    /*! Extracts a unit-length rotation axis \a axis and a rotation angle
        \a angle (in radian) from the matrix. */
    void toAxisAngle (vec3 &axis, double &angle) const;

    /*! Constructs a matrix which causes a rotation by \a angle radians around
        \a axis. \a axis must have unit length. */
    void Make_Axis_Rotation_Transform (const vec3 &axis, double angle);

    /*! Creates a rotation matrix \a A, which performs the following operations
        on a vector \a v, when \a Av is calculated:
        -# rotate \a v around the z-axis by \a gamma,
        -# rotate \a v' around the y-axis by \a beta,
        -# rotate \a v'' around the z-axis by \a alpha.

        \note \a alpha, \a beta and \a gamma are given in radians,
              the rotations are right handed.

        \note This transformation rotates the \e vectors, not the coordinate
              axes! */
    void Make_CPAC_Euler_Matrix (double alpha, double beta, double gamma);

    /*! Extracts the Euler angles \a alpha, \a beta and \a gamma from the
        matrix. For their definition see Make_CPAC_Euler_Matrix().

        \note In case of ambiguity \a alpha will be 0. */
    void Extract_CPAC_Euler_Angles
      (double &alpha, double &beta, double &gamma) const;

    /*! Returns the vector \a vec, transformed by the matrix. */
    vec3 Transform (const vec3 &vec) const
      {
      return vec3
        (vec.x*entry[0][0] + vec.y*entry[0][1] + vec.z*entry[0][2],
         vec.x*entry[1][0] + vec.y*entry[1][1] + vec.z*entry[1][2],
         vec.x*entry[2][0] + vec.y*entry[2][1] + vec.z*entry[2][2]);
      }
    /*! Returns the vector \a vec, transformed by the matrix, in \a vec2. */
    void Transform (const vec3 &vec, vec3 &vec2) const
      {
      vec2.x = vec.x*entry[0][0] + vec.y*entry[0][1] + vec.z*entry[0][2];
      vec2.y = vec.x*entry[1][0] + vec.y*entry[1][1] + vec.z*entry[1][2];
      vec2.z = vec.x*entry[2][0] + vec.y*entry[2][1] + vec.z*entry[2][2];
      }
  };

/*! Returns \a a * \a b.
    \relates rotmatrix */
rotmatrix operator* (const rotmatrix &a, const rotmatrix &b);
/*! Returns \a a * \a b in \a res.
    \relates rotmatrix */
void matmult (const rotmatrix &a, const rotmatrix &b, rotmatrix &res);

/*! Returns \a a^T * \a b in \a res.
    \relates rotmatrix */
void TransposeTimes (const rotmatrix &a, const rotmatrix &b, rotmatrix &res);

/*! Writes \a mat to \a os.
    \relates rotmatrix */
std::ostream &operator<< (std::ostream &os, const rotmatrix &mat);

/*! \} */

#endif