Method PullingUpdate

ogsr_engine/xrGame/PHCapture.cpp:77–193

}

void CPHCapture::PullingUpdate()
{
    if (!m_taget_element->isActive() || Device.dwTimeGlobal - m_time_start > m_capture_time)
    {
        Release();
        return;
    }

    Fvector dir;
    Fvector capture_bone_position = GetCapturePosition();
    m_taget_element->GetGlobalPositionDynamic(&dir);
    dir.sub(capture_bone_position, dir);
    float dist = dir.magnitude();
    if (dist > m_pull_distance)
    {
        Release();
        return;
    }
    dir.mul(1.f / dist);
    if (dist < m_capture_distance)
    {
        m_back_force = 0.f;

        m_joint = dJointCreateBall(0, 0);
        m_island.AddJoint(m_joint);
        m_ajoint = dJointCreateAMotor(0, 0);
        m_island.AddJoint(m_ajoint);
        dJointSetAMotorMode(m_ajoint, dAMotorEuler);
        dJointSetAMotorNumAxes(m_ajoint, 3);

        CreateBody();
        dBodySetPosition(m_body, capture_bone_position.x, capture_bone_position.y, capture_bone_position.z);
        dJointAttach(m_joint, m_body, m_taget_element->get_body());
        dJointAttach(m_ajoint, m_body, m_taget_element->get_body());
        dJointSetFeedback(m_joint, &m_joint_feedback);
        dJointSetFeedback(m_ajoint, &m_joint_feedback);
        dJointSetBallAnchor(m_joint, capture_bone_position.x, capture_bone_position.y, capture_bone_position.z);

        dJointSetAMotorAxis(m_ajoint, 0, 1, dir.x, dir.y, dir.z);

        if (dir.x > EPS)
        {
            if (dir.y > EPS)
            {
                float mag = dir.x * dir.x + dir.y * dir.y;
                dJointSetAMotorAxis(m_ajoint, 2, 2, -dir.y / mag, dir.x / mag, 0.f);
            }
            else if (dir.z > EPS)
            {
                float mag = dir.x * dir.x + dir.z * dir.z;
                dJointSetAMotorAxis(m_ajoint, 2, 2, -dir.z / mag, 0.f, dir.x / mag);
            }
            else
            {
                dJointSetAMotorAxis(m_ajoint, 2, 2, 1.f, 0.f, 0.f);
            }
        }
        else