OMKTracker.cpp

Go to the documentation of this file.

#include "OMKTracker.h"
#include "OMKAttribute.inl"
#include "OMKTracer.h"
#include "OMKTransformType.h"

using namespace OMK ;
using namespace OMK::Type ;
//-------------------------------------------------------------------------
REGISTER_OBJECT_FACTORY( Tracker, "Tracker" ) ;
//-----------------------------------------------------------------------------

Tracker::Tracker( Controller& ctrl, const ObjectDescriptor& objectDescriptor )
: OMK::SimplePoint( ctrl, objectDescriptor ), 
  _speed( "Speed", 0.1f ),
  _target( "Target", Transform( Wm4::Vector3f::ZERO )  ),
  _followOrientation( false )
{ 
  addAttribute( _speed ) ;
  addAttribute( _target ) ;
}

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

Tracker::~Tracker( void ) 
{
}
//-----------------------------------------------------------------------------
bool Tracker::loadParameters( const ConfigurationParameterDescriptor * node )
{
  SimplePoint::loadParameters( node ) ;
  ParametersAccessor::get( node, "Orientation", _followOrientation ) ;
  
  _refPosition = _position.get() ;
  if( _target.get().getTranslate() != _refPosition.getTranslate() )
  {
    _refOrientation =  _target.get().getTranslate() - _refPosition.getTranslate() ;
    _refOrientation.Normalize() ;
  }
  else
  {
    _refOrientation =  Wm4::Vector3f( 1.0f, 0.0f, 0.0f ) ;
  }
  
  return true ; 
}
//-----------------------------------------------------------------------------

void Tracker::computeParameters() 
{
  if( _target.getInput() && _target.getInput()->getConnectedOutput() ) 
  {
    OMK::Type::Transform position( _refPosition ) ;
  
    Wm4::Vector3f orientation ( _target.get().getTranslate() - _position.get().getTranslate() ) ;
    position.setTranslate( _position.get().getTranslate() + orientation * _speed ) ;
    
    if( _followOrientation ) 
    { // Calculate the orientation
      orientation.Normalize() ;
      Wm4::Vector3f axis( orientation.Cross( _refOrientation ) ) ;
      axis.Normalize() ;
      float angle = -Wm4::Math<float>::ACos( orientation.Dot( _refOrientation ) ) ;
      Wm4::Matrix3f rotationMatrix( axis, angle ) ;
      position.setRotate( position.getRotate() * rotationMatrix ) ;
    }
    // Set the new position
    _position.set( position ) ;
  }
}

---