Rotation3d.h

// Rotation3d.h:
// -------------
//

#ifndef __IPSDKMATH_ROTATION3D_H__
#define __IPSDKMATH_ROTATION3D_H__

// suppression warnings
// warning C4251: 'ipsdk::math::transform::Rotation3d::g_registrator' : struct 'ipsdk::math::transform::Registrator<ipsdk::math::transform::Rotation3d>' needs to have dll-interface to be used by clients of class 'ipsdk::math::transform::Rotation3d'
#pragma warning (push)
#pragma warning (disable : 4251)

#include <IPSDKMath/Geometry/3d/Transform/BaseLinearGeometricTransform3d.h>
#include <IPSDKMath/Geometry/3d/Angles3d.h>

namespace ipsdk {
namespace math {
namespace transform {


class IPSDKMATH_API Rotation3d : public BaseLinearGeometricTransform3d
{
// predefined public type
public:
    IPSDK_ENUM(eTransformParams,

        (eTP_Chi)       
        (eTP_Beta)      
        (eTP_Alpha)     
    );

    // declare geometric transformation 3d
    IPSDK_DECLARE_TRANSFORM3D(Rotation3d);

public:
    Rotation3d()
    {
        setParams(0, 0, 0);
    }
    Rotation3d(const ipReal64 chi, const ipReal64 beta, const ipReal64 alpha)
    {
        setParams(chi, beta, alpha);
    }
    ~Rotation3d() {}

// methods
public:
    static void             transform(const ipReal64 chi, const ipReal64 beta, const ipReal64 alpha,
                                      ipReal64& x, ipReal64& y, ipReal64& z)
    {
        transform(std::cos(chi), std::sin(chi),
                  std::cos(beta), std::sin(beta),
                  std::cos(alpha), std::sin(alpha),
                  x, y, z);
    }
    static void             transform(const ipReal64 cosChi, const ipReal64 sinChi,
                                      const ipReal64 cosBeta, const ipReal64 sinBeta,
                                      const ipReal64 cosAlpha, const ipReal64 sinAlpha,
                                      ipReal64& x, ipReal64& y, ipReal64& z)
    {
        rotate3dInSitu(cosChi, sinChi, cosBeta, sinBeta, cosAlpha, sinAlpha, x, y, z);
    }

    static Matrix4d         getHomogenousMatrix(const ipReal64 chi,
                                                const ipReal64 beta,
                                                const ipReal64 alpha)
    {
        return getHomogenousMatrix(std::cos(chi), std::sin(chi),
                                   std::cos(beta), std::sin(beta),
                                   std::cos(alpha), std::sin(alpha));
    }
    static Matrix4d         getHomogenousMatrix(const ipReal64 cosChi, const ipReal64 sinChi,
                                                const ipReal64 cosBeta, const ipReal64 sinBeta,
                                                const ipReal64 cosAlpha, const ipReal64 sinAlpha)
    {
        Matrix4d transform;
        eulerToMatrix(cosChi, sinChi, cosBeta, sinBeta, cosAlpha, sinAlpha,
                      transform(0, 0), transform(0, 1), transform(0, 2),
                      transform(1, 0), transform(1, 1), transform(1, 2),
                      transform(2, 0), transform(2, 1), transform(2, 2));
        transform(0, 3) = 0;
        transform(1, 3) = 0;
        transform(2, 3) = 0;
        transform(3, 0) = 0; transform(3, 1) = 0; transform(3, 2) = 0; transform(3, 3) = 1;

        return transform;
    }

    static Matrix4d         getInvHomogenousMatrix(const ipReal64 chi, const ipReal64 beta, const ipReal64 alpha)
    {
        // invert input parameters
        ipReal64 invChi= chi;
        ipReal64 invBeta = beta;
        ipReal64 invAlpha = alpha;
        getInvParams(invChi, invBeta, invAlpha);

        return getHomogenousMatrix(invChi, invBeta, invAlpha);
    }

    static void             getInvParams(ipReal64& chi, ipReal64& beta, ipReal64& alpha);

    static Vector           getIdentityParams();

    void                    setParams(const ipReal64 chi, const ipReal64 beta, const ipReal64 alpha)
    {
        _chi = chi;
        _cosChi = std::cos(_chi);
        _sinChi = std::sin(_chi);
        _beta = beta;
        _cosBeta = std::cos(_beta);
        _sinBeta = std::sin(_beta);
        _alpha = alpha;
        _cosAlpha = std::cos(_alpha);
        _sinAlpha = std::sin(_alpha);
    }

    void                    setParams(const Vector& params);

    void                    setIdentity();

    void                    apply(ipReal64& x, ipReal64& y, ipReal64& z) const;

    Matrix4d                getHomogenousMatrix() const;

    Vector                  getParams() const;

    ipReal64                getChi() const;
    ipReal64                getBeta() const;
    ipReal64                getAlpha() const;

    Matrix4d                getInvHomogenousMatrix() const;

    Vector                  getInvParams() const;

// attributes
protected:
    ipReal64        _chi;
    ipReal64        _beta;
    ipReal64        _alpha;

    ipReal64        _cosChi;
    ipReal64        _sinChi;
    ipReal64        _cosBeta;
    ipReal64        _sinBeta;
    ipReal64        _cosAlpha;
    ipReal64        _sinAlpha;
};


inline ipReal64
Rotation3d::getChi() const
{
    return _chi;
}

inline ipReal64
Rotation3d::getBeta() const
{
    return _beta;
}

inline ipReal64
Rotation3d::getAlpha() const
{
    return _alpha;
}

inline void
Rotation3d::setIdentity()
{
    setParams(getIdentityParams());
}


} // end of namespace transform
} // end of namespace math
} // end of namespace ipsdk

#pragma warning (pop)

#endif // __IPSDKMATH_ROTATION3D_H__