MTT_EmbryonicTrack.hpp

Go to the documentation of this file.

// ****************************************************************************
// CUI//REL TO USA ONLY
//
// The Advanced Framework for Simulation, Integration, and Modeling (AFSIM)
//
// Copyright 2003-2015 The Boeing Company. All rights reserved.
//
// The use, dissemination or disclosure of data in this file is subject to
// limitation or restriction. See accompanying README and LICENSE for details.
// ****************************************************************************
 
#ifndef MTT_EMBRYONIC_TRACK_HPP
#define MTT_EMBRYONIC_TRACK_HPP
 
#include <fstream>
#include <string>
 
#include "MTT_Track.hpp"
#include "SupBlock.hpp"
#include "UtMatrix.hpp"

class MTT_EmbryonicTrack : public MTT_Track
{
public:
   class Data : public MTT_Track::Data
   {
   public:
      Data()
         : mErrorInfoMatrix(4, 4)
         , mHorizontalState(4)
         , mVerticalErrorInfoMatrix(2, 2)
         , mVerticalState(2)
      {
      }
 
      MTT_Track::Data* Clone() const override { return new Data(*this); }
 
      ~Data() override {}
      // Suppressor offset (385 block, same as 386)
      UtMatrixd mErrorInfoMatrix;         // 0-31   (4x4 = 16 doubles)
      UtMatrixd mHorizontalState;         // 32-39  (4x1 = 4 doubles)
      UtMatrixd mVerticalErrorInfoMatrix; // 40-47  (2x2 = 4 doubles)
      UtMatrixd mVerticalState;           // 48-51  (2x1 = 2 doubles)
 
      void ConvertFrom(const SupBlock& aBlock) override
      {
         mErrorInfoMatrix.CopyFrom(aBlock.mDoubleBlock + 0);          // 0-31   (4x4 = 16 doubles)
         mHorizontalState.CopyFrom(aBlock.mDoubleBlock + 16);         // 32-39  (4x1 = 4 doubles)
         mVerticalErrorInfoMatrix.CopyFrom(aBlock.mDoubleBlock + 20); // 40-47  (2x2 = 4 doubles)
         mVerticalState.CopyFrom(aBlock.mDoubleBlock + 24);           // 48-51  (2x1 = 2 doubles)
      }
 
      void Log(std::fstream& aFS) override
      {
         aFS << mErrorInfoMatrix << std::endl;
         aFS << mHorizontalState << std::endl;
         aFS << mVerticalErrorInfoMatrix << std::endl;
         aFS << mVerticalState << std::endl;
      }
   };
 
public:
   MTT_EmbryonicTrack() { mDataPtr = new MTT_EmbryonicTrack::Data(); }
 
   MTT_EmbryonicTrack(const MTT_EmbryonicTrack& aSrc)
      : MTT_Track(aSrc)
   {
   }
 
   ~MTT_EmbryonicTrack() override {}
 
   void SetData(const Data& aData)
   {
      if (mDataPtr != nullptr)
      {
         delete mDataPtr;
      }
      mDataPtr = new Data(aData);
   }
 
   MTT_EmbryonicTrack::Data& GetData() const { return *(static_cast<MTT_EmbryonicTrack::Data*>(mDataPtr)); }
};
 
#endif