OMKMKMHumano.cpp

Go to the documentation of this file.

#include "OMKMKMHumano.h"
#include "OMKTransform.h"
#include "OMKAddVisualObjectPrm.h"
#include "OMKVisBase.h"
#include "OMKParametersAccessor.inl"
#include "OMKAddAnimatorPrm.h"
#include "OMKConversion.h"
#include "OMKGroundService.h"
#include "OBTServiceManager.h"

using namespace OMK ;
using namespace OMK::Type ;
using namespace OMK::Vis ;

//-------------------------------------------------------------------------
REGISTER_OBJECT_FACTORY( OMK::MKMHumano, "MKMHumano" ) ;
//-----------------------------------------------------------------------------

MKMHumano::MKMHumano( Controller& ctrl, const ObjectDescriptor& objectDescriptor )
: MovingHumano( ctrl, objectDescriptor ),
  _treehMesh(),
  _avatarMaster(),
  _controlMesh()
{ 
}

//-----------------------------------------------------------------------------

MKMHumano::~MKMHumano() 
{
}
//-----------------------------------------------------------------------------

void MKMHumano::finish() 
{
  _avatarMaster.close() ;
}
//-----------------------------------------------------------------------------
void MKMHumano::computeParameters() 
{
  if( !_initDone )
  {
    bool ok = true ;

    // Retrieve parameters
    const ConfigurationParameterDescriptor* node = getConfigurationParameters() ;
    ok = ok && ( node != 0 ) ;

    if( !_position.get().isUniformScale() ) OMERROR( "Scale must be uniform" ) ;
    std::string name = getName().getString() ; 
    ParametersAccessor::get( node, "Name", name ) ;

    std::string meshFile ;
    ok = ok && ParametersAccessor::get( node, "Mesh", meshFile, this ) ;

    std::string nodeAssociationFile ;
    ok = ok && ParametersAccessor::get( node, "NodeAssociation", nodeAssociationFile, this ) ;

    mkSystem::COgreAvatarMeshMaster::ESoftAxis axis = mkSystem::COgreAvatarMeshMaster::EAxis_Default ;
    std::map< std::string, mkSystem::COgreAvatarMeshMaster::ESoftAxis > softAxisMapping ;
    softAxisMapping[ "Default"      ] = mkSystem::COgreAvatarMeshMaster::EAxis_Default      ;
    softAxisMapping[ "UserDefined"  ] = mkSystem::COgreAvatarMeshMaster::EAxis_UserDefined  ;
    softAxisMapping[ "BipedeMax"    ] = mkSystem::COgreAvatarMeshMaster::EAxis_BipedeMax    ;
    softAxisMapping[ "BipedeQuidam" ] = mkSystem::COgreAvatarMeshMaster::EAxis_BipedeQuidam ;

    ParametersAccessor::get( node, "Axis", axis,  softAxisMapping ) ;

    bool useShadows = true ;
    ParametersAccessor::get( node, "UseShadows", useShadows ) ;
    
    bool footPrint = true ;
    ParametersAccessor::get( node, "FootPrint", footPrint ) ;

    float heightCorrection = footPrint ? 0.0f : -1.0f ;
    ParametersAccessor::get( node, "HeightCorrection", heightCorrection ) ;

    float footPrintResistance = 0.5f ;
    ParametersAccessor::get( node, "FootPrintResistance", footPrintResistance ) ;

    bool stackBlending = false ; // true = stack, false = dynamic, default dynamic
    std::map< std::string, bool > blendingMapping ;
    blendingMapping[ "Stack"   ] = true  ;
    blendingMapping[ "Dynamic" ] = false ;
    ParametersAccessor::get( node, "StackBlending", stackBlending, blendingMapping ) ;

    if( ok )
    { // All parameters are ok
      // Initialisation
      _treehMesh.init() ;
      _initialisationSequence = _avatarMaster.init( _treehMesh, meshFile,
                          name, true,
                          nodeAssociationFile,
                          useShadows, axis, 1.0f/_position.get().getScale().X(),
                          0.0f ) ;
      _controlMesh.init( _treehMesh ) ;
      // Configuration
      _controlMesh.setPosition( -_position.get().getTranslate().X(), _position.get().getTranslate().Z(), _position.get().getTranslate().Y() ) ;
      _controlMesh.enableFootprint( footPrint ) ;
      _controlMesh.setHeightCorrection( heightCorrection ) ;
      _controlMesh.setFootprintResistance( footPrintResistance ) ;
      _controlMesh.enableConstraints( false ) ;

      GroundService* groundService = OBT::getService< GroundService >( 'Grnd' ) ;
      if( groundService )
      {
        _controlMesh.getControlFootprint().setGroundClass( &groundService->getGround() ) ;
      }
      if( stackBlending )
        _controlMesh.setStackBlending() ; 
      else 
        _controlMesh.setDynamicBlending() ;
      // Need at least one update
      _controlMesh.update( 1e-9f );
    }
    else
    {
      OMERROR( "Unable to initialise MKM" ) ;
    }
  }
  // Call the ancestor to send the intialisation data
  MovingHumano::computeParameters() ;
  // The avatar master is initialised => update the posture
  if( _avatarMaster.isInitialized() )
    {
    _controlMesh.update( 1.0f / getObjectDescriptor().getFrequency() );
    _controlMesh.getPosture().computeToRelative( _avatarMaster );
    HBT::PostureData* posture = _avatarMaster.computeAndGetPostureDatas() ;
    _posture.set( *posture );
    Transform pos( _position.get() ) ;
    pos.setTranslate( convert( posture->rootPos ) ) ;
    pos.setRotate( convert( posture->rootQuat ) ) ;
    _position.set( pos ) ; 
  }
}

---