quaternion.h

Go to the documentation of this file.

/*
 MCL
 Copyright (c) 2012-18, Enzo De Sena
 All rights reserved.
 
 Authors: Enzo De Sena, enzodesena@gmail.com
 */

// This file contains definitions of matrix operations and classes

#ifndef MCL_QUATERNION_H
#define MCL_QUATERNION_H

#include "mcltypes.h"
#include "point.h"
#include "constants.h"
#include <cassert>

namespace mcl {
  
  
enum EulerOrder {
  zxz, xyx, yzy, zyz, xzx, yxy,
  xyz, yzx, zxy, xzy, zyx, yxz
};
  
struct AxAng {
  Real x;
  Real y;
  Real z;
  Real angle;
};
  
class Quaternion {
public:
  Quaternion(const Real w, const Real x, const Real y, const Real z) noexcept :
            w_(w), x_(x), y_(y), z_(z) {}
  
  Real w() const noexcept { return w_; }
  Real x() const noexcept { return x_; }
  Real y() const noexcept { return y_; }
  Real z() const noexcept { return z_; }
  
  static Quaternion Identity();
  
  static bool Test();
  
private:
  // q = w + x*i + y*j + z*k where i² = j² = k² = i*j*k = -1
  Real w_;
  Real x_;
  Real y_;
  Real z_;
};
  
Quaternion AxAng2Quat(const Real x, const Real y, const Real z,
                              const Real angle) noexcept;
  
AxAng Quat2AxAng(const Quaternion& q) noexcept;
  
Quaternion QuatConj(const Quaternion& q) noexcept;

Real Norm(const Quaternion& q) noexcept;
  
Point QuatRotate(const Quaternion& q, const Point& r,
                 const Handedness handedness = kRightHanded) noexcept;

Quaternion QuatMultiply(const Quaternion& q, const Quaternion& r) noexcept;
  
Quaternion Eul2Quat(const Real angle_1, const Real angle_2, const Real angle_3,
                    const EulerOrder order = zyx) noexcept;
  
Real Quat2EulX(const Quaternion q,
                       const EulerOrder order = zyx) noexcept;
  
Real Quat2EulY(const Quaternion q,
                       const EulerOrder order = zyx) noexcept;
  
Real Quat2EulZ(const Quaternion q,
                       const EulerOrder order = zyx) noexcept;
  
Quaternion QuatInverse(const Quaternion q) noexcept;
  
} // namespace mcl

#endif