khanat-opennel-code/code/nel/src/3d/bone.cpp
2014-08-19 01:57:20 +02:00

299 lines
9 KiB
C++

// NeL - MMORPG Framework <http://dev.ryzom.com/projects/nel/>
// Copyright (C) 2010 Winch Gate Property Limited
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU Affero General Public License as
// published by the Free Software Foundation, either version 3 of the
// License, or (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU Affero General Public License for more details.
//
// You should have received a copy of the GNU Affero General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
#include "std3d.h"
#include "nel/3d/bone.h"
#include "nel/3d/anim_ctrl.h"
#include "nel/misc/hierarchical_timer.h"
namespace NL3D
{
// ***************************************************************************
// ***************************************************************************
// CBoneBase
// ***************************************************************************
// ***************************************************************************
static const CVector UnitScale(1,1,1);
// ***************************************************************************
CBoneBase::CBoneBase() : DefaultPos(CVector(0,0,0)), DefaultRotEuler(CVector(0,0,0)),
DefaultScale(UnitScale), DefaultPivot(CVector(0,0,0)), SkinScale(UnitScale)
{
FatherId= -1;
UnheritScale= true;
// Default: never disable.
LodDisableDistance= 0.f;
}
// ***************************************************************************
void CBoneBase::serial(NLMISC::IStream &f)
{
/*
Version 2:
- SkinScale
Version 1:
- LodDisableDistance
*/
sint ver= f.serialVersion(2);
f.serial(Name);
f.serial(InvBindPos);
f.serial(FatherId);
f.serial(UnheritScale);
if(ver>=1)
f.serial(LodDisableDistance);
else
{
// Default: never disable.
LodDisableDistance= 0.f;
}
f.serial(DefaultPos);
f.serial(DefaultRotEuler);
f.serial(DefaultRotQuat);
f.serial(DefaultScale);
f.serial(DefaultPivot);
if(ver>=2)
f.serial(SkinScale);
}
// ***************************************************************************
// ***************************************************************************
// CBone
// ***************************************************************************
// ***************************************************************************
// ***************************************************************************
CBone::CBone(CBoneBase *boneBase)
{
nlassert(boneBase);
_BoneBase= boneBase;
// IAnimatable.
IAnimatable::resize(AnimValueLast);
ITransformable::setTransformMode(ITransformable::RotQuat);
ITransformable::setPos( _BoneBase->DefaultPos.getDefaultValue() );
ITransformable::setRotQuat( _BoneBase->DefaultRotQuat.getDefaultValue() );
ITransformable::setScale( _BoneBase->DefaultScale.getDefaultValue() );
ITransformable::setPivot( _BoneBase->DefaultPivot.getDefaultValue() );
// By default, the bone is not binded to a channelMixer.
_PosChannelId= -1;
_RotEulerChannelId= -1;
_RotQuatChannelId= -1;
_ScaleChannelId= -1;
_PivotChannelId= -1;
// No animCtrl by default
_AnimCtrl= NULL;
// Get default BoneBase SkinScale
_SkinScale= _BoneBase->SkinScale;
}
// ***************************************************************************
ITrack* CBone::getDefaultTrack (uint valueId)
{
nlassert(_BoneBase);
// what value ?
switch (valueId)
{
case PosValue: return &_BoneBase->DefaultPos;
case RotEulerValue: return &_BoneBase->DefaultRotEuler;
case RotQuatValue: return &_BoneBase->DefaultRotQuat;
case ScaleValue: return &_BoneBase->DefaultScale;
case PivotValue: return &_BoneBase->DefaultPivot;
}
// No, only ITrnasformable values!
nlstop;
// Deriver note: else call BaseClass::getDefaultTrack(valueId);
return NULL;
}
// ***************************************************************************
void CBone::registerToChannelMixer(CChannelMixer *chanMixer, const std::string &prefix)
{
// For CBone, channels are detailled.
// Bkup each channelId (for disable).
_PosChannelId= addValue(chanMixer, PosValue, OwnerBit, prefix, true);
_RotEulerChannelId= addValue(chanMixer, RotEulerValue, OwnerBit, prefix, true);
_RotQuatChannelId= addValue(chanMixer, RotQuatValue, OwnerBit, prefix, true);
_ScaleChannelId= addValue(chanMixer, ScaleValue, OwnerBit, prefix, true);
_PivotChannelId= addValue(chanMixer, PivotValue, OwnerBit, prefix, true);
// Deriver note: if necessary, call BaseClass::registerToChannelMixer(chanMixer, prefix);
}
// ***************************************************************************
void CBone::compute(CBone *parent, const CMatrix &rootMatrix, CSkeletonModel *skeletonForAnimCtrl)
{
// compute is called typically 800 time per frame.
#ifdef NL_DEBUG
nlassert(_BoneBase);
#endif
// get/compute our local matrix
const CMatrix &localMatrix= getMatrix();
// Compute LocalSkeletonMatrix.
// Root case?
if(!parent)
{
_LocalSkeletonMatrix= localMatrix;
}
// Else, son case, take world matrix from parent.
else
{
// UnheritScale case.
if(_BoneBase->UnheritScale)
{
CMatrix invScaleComp;
CVector fatherScale;
CVector trans;
/* Optim note:
the scale is rarely ==1, so don't optimize case where it may be.
*/
// retrieve our translation
localMatrix.getPos(trans);
// retrieve scale from our father.
parent->getScale(fatherScale);
// inverse this scale.
fatherScale.x= 1.0f / fatherScale.x;
fatherScale.y= 1.0f / fatherScale.y;
fatherScale.z= 1.0f / fatherScale.z;
// Compute InverseScale compensation:
// with UnheritScale, formula per bone should be T*Sf-1*P*R*S*P-1.
// But getMatrix() return T*P*R*S*P-1.
// So we must compute T*Sf-1*T-1, in order to get wanted result.
invScaleComp.setScale(fatherScale);
// Faster compute of the translation part: just "trans + fatherScale MUL -trans" where MUL is comp mul
trans.x-= fatherScale.x * trans.x;
trans.y-= fatherScale.y * trans.y;
trans.z-= fatherScale.z * trans.z;
invScaleComp.setPos(trans);
// And finally, we got ParentWM * T*Sf-1*P*R*S*P-1.
// Do: _LocalSkeletonMatrix= parent->_LocalSkeletonMatrix * invScaleComp * localMatrix
static CMatrix tmp;
tmp.setMulMatrixNoProj( parent->_LocalSkeletonMatrix, invScaleComp );
_LocalSkeletonMatrix.setMulMatrixNoProj( tmp, localMatrix );
}
// Normal case.
else
{
// Do: _LocalSkeletonMatrix= parent->_LocalSkeletonMatrix * localMatrix
_LocalSkeletonMatrix.setMulMatrixNoProj( parent->_LocalSkeletonMatrix, localMatrix );
}
}
// Compute WorldMatrix. Do: _WorldMatrix= rootMatrix * _LocalSkeletonMatrix
_WorldMatrix.setMulMatrixNoProj( rootMatrix, _LocalSkeletonMatrix );
// Compute BoneSkinMatrix. Easier of no SkinScale
if(_SkinScale==UnitScale)
{
// Do: _BoneSkinMatrix= _LocalSkeletonMatrix * _BoneBase->InvBindPos
_BoneSkinMatrix.setMulMatrixNoProj( _LocalSkeletonMatrix, _BoneBase->InvBindPos );
}
else
{
// Do: _BoneSkinMatrix= _LocalSkeletonMatrix * SkinScale * _BoneBase->InvBindPos
CMatrix tmp;
CMatrix scaleMat;
scaleMat.setScale(_SkinScale);
tmp.setMulMatrixNoProj(_LocalSkeletonMatrix, scaleMat);
_BoneSkinMatrix.setMulMatrixNoProj( tmp, _BoneBase->InvBindPos );
}
// When compute is done, do extra user ctrl?
if(_AnimCtrl && skeletonForAnimCtrl)
_AnimCtrl->execute(skeletonForAnimCtrl, this);
}
// ***************************************************************************
void CBone::interpolateBoneSkinMatrix(const CMatrix &otherMatrix, float interp)
{
CMatrix &curMatrix= _BoneSkinMatrix;
// interpolate rot/scale. Just interpolate basis vectors
CVector fatherI= otherMatrix.getI();
CVector curI= curMatrix.getI();
curI= fatherI*(1-interp) + curI*interp;
CVector fatherJ= otherMatrix.getJ();
CVector curJ= curMatrix.getJ();
curJ= fatherJ*(1-interp) + curJ*interp;
CVector fatherK= otherMatrix.getK();
CVector curK= curMatrix.getK();
curK= fatherK*(1-interp) + curK*interp;
// replace rotation
curMatrix.setRot(curI, curJ, curK);
// interpolate pos
CVector fatherPos= otherMatrix.getPos();
CVector curPos= curMatrix.getPos();
curPos= fatherPos*(1-interp) + curPos*interp;
curMatrix.setPos(curPos);
}
// ***************************************************************************
void CBone::lodEnableChannels(CChannelMixer *chanMixer, bool enable)
{
nlassert(chanMixer);
// Lod Enable channels if they are correclty registered to the channelMixer.
if( _PosChannelId>=0 )
chanMixer->lodEnableChannel(_PosChannelId, enable);
if( _RotEulerChannelId>=0 )
chanMixer->lodEnableChannel(_RotEulerChannelId, enable);
if( _RotQuatChannelId>=0 )
chanMixer->lodEnableChannel(_RotQuatChannelId, enable);
if( _ScaleChannelId>=0 )
chanMixer->lodEnableChannel(_ScaleChannelId, enable);
if( _PivotChannelId>=0 )
chanMixer->lodEnableChannel(_PivotChannelId, enable);
}
// ***************************************************************************
void CBone::setSkinScale(CVector &skinScale)
{
_SkinScale= skinScale;
}
} // NL3D