groundMoveToDestinationControllerComponent.h

Go to the documentation of this file.

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




#pragma once


#include "vrfmodel/groundAutoControllerComponent.h"
#include <matrix/vlVector.h>
#include "vrfobjcore/automotivePSR.h"

class DtString;
class DtSimulationServices;
class DtSimMessage;
class DtGroundMoveToDescriptor;
class DtRangeAndDirectionNetworkSegmentMetric;
class DtCollisionInputPort;
class DtInputPortGroup;
class DtActiveBotNavInterface;
class DtCollision;

#include "vrfmodel/vrfmodelDefines.h"
class DT_DLL_vrfmodel DtGroundMoveToDestinationControllerComponent : public DtGroundAutoControllerComponent
{
public:

   DtGroundMoveToDestinationControllerComponent(const DtString& name, 
      DtLocalObject* owner,
      DtSimulationServices* simManager, 
      DtComponentDescriptor* desc = 0,
      DtReaderWriterRegistry* parentRegistry = 0);

   virtual ~DtGroundMoveToDestinationControllerComponent();

   virtual bool init();

   virtual void tick();

   virtual const char* type() const;

   static void setLocationCallback(DtSimMessage* msg, void* usr);
   virtual void processSetLocation(DtSimMessage* msg);
   
   static void modifyVrfObjectCallback(DtSimMessage* msg, void* usr);
   virtual void processModifyVrfObject(DtSimMessage* msg);

   static DtSimComponent * creator(const DtString& name, 
      DtLocalObject* owner,
      DtSimulationServices* simManager, 
      DtComponentDescriptor* desc = 0,
      DtReaderWriterRegistry* parentRegistry = 0);

   virtual void registerTaskMsgCallbacks();

   virtual void clearTask();

   virtual bool getDestination(DtVector & destination);

   virtual const DtVector& destinationVector();

   virtual double findDesiredSpeed();

   virtual double findDesiredHeading();

   virtual DtAutoTransmissionGearEnum determineGearSetting(const double desiredSpeed);

   virtual double headingForNavPath(const DtVector& entityPosition,
      const double entityHeading,
      const double entitySize,
      const double navTargetHeading,
      const DtVector& pathSegStartPosition,
      const DtVector& pathSegEndPosition);

   virtual bool nearDestination();

   virtual bool atDestination();

   virtual bool passedDestination();

   virtual double approximateThrottle(double desiredSpeed, double headingError = 0.0);


   virtual void stop(bool success = true);

   virtual void doMoving();

   virtual void updateTaskVisualizations();

protected:
   virtual bool setupDestination();

   virtual void setupDestinationVector();

   virtual void invalidateDestinationVector() const;

   virtual void moveToDestination();
   virtual double distanceSqToDestination() const;

   virtual bool decideToGiveUpTask() const;

   virtual bool createPortGroups();
   virtual bool createPorts();

   virtual void setDestinationIsInsideObstruction(bool yesNo);

   virtual bool destinationIsInsideObstruction() const;

   virtual double obstacleLimitedSpeed(const DtCollision* obstacle,
      const DtVector& position, const DtVector& velocity,
      const double deceleration, const double dT, const bool isMovingForward);

   virtual bool usingNavBot();

   virtual void useNavBotData();

   virtual void updateNavBotDestination();

   virtual unsigned maxNumFailedPathAttempts() const;

   virtual bool findAlternateDestination();

   static void navAreaChangedCallback(void* usr);
   virtual void processNavAreaChanged();

   DtVector localDestination() const;

   virtual void processNavigationInterfaceChanged();

   virtual void processEstimatedTotCalculation();

   virtual void processGroundVehicleLocationChanged();

private:
   DtGroundMoveToDestinationControllerComponent();

   DtGroundMoveToDestinationControllerComponent(const DtGroundMoveToDestinationControllerComponent &orig);

   const DtGroundMoveToDestinationControllerComponent & operator=(const 
      DtGroundMoveToDestinationControllerComponent & orig);

protected:

   double            myDistanceSquared;

   DtVector          myLocalDestination;
   DtVector          myWorldDestination;

   bool              myHasIntermediateDestination;
   DtVector          myIntermediateWorldDestination;
   DtVector          myIntermediateLocalDestination;

   mutable DtVector  myDestinationVector;
   mutable bool      myDestinationVectorIsValid;

   double            myCurrentSpeed;

   bool              myAtDestination;
   bool              myNearDestination;
   bool              myPassedDestination;

   double myNearDistanceSquared;

   const DtGroundMoveToDescriptor* myMoveToDescriptor;


   DtCollisionInputPort*   myCollisionAvoidancePort;

   DtInputPortGroup*       myCollisionAvoidancePortGroup;

   DtBooleanOutputPort* myClampToNavDataPort;


   DtActiveBotNavInterface* myNavInterface;
   bool myIgnoreNavData;

   bool myDestinationIsInsideObstruction;
   DtCollision* myCollisionObject;
   double myObstacleLimitedSpeed;

   double myTargetHeading;

   unsigned myNumFailedPathAttempts;

   const double DtEstimatedTotCalcInterval = 5.0;

   bool myEstimatedTotCalcEnabled;
   double myEstimatedTotValue;
   double myEstimatedTotLastCalcTime;
   DtVector myEstimatedTotTextPos;
   bool myChangedLocation;
};