automotiveActuatorComponent.h

Go to the documentation of this file.

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



#pragma once

#include <vlpi/disEnums.h>
#include "vrfobjcore/actuatorComponent.h"
#include "vrfobjcore/automotivePSR.h"
#include <matrix/vlVector.h>

class DtChord;
class DtString;
class DtSimManager;
class DtGroundVehicleStateRepository;
class boolPort;
class DtTaitBryan;
class DtSoilFactors;
class DtAutomotivePSR;
class DtAutomotiveActuatorDescriptor;
class DtConstrainedIntegerInputPort;
class DtConstrainedAnalogInputPort;
class DtBooleanInputPort;
class DtVrfChordIntersectionRecord;
class DtAttachedTerrain;
class DtUpdateRepositoryOutputPortGroup;

#include "vrfmodel/vrfmodelDefines.h"
class DT_DLL_vrfmodel DtAutomotiveActuatorComponent : public DtActuatorComponent
{

public:

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


   virtual ~DtAutomotiveActuatorComponent();

   virtual bool init();

   virtual const char* type() const;

   virtual void tick();

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

protected:

   virtual double maxSpeedSoilFactor() const;

   virtual double accelSoilFactor() const;

   virtual double decelSoilFactor() const;

   virtual DtSoilFactors* soilFactors() const;

   virtual void useFuel(double fuelUsed);

   virtual double fuelLeft() const;

   virtual void updateRepository(const DtVector & localPosition, 
      const DtVector & localVelocity, const DtVector & localAcceleration, 
      const DtTaitBryan & localOrientation, const DtVector& rotationalVelocity,
      double newHeading);


   virtual double calculateMaxDecelerationFromFriction(
      const DtVector& oldBodyVelocity);

   virtual double calculateMaxDecelerationFromBrake(double brake);

   virtual double calculateAccelerationFromEngine(double throttle, 
      DtAutoTransmissionGear gear);

   virtual double calculateDecelerationFromSoilType(
      const DtVector& oldBodyVelocity);

   //~ (i.e., rise-over-run, or tangent of pitch).
   virtual double calculateAccelerationFromSlope(double slope);

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

   virtual bool useHighFidelityGroundClamping() const;
   
   bool groundClamp(double heading, const DtVector& location, 
      DtAttachedTerrain& terrain, DtVector& newNormal, bool& dataAvailable);

   void groundClampHighFidelity(double heading, const DtVector& location, 
      DtAttachedTerrain& terrain, DtVector& newNormal, bool& dataAvailable);

   void groundClampLowFidelity(double heading, const DtVector& location, 
      DtAttachedTerrain& terrain, DtVector& newNormal, bool& dataAvailable);

   virtual double calculateHeading(double oldHeading, 
      const DtVector& oldBodyVelocity, DtAutoTransmissionGear gear, 
      double steering, double throttle, double dT);

   virtual DtVector calculateBodyAcceleration(double throttle, 
      DtAutoTransmissionGear gear, double brake, 
      const DtVector& oldBodyVelocity, double oldPitch, double dT);

   virtual DtVector calculateBodyVelocity(
     const DtVector& oldBodyVelocity, const DtVector& newBodyAcceleration,
     double dT);

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

   virtual bool checkForTerrainCollisions() const;

   virtual bool foundTerrainCollision(double heading,
                                      const DtVector& oldLocalPosition, 
                                      const DtVector& newLocalPosition,
                                      DtVrfChordIntersectionRecord 
                                      &collisionIntersectionRecord) const;

   virtual bool createMovementChord(DtChord& movementChord, 
                                    double heading,
                                    const DtVector& oldLocalPosition, 
                                    const DtVector& newLocalPosition) const;

   virtual bool terrainPassable(double heading,
                                const DtVrfChordIntersectionRecord&
                                terrainIntersectionRecord) const;


   virtual double calculateMaxSpeed();

   virtual double calculateMaxAcceleration();

   virtual double calculatePitch(const DtVector& localPosition, double heading, 
      const DtAttachedTerrain& terrain);
   
   virtual void calculateDirectionOfLinearMotion(
      const DtDcm& newLocalOrientation, const DtVector& newLocalPosition, 
      DtDcm& newLocalDirectionOfLinearMotion);

   virtual double getPitchAdjustedMaxSpeed(double maxSpeed, double pitch) const;

   virtual bool createPortGroups();

   virtual bool createPorts();

   virtual bool createPSR();

   virtual bool rotationalVelocityShouldBeClamped(const DtVector&
      bodyRotationalVelocity);

   virtual double steeringControlValue() const;
   virtual double throttleControlValue() const;
   virtual double brakeControlValue() const;
   virtual DtAutoTransmissionGear gearControlValue() const;
   virtual bool parkingBrakeControlValue() const;

   virtual bool checkIfMoveOntoEmbarked(const DtVector& localPosition);
   
   virtual bool checkAndDisembarkIfEmbarked(const DtVector& localPosition);

private:
   DtAutomotiveActuatorComponent();

   DtAutomotiveActuatorComponent(const DtAutomotiveActuatorComponent & orig);

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

protected:


   DtConstrainedAnalogInputPort* myThrottlePort;

   DtConstrainedAnalogInputPort* mySteeringPort;

   DtConstrainedAnalogInputPort* myBrakePort;

   DtConstrainedIntegerInputPort* myGearPort;

   DtBooleanInputPort* myParkingBrakePort;

   DtInputPortGroup* myAutomotiveControlPortGroup;


   DtGroundVehicleStateRepository * myGroundVehicleState;

   DtAutomotivePSR* myProcessState;

   DtUpdateRepositoryOutputPortGroup* myUpdateRepositoryOutputPortGroup;

   const DtAutomotiveActuatorDescriptor* myAutomotiveDescriptor;
   bool myKeepParentPosition;
   DtUUID myWasJustEmbarkedOn;

   double myLastPitch;
   double myLastPitchHeading;
   DtVector myLastPitchLocation;
};