humanMovementActuator.h

Go to the documentation of this file.

/*******************************************************************************
** Copyright (c) 2013 MAK Technologies, Inc.
** All rights reserved.
*******************************************************************************/



#pragma once

#include <vrfobjcore/actCmpnt.h>
#include "vrfmodel/vrfmodelDefines.h"
#include "vrfutil/lifeformStaticPostures.h"
#include <map>

class DtInputPortGroup;
class DtAnalogInputPort;
class DtVrfMovingObjectStateRepository;
class DtHumanStateRepository;
class DtIntegerInputPort;
class DtHumanMovementActuatorDescriptor;
class DtAttachedTerrain;
class DtBooleanInputPort;
class DtUpdateRepositoryOutputPortGroup;

class DT_DLL_vrfmodel DtHumanMovementActuator : public DtActuatorComponent
{
private:
   DtHumanMovementActuator& operator=(const DtHumanMovementActuator& orig);
   DtHumanMovementActuator(const DtHumanMovementActuator& orig);

public:

   typedef std::map<DtLifeformStaticPosture, DtLifeformState> 
      DtStaticToDynamicPostureMap;

public:
   DtHumanMovementActuator(const DtString& name, 
      DtVrfObject* owner,
      DtSimManager* simManager, 
      DtComponentDescriptor* desc = 0,
      DtReaderWriterRegistry* parentRegistry = 0);

   virtual ~DtHumanMovementActuator();

   virtual bool init();

   virtual DtString type() const;

   virtual void tick();
   
   static DtSimComponent * creator(const DtString& name, 
      DtVrfObject* owner,
      DtSimManager* simManager, 
      DtComponentDescriptor* desc = 0,
      DtReaderWriterRegistry* parentRegistry = 0);

protected:
   virtual double calculateMaxSpeed() const;

   virtual double maxSpeedSoilFactor() const;

   virtual DtVector calculateProjectedLocation(
      const DtVector& oldLocalPosition, const DtVector& newBodyVelocity,
      double newHeading);

   virtual void calculateOrientationAndPosition(
      const DtVector& newLocalProjectedLocation, double newHeading, double newFacingOrientation,
      DtDcm& newLocalOrientation, DtDcm& newLocalDirectionOfMovement, DtVector& newLocalPosition);

   virtual void calculateOrientationAndPositionCrawling(
      const DtVector& newLocalProjectedLocation, double newHeading, double newFacingOrientation,
      DtDcm& newLocalOrientation, DtDcm& newLocalDirectionOfMovement, DtVector& newLocalPosition);

   /*virtual void calculateOrientationAndPositionCrawling(
      const DtVector& newLocalProjectedLocation, double newHeading,
      DtDcm& newLocalOrientation, DtVector& newLocalPosition);*/

   virtual void groundClamp(double heading, 
      const DtVector& location, DtAttachedTerrain& terrainDatabase, DtVector& newNormal);

   virtual void calculateDirectionOfLinearMotion(
      const DtDcm& newLocalOrientation, double desiredDirectionOfMovement, const DtVector& newLocalPosition, 
      DtDcm& newLocalDirectionOfLinearMotion);

   virtual void updateRepository(const DtVector & position,
      const DtVector & velocity, const DtVector & acceleration,
      const DtTaitBryan & localOrientation, const DtVector& rotationalVelocity,
      double newHeading);

   virtual void computeAndSetPosture();

   virtual DtLifeformState computeDynamicPosture(DtLifeformStaticPosture staticPosture);

   virtual DtLifeformStaticPosture restrictPostureForTerrain(DtLifeformStaticPosture desiredPosture);

   virtual bool checkForTerrainCollisions() const;

   virtual bool checkBlockedByTerrain(const DtVector& oldLocalPosition,
      DtVector& newLocalProjectedLocation);

   virtual double maxUprightTerrainPitch() const;

   virtual double maxWalkingSpeed() const;

   virtual void initializeStaticToDynamicPostureMap();

   virtual bool computeEntityDirOfMovement(double& heading) const;

   virtual double calculateTerrainPitch(const DtVector& localPosition, 
      double heading, 
      const DtAttachedTerrain& terrain) const;

protected:
   virtual bool createPorts();

   virtual bool createPortGroups();

protected:

   DtAnalogInputPort* myMovementDirectionInputPort;

   DtAnalogInputPort* myFacingDirectionInputPort;

   DtAnalogInputPort* mySpeedInputPort;

   DtInputPortGroup* myMovementControlInputPortGroup;

   DtIntegerInputPort* myDesiredStaticPostureInputPort;

   DtVrfMovingObjectStateRepository* myMovingObjectStateRepository;
   DtHumanStateRepository* myHumanStateRepository;

   mutable double myMutablePitch;
   mutable bool myMutablePitchValid;

   DtVector myLastParentPosition;

   DtStaticToDynamicPostureMap myStaticToDynamicPostureMap;

   const DtHumanMovementActuatorDescriptor* myHumanMovementActuatorDescriptor;

   bool myPreviouslyEmbarked;

   DtUpdateRepositoryOutputPortGroup* myUpdateRepositoryOutputPortGroup;
};

bool closestIntersectionWithBias(const DtVector& localPosition, DtChordIntersectionRecord& record,
                                 DtIntersectionRecord::DtIntersectionType irtFlag, double bias,
                                 const DtAttachedTerrain* terrain);