StateMapper.hpp

浏览该文件的文档.

 
 
#pragma once
 
#include "AstGlobal.h"
#include "AstCore/TimePoint.hpp"
#include "AstCore/OrbitElement.hpp"
#include "AstMath/Vector.hpp"
#include "AstMath/Matrix.hpp"
 
AST_NAMESPACE_BEGIN
 
class StateMapper
{
public:
    StateMapper() = default;
    virtual ~StateMapper() = default;
 
    virtual void toState(const double* y, double x, SpacecraftState& state) const = 0;
 
    virtual void fromState(const SpacecraftState& state, double* y, double& x) const = 0;
 
    virtual void toState(const double* y, CartState& state) const = 0;
    CartState toCartState(const double* y) const{CartState state{}; toState(y, state); return state;}
 
 
    virtual errc_t toStateTransitionMatrix(const double* y, Matrix6d& stm) const = 0;
    Matrix6d toStateTransitionMatrix(const double* y) const{Matrix6d stm{}; toStateTransitionMatrix(y, stm); return stm;}
 
    virtual errc_t toStateSensitivityWrtDrag(const double* y, Vector6d& stateSensWrtDrag) const = 0;
    Vector6d toStateSensitivityWrtDrag(const double* y) const{Vector6d stateSensWrtDrag{}; toStateSensitivityWrtDrag(y, stateSensWrtDrag); return stateSensWrtDrag;}
 
    virtual errc_t toStateSensitivityWrtSRP(const double* y, Vector6d& stateSensWrtSRP) const = 0;
    Vector6d toStateSensitivityWrtSRP(const double* y) const{Vector6d stateSensWrtSRP{}; toStateSensitivityWrtSRP(y, stateSensWrtSRP); return stateSensWrtSRP;}
 
 
    void toTime(double x, TimePoint& time) const
    {
        time = epoch_ + x;
    }
 
    void fromTime(const TimePoint& time, double& x) const
    {
        x = time - epoch_;
    }
public:
 
    const TimePoint& epoch() const{return epoch_;}
 
    void setEpoch(TimePoint epoch){epoch_ = epoch;}
private:
    TimePoint epoch_{};   
};
 
AST_NAMESPACE_END