Transform.hpp

浏览该文件的文档.

 
 
#pragma once
 
#include "AstGlobal.h"
#include "AstMath/Rotation.hpp"
 
AST_NAMESPACE_BEGIN
 
 
#define _AST_DEF_TRANSFORM_PROPERTIES\
    const Vector3d& translation() const { return translation_; }\
    Vector3d& translation() { return translation_; }\
    const Vector3d& getTranslation() const { return translation_; }\
    Vector3d& getTranslation() { return translation_; }\
    void setTranslation(const Vector3d& translation) { translation_ = translation; }\
 
class Transform
{
public:
 
    Transform() = default;
 
    Transform(const Vector3d& trans, const Rotation& rot);
 
    static Transform Identity();
 
    _AST_DEF_TRANSFORM_PROPERTIES
    _AST_DEF_ROTATION_PROPERTIES
 
 
    Transform& compose(const Transform& next);
 
    Transform composed(const Transform& next) const;
 
    Transform operator*(const Transform& next) const;
 
    Transform& operator*=(const Transform& next);
 
    void getInverse(Transform& inversed) const;
 
    Transform inverse() const;
 
    void setIdentity() { rotation_ = Rotation::Identity(); translation_ = Vector3d::Zero(); }
 
    void transformPosition(const Vector3d& position, Vector3d& positionOut) const;
 
    Vector3d transformPosition(const Vector3d& position) const;
 
protected:
    Vector3d translation_{};  
    Rotation rotation_{};     
};
 
A_ALWAYS_INLINE Transform::Transform(const Vector3d &trans, const Rotation &rot)
    : translation_(trans), rotation_(rot)
{
}
 
A_ALWAYS_INLINE Transform Transform::Identity()
{
    return Transform(Vector3d::Zero(), Rotation::Identity());
}
 
A_ALWAYS_INLINE Transform &Transform::compose(const Transform &next)
{
    translation_ += next.translation() * matrix();
    rotation_ = rotation_.composed(next.rotation());
    return *this;
}
 
A_ALWAYS_INLINE Transform Transform::composed(const Transform &next) const
{
    return Transform(
        translation_ + next.translation() * matrix(),
        rotation_.composed(next.rotation())
    );
}
 
A_ALWAYS_INLINE Transform Transform::operator*(const Transform &next) const
{
    return this->composed(next);
}
 
A_ALWAYS_INLINE Transform &Transform::operator*=(const Transform &next)
{
    return this->compose(next);
}
 
A_ALWAYS_INLINE void Transform::getInverse(Transform &inversed) const
{
    rotation_.transformVector(-translation_, inversed.translation());
    rotation_.getInverse(inversed.rotation());
}
 
A_ALWAYS_INLINE Transform Transform::inverse() const
{
    Transform retval;
    this->getInverse(retval);
    return retval;
}
 
A_ALWAYS_INLINE void Transform::transformPosition(const Vector3d &position, Vector3d &positionOut) const
{
    rotation_.transformVector(position - translation_, positionOut);
}
 
A_ALWAYS_INLINE Vector3d Transform::transformPosition(const Vector3d &position) const
{
    Vector3d retval;
    this->transformPosition(position, retval);
    return retval;
}
 
AST_NAMESPACE_END