vrsode/src/PhysicsJointHinge2.cpp

Go to the documentation of this file.

#include "PhysicsJointHinge2.h"

#include "PhysicsManager.h"

namespace vrsode
{

PhysicsJointHinge2::PhysicsJointHinge2(VRS::SO<PhysicsBody> p_bodyOne,
                                       VRS::SO<PhysicsBody> p_bodyTwo,
                                       VRS::Vector p_position,
                                       VRS::Vector p_axisOne,
                                       VRS::Vector p_axisTwo)
    : PhysicsJoint(p_bodyOne, p_bodyTwo)
{
    dBodyID bodyOne;
    dBodyID bodyTwo;
    p_bodyOne != 0 ? bodyOne = p_bodyOne->bodyId() : bodyOne = 0;
    p_bodyTwo != 0 ? bodyTwo = p_bodyTwo->bodyId() : bodyTwo = 0;

    setJointId(dJointCreateHinge2(PhysicsManager::get()->worldId(), 0));
    dJointAttach(jointId(), bodyOne, bodyTwo);
    dJointSetHinge2Axis1(
            jointId(), p_axisOne[0], p_axisOne[1], p_axisOne[2]);
    dJointSetHinge2Axis2(
            jointId(), p_axisTwo[0], p_axisTwo[1], p_axisTwo[2]);
    dJointSetHinge2Anchor(
            jointId(), p_position[0], p_position[1], p_position[2]);

    dJointSetData(jointId(), this);
}

PhysicsJointHinge2::~PhysicsJointHinge2()
{
    dJointDestroy(jointId());
}

void
PhysicsJointHinge2::setLowStop(double p_lowStop)
{
    dJointSetHinge2Param(jointId(), dParamLoStop, p_lowStop);
}

void
PhysicsJointHinge2::setHighStop(double p_highStop)
{
    dJointSetHinge2Param(jointId(), dParamHiStop, p_highStop);
}

void
PhysicsJointHinge2::setMotorVelocity(double p_velocity)
{
    dJointSetHinge2Param(jointId(), dParamVel, p_velocity);
}

void
PhysicsJointHinge2::setMotorMaxForce(double p_maxForce)
{
    dJointSetHinge2Param(jointId(), dParamFMax, p_maxForce);
}

void
PhysicsJointHinge2::setStopBounce(double p_bounce)
{
    dJointSetHinge2Param(jointId(), dParamBounce, p_bounce);
}

void
PhysicsJointHinge2::setCFM(double p_cfm)
{
    dJointSetHinge2Param(jointId(), dParamCFM, p_cfm);
}

}

---