//-----------------------------------------------------------------------------
// Name: Bound::operator*
// Desc: transforms the bound by the current matrix
//-----------------------------------------------------------------------------
Bound Bound::operator*( CXMMATRIX World ) const
{
//$OPTIMIZE: store matrix decomposed
XMVECTOR Translation = World.r[3];
FLOAT Scale = XMVectorGetX( XMVector3Length( World.r[2] ) );
XMVECTOR Rotation = XMQuaternionNormalize( XMQuaternionRotationMatrix( World ) );
// switch based off this bounds type and call the correct
// bound transform function
switch( m_Type )
{
case Bound::Sphere_Bound:
{
Sphere WorldSphere = GetSphere();
TransformSphere( &WorldSphere,
&WorldSphere,
Scale,
Rotation,
Translation );
return Bound( WorldSphere );
}
case Bound::Frustum_Bound:
{
Frustum WorldFrustum = GetFrustum();
TransformFrustum( &WorldFrustum,
&WorldFrustum,
Scale,
Rotation,
Translation );
return Bound( WorldFrustum );
}
case Bound::OBB_Bound:
{
OrientedBox WorldObb = GetObb();
TransformOrientedBox( &WorldObb,
&WorldObb,
Scale,
Rotation,
Translation );
return Bound( WorldObb );
}
case Bound::AABB_Bound:
{
AxisAlignedBox WorldAabb = GetAabb();
TransformAxisAlignedBox( &WorldAabb,
&WorldAabb,
Scale,
Rotation,
Translation );
return Bound( WorldAabb );
}
case Bound::No_Bound:
return Bound();
}
return Bound();
}
void SphereWalker::orientationToPos(XMFLOAT4 qorientation, XMFLOAT3 &npos)
{
float r = SphereWorld::instance()->getRadius();
XMVECTOR xorientation = XMLoadFloat4(&qorientation);
xorientation = XMQuaternionNormalize(xorientation);
XMVECTOR qvec= XMVectorSet(0,0,r,0);
qvec = XMVector3Rotate(qvec, xorientation);
XMStoreFloat3(&npos, qvec);
}
void D3DCamera::Render(XMVECTOR translate, XMVECTOR rotate, bool move, bool playback)
{
XMVECTOR upVector, lookAtVector, rightVector;
XMMATRIX rotationMatrix;
rightVector = XMVectorSet(1.0f, 0.0f, 0.0f, 0.0f);
upVector = XMVectorSet(0.0f, 1.0f, 0.0f, 0.0f);
lookAtVector = XMVectorSet(0.0f, 0.0f, 1.0f, 0.0f);
if (move)
{
XMVECTOR quaternion = XMQuaternionRotationRollPitchYawFromVector(rotate);
quaternion = XMQuaternionNormalize(quaternion);
m_rotation = XMQuaternionMultiply(quaternion, m_rotation);
}
if (playback) m_rotation = rotate;
rotationMatrix = XMMatrixRotationQuaternion(m_rotation);
// Transform the lookAt and up vector by the rotation matrix so the view is correctly rotated at the origin.
lookAtVector = XMVector3TransformCoord(lookAtVector, rotationMatrix);
upVector = XMVector3TransformCoord(upVector, rotationMatrix);
rightVector = XMVector3TransformCoord(upVector, rotationMatrix);
if (move)
{
translate = XMVector3TransformCoord(translate, rotationMatrix);
translate = XMVectorSetW(translate, 0);
m_position += translate;
}
if (playback) m_position = translate;
// Translate the rotated camera position to the location of the viewer.
lookAtVector = XMVectorAdd(m_position, lookAtVector);
m_lookAtVector.x = lookAtVector.m128_f32[0];
m_lookAtVector.y = lookAtVector.m128_f32[1];
m_lookAtVector.z = lookAtVector.m128_f32[2];
// Finally create the view matrix from the three updated vectors.
m_viewMatrix = XMMatrixLookAtLH(m_position, lookAtVector, upVector);
return;
}
void AnimationController::Interpolate( float dt ) {
timeSinceStart += dt;
Anim anim = *anims[currentAnim];
float animCurrentTime = fmod( timeSinceStart, anim.totalTime );
for( Bone* bone:anim.boneSet ) {
XMMATRIX rotMat, scaleMat, translateMat;
// Interpolate Rotation
auto rotSetIt = anim.rotChannels.find( bone );
if( rotSetIt==anim.rotChannels.end() ) {
rotMat = XMMatrixIdentity();
} else {
keySet_t rotKeySet = rotSetIt->second;
auto itLow = rotKeySet.lower_bound( animCurrentTime );
if( itLow==rotKeySet.begin() ) {
itLow = rotKeySet.end();
}
--itLow;
auto itHigh = rotKeySet.upper_bound( animCurrentTime );
if( itHigh==rotKeySet.end() ) {
itHigh = rotKeySet.begin();
}
float factor = (animCurrentTime-itLow->first)/(itHigh->first-itLow->first);
XMVECTOR low = XMLoadFloat4( &itLow->second );
XMVECTOR high = XMLoadFloat4( &itHigh->second );
XMVECTOR interp = XMQuaternionSlerp( low, high, factor );
XMVECTOR normalized = XMQuaternionNormalize( interp );
rotMat = XMMatrixRotationQuaternion( interp );
}
// Interpolate Scale
auto scaleSetIt = anim.scaleChannels.find( bone );
if( scaleSetIt==anim.scaleChannels.end() ) {
scaleMat = XMMatrixIdentity();
} else {
keySet_t scaleKeySet = scaleSetIt->second;
auto itLow = scaleKeySet.lower_bound( animCurrentTime );
if( itLow==scaleKeySet.begin() ) {
itLow = scaleKeySet.end();
}
--itLow;
auto itHigh = scaleKeySet.upper_bound( animCurrentTime );
if( itHigh==scaleKeySet.end() ) {
itHigh = scaleKeySet.begin();
}
float factor = (animCurrentTime-itLow->first)/(itHigh->first-itLow->first);
XMFLOAT4 lowVec = itLow->second;
XMFLOAT4 highVec = itHigh->second;
scaleMat = XMMatrixScaling(
lowVec.x+factor*(highVec.x-lowVec.x),
lowVec.y+factor*(highVec.y-lowVec.y),
lowVec.z+factor*(highVec.z-lowVec.z) );
}
// Interpolate Position
auto posSetIt = anim.posChannels.find( bone );
if( posSetIt==anim.posChannels.end() ) {
translateMat = XMMatrixIdentity();
} else {
keySet_t posKeySet = posSetIt->second;
auto itLow = posKeySet.lower_bound( animCurrentTime );
if( itLow==posKeySet.begin() ) {
itLow = posKeySet.end();
}
--itLow;
auto itHigh = posKeySet.upper_bound( animCurrentTime );
if( itHigh==posKeySet.end() ) {
itHigh = posKeySet.begin();
}
float factor = (animCurrentTime-itLow->first)/(itHigh->first-itLow->first);
XMFLOAT4 lowVec = itLow->second;
XMFLOAT4 highVec = itHigh->second;
translateMat = XMMatrixTranslation(
lowVec.x+factor*(highVec.x-lowVec.x),
lowVec.y+factor*(highVec.y-lowVec.y),
lowVec.z+factor*(highVec.z-lowVec.z) );
}
// Conversion Matrix - this converts imported coords to DirectX
XMMATRIX reflectX = XMMatrixReflect( XMLoadFloat3( &XMFLOAT3( 1.f, 0.f, 0.f ) ) );
XMMATRIX reflectY = XMMatrixReflect( XMLoadFloat3( &XMFLOAT3( 0.f, 1.f, 0.f ) ) );
XMMATRIX reflectZ = XMMatrixReflect( XMLoadFloat3( &XMFLOAT3( 0.f, 0.f, 1.f ) ) );
XMMATRIX rotX = XMMatrixRotationX( XM_PIDIV2 );
XMMATRIX rotY = XMMatrixRotationY( XM_PIDIV2 );
XMMATRIX rotZ = XMMatrixRotationZ( XM_PIDIV2 );
int foo = 17; //DELETEME
XMMATRIX flip = XMLoadFloat4x4( &XMFLOAT4X4(
1.f, 0.f, 0.f, 0.f,
0.f, 1.f, 0.f, 0.f,
0.f, 0.f, 1.f, 0.f,
0.f, 0.f, 0.f, 1.f
) );
XMMATRIX finalMat = scaleMat * rotMat * translateMat;
XMFLOAT4X4 transform;
XMStoreFloat4x4( &transform, finalMat );
finalTransform[bone] = transform;
}
}
void normalise()
{
XMStoreFloat4A(this, XMQuaternionNormalize(*this));
}
Quaternion Quaternion::Normalize(const Quaternion& q)
{
return Quaternion(XMQuaternionNormalize(q.ToSIMD()));
}