Ejemplos de RTQuaternion::fromAngleVector en C++ (Cpp)

Ejemplo n.º 1

Archivo: RTMath.cpp Proyecto: bakercp/RTIMULib2-Teensy

void RTVector3::accelToQuaternion(RTQuaternion& qPose) const
{
    RTVector3 normAccel = *this;
    RTVector3 vec;
    RTVector3 z(0, 0, 1.0);

    normAccel.normalize();

    RTFLOAT angle = acos(RTVector3::dotProduct(z, normAccel));
    RTVector3::crossProduct(normAccel, z, vec);
    vec.normalize();

    qPose.fromAngleVector(angle, vec);
}