groundFollowInFormationController.h

Go to the documentation of this file.

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




#pragma once

class DtLocalVectorIterator;
class DtVectorOutputPort;

#include "vrfmodel/vrfmodelDefines.h"
#include "vrfobjcore/constrainedAnalogIOPort.h"
#include "vrfobjcore/taskControllerComponent.h"
#include "vrfmodel/groundAutoControllerComponent.h"
#include "vrfobjcore/inputPortGroup.h"
#include "vrfobjcore/outputPortGroup.h"
#include "vrfobjcore/collisionIOPort.h"

class DT_DLL_vrfmodel DtGroundFollowInFormationControllerComponent : public DtGroundAutoControllerComponent
{

public:

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

   virtual ~DtGroundFollowInFormationControllerComponent();

   virtual const char* type() const;

   virtual void tick();

   virtual void registerTaskMsgCallbacks();

   static void followInFormationCallback(DtSimMessage * msg, void * usr);
   
   static DtSimComponent * creator(const DtString& name,
      DtLocalObject* owner,
      DtSimulationServices* simManager,
      DtComponentDescriptor* desc = 0,
      DtReaderWriterRegistry* parentRegistry = 0);
protected:

   void cleanFollowInFormation();

   virtual void endFollowInFormation(bool taskSuccess = true);
   
   virtual void clearTask();

   virtual void doMoving();

   virtual double distanceAlongRoute(DtVector testLocation, int segmentIndex, std::vector<DtVector> testRoute);

   virtual bool checkTaskEndCondition();

   virtual double findDistanceToTarget(DtVector, DtVector);
   virtual double findDistanceToTarget(DtPoint loc1, DtPoint loc2);

   virtual int findClosestSegmentIndex(DtVector testPoint, std::vector<DtVector> testRoute, 
      DtPoint& closestSegmentLoc, double& distanceToSegment, int indexSegmentFloor = 0);

   virtual double findHeading(DtVector initialLocation, DtVector localDestination);

   virtual DtVector shiftLocationAlongRoute(double shiftDistance, 
      std::vector<DtVector> testRoute, DtVector initalLoc, int segmentIndex);

   virtual DtVector findTargetLocation();

   virtual double findDesiredAcceleration(double targetSpeed, double targetHeading, 
      double currentHeading, double disToTarget);

   virtual bool createFollowerOffsetRoute(const std::vector<DtVector>& localPoints, 
      float rightOffset, float forwardOffset, DtUUID& routeUUID);

   virtual void processFollowInFormation(const DtTaskMessage& msg);

   virtual void updateTaskVisualizations();

   virtual double headingTo(DtVector localDestination);

   bool publishFormationRoutes() const;

private:

   DtGroundFollowInFormationControllerComponent();

   DtGroundFollowInFormationControllerComponent(
      const DtGroundFollowInFormationControllerComponent& orig);

   DtGroundFollowInFormationControllerComponent& operator=(
      const DtGroundFollowInFormationControllerComponent& orig);

protected:
   DtSimObjectReference             myRoute;
   bool                             myIsOnRoute;
   bool                             myHasProcessed;
   double                           myDisToTarget;
   double                           myBackwardsOffset;
   double                           myNearDistance;
   double                           myAtDistance;
   double                           myApproachSpeed;
   int                              myIndexDriven;
   DtSimObjectReference             myLeader;
   DtSimObjectReference             myLeadersRoute;
   DtVector                         myPlaceOnRoute;
   DtVector                         myLocalDestination;
   DtVector                         myClosestSegmentPt1;
   DtVector                         myClosestSegmentPt2;
   DtVector myLeaderLocationOnMyRoute;
};