PrismaticJoint.hpp

Go to the documentation of this file.

/*
 * Original work Copyright (c) 2006-2011 Erin Catto http://www.box2d.org
 * Modified work Copyright (c) 2017 Louis Langholtz https://github.com/louis-langholtz/PlayRho
 *
 * This software is provided 'as-is', without any express or implied
 * warranty. In no event will the authors be held liable for any damages
 * arising from the use of this software.
 *
 * Permission is granted to anyone to use this software for any purpose,
 * including commercial applications, and to alter it and redistribute it
 * freely, subject to the following restrictions:
 *
 * 1. The origin of this software must not be misrepresented; you must not
 *    claim that you wrote the original software. If you use this software
 *    in a product, an acknowledgment in the product documentation would be
 *    appreciated but is not required.
 * 2. Altered source versions must be plainly marked as such, and must not be
 *    misrepresented as being the original software.
 * 3. This notice may not be removed or altered from any source distribution.
 */
 
#ifndef PLAYRHO_DYNAMICS_JOINTS_PRISMATICJOINT_HPP
#define PLAYRHO_DYNAMICS_JOINTS_PRISMATICJOINT_HPP
 
#include <PlayRho/Dynamics/Joints/Joint.hpp>
#include <PlayRho/Dynamics/Joints/PrismaticJointConf.hpp>
#include <PlayRho/Common/BoundedValue.hpp>
 
namespace playrho {
namespace d2 {
 
class PrismaticJoint : public Joint
{
public:
    
    PrismaticJoint(const PrismaticJointConf& def);
    
    void Accept(JointVisitor& visitor) const override;
    void Accept(JointVisitor& visitor) override;
 
    Length2 GetAnchorA() const override;
    Length2 GetAnchorB() const override;
 
    Momentum2 GetLinearReaction() const override;
    AngularMomentum GetAngularReaction() const override;
 
    Length2 GetLocalAnchorA() const { return m_localAnchorA; }
 
    Length2 GetLocalAnchorB() const  { return m_localAnchorB; }
 
    UnitVec GetLocalAxisA() const { return m_localXAxisA; }
 
    Angle GetReferenceAngle() const { return m_referenceAngle; }
 
    bool IsLimitEnabled() const noexcept;
 
    void EnableLimit(bool flag) noexcept;
 
    Length GetLowerLimit() const noexcept;
 
    Length GetUpperLimit() const noexcept;
 
    void SetLimits(Length lower, Length upper) noexcept;
 
    bool IsMotorEnabled() const noexcept;
 
    void EnableMotor(bool flag) noexcept;
 
    void SetMotorSpeed(AngularVelocity speed) noexcept;
 
    AngularVelocity GetMotorSpeed() const noexcept;
 
    void SetMaxMotorForce(Force force) noexcept;
 
    Force GetMaxMotorForce() const noexcept { return m_maxMotorForce; }
 
    Momentum GetMotorImpulse() const noexcept { return m_motorImpulse; }
 
    LimitState GetLimitState() const noexcept;
    
private:
    void InitVelocityConstraints(BodyConstraintsMap& bodies, const StepConf& step,
                                 const ConstraintSolverConf& conf) override;
    bool SolveVelocityConstraints(BodyConstraintsMap& bodies, const StepConf& step) override;
    bool SolvePositionConstraints(BodyConstraintsMap& bodies,
                                  const ConstraintSolverConf& conf) const override;
 
    // Solver shared
    Length2 m_localAnchorA; 
    Length2 m_localAnchorB; 
    UnitVec m_localXAxisA; 
    UnitVec m_localYAxisA; 
    Angle m_referenceAngle; 
    Vec3 m_impulse = Vec3{}; 
    Momentum m_motorImpulse = 0; 
    Length m_lowerTranslation; 
    Length m_upperTranslation; 
    Force m_maxMotorForce; 
    AngularVelocity m_motorSpeed; 
    bool m_enableLimit; 
    bool m_enableMotor; 
    LimitState m_limitState = e_inactiveLimit; 
 
    // Solver temp
    UnitVec m_axis = UnitVec::GetZero(); 
    UnitVec m_perp = UnitVec::GetZero(); 
    Length m_s1; 
    Length m_s2; 
    Length m_a1; 
    Length m_a2; 
    Mat33 m_K; 
    Mass m_motorMass = 0_kg; 
};
 
inline Length PrismaticJoint::GetLowerLimit() const noexcept
{
    return m_lowerTranslation;
}
 
inline Length PrismaticJoint::GetUpperLimit() const noexcept
{
    return m_upperTranslation;
}
 
inline bool PrismaticJoint::IsLimitEnabled() const noexcept
{
    return m_enableLimit;
}
 
inline bool PrismaticJoint::IsMotorEnabled() const noexcept
{
    return m_enableMotor;
}
 
inline AngularVelocity PrismaticJoint::GetMotorSpeed() const noexcept
{
    return m_motorSpeed;
}
 
inline Joint::LimitState PrismaticJoint::GetLimitState() const noexcept
{
    return m_limitState;
}
 
Length GetJointTranslation(const PrismaticJoint& joint) noexcept;
 
LinearVelocity GetLinearVelocity(const PrismaticJoint& joint) noexcept;
 
inline Force GetMotorForce(const PrismaticJoint& joint, Frequency inv_dt) noexcept
{
    return joint.GetMotorImpulse() * inv_dt;
}
 
} // namespace d2
} // namespace playrho
 
#endif // PLAYRHO_DYNAMICS_JOINTS_PRISMATICJOINT_HPP