OrbitElement.hpp

浏览该文件的文档.

 
 
#pragma once
 
#include "AstGlobal.h"
#include "AstCore/Vector.hpp"
#include "AstCore/OrbitParam.hpp"
#include "AstCore/TimePoint.hpp"
#include "AstUtil/Constants.h"
#include <string>
 
AST_NAMESPACE_BEGIN
 
class CartState
{
public:
    Vector3d pos_;   
    Vector3d vel_;   
public:
    static CartState Zero() {return CartState{Vector3d::Zero(), Vector3d::Zero()};}
 
    A_DEF_POD_ITERABLE(double)
    
    
    const Vector3d& pos() const {return pos_;} 
    Vector3d& pos() {return pos_;}
 
    const Vector3d& vel() const {return vel_;} 
    Vector3d& vel() {return vel_;}
 
    double& x() {return pos_.x();}
    double& y() {return pos_.y();}
    double& z() {return pos_.z();}
    double& vx() {return vel_.x();}
    double& vy() {return vel_.y();}
    double& vz() {return vel_.z();}
 
    double x() const {return pos_.x();}
    double y() const {return pos_.y();}
    double z() const {return pos_.z();}
    double vx() const {return vel_.x();}
    double vy() const {return vel_.y();}
    double vz() const {return vel_.z();}
};
 
 
class OrbElem
{
public:
    double   a_;          
    double   e_;          
    double   i_;          
    double   raan_;       
    double   argper_;     
    double   trueA_;      
public:
    double getMeanMotion(double gm) const {return aSMAToMeanMotion(getSMA(), gm);}
 
    double getSMA() const {return a_;}
 
    double getA() const {return a_;}
 
    double getE() const {return e_;}
 
    double getI() const {return i_;}
 
    double getRAAN() const {return raan_;}
 
    double getArgPer() const {return argper_;}
 
    double getTrueA() const {return trueA_;}
 
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, a)
    AST_DEF_ACCESS_METHOD(double, e)
    AST_DEF_ACCESS_METHOD(double, i)
    AST_DEF_ACCESS_METHOD(double, raan)
    AST_DEF_ACCESS_METHOD(double, argper)
    AST_DEF_ACCESS_METHOD(double, trueA)
};
 
 
class ModOrbElem
{
public:
    double rp_;         
    double e_;          
    double i_;          
    double raan_;       
    double argper_;     
    double trueA_;      
public:
    double getSMA() const {return rp_ / (1 - e_);}
    
    double getMeanMotion(double gm) const {return aPeriRadToMeanMotion(getPeriRad(), getEcc(), gm);}
 
    double getPeriod(double gm) const {return kTwoPI / getMeanMotion(gm);}
 
    double getApoRad() const{return aPeriRadToApoRad(getPeriRad(), getEcc());}
 
    double getApoAlt(double bodyRadius) const{ return aPeriRadToApoAlt(getPeriRad(), getEcc(), bodyRadius);}
 
    double getPeriRad() const {return rp_;}
 
    double getPeriAlt(double bodyRadius) const{ return getPeriRad() - bodyRadius;}
 
    double getEcc() const {return e_;}
 
    double getInc() const {return i_;}
 
    double getRAAN() const {return raan_;}
 
    double getArgPeri() const {return argper_;}
 
    double getTrueAnomaly() const {return trueA_;}
 
    double getMeanAnomaly() const {return aTrueToMean(getTrueAnomaly(), getEcc());}
 
    double getEccAnomaly() const {return aTrueToEcc(getTrueAnomaly(), getEcc());}
 
    double getArgLat() const {return aTrueToArgLat(getTrueAnomaly(), getArgPeri());}
 
    double getTimePastPeri(double gm) const{return aTrueToTimePastPeri(getTrueAnomaly(), getSMA(), getEcc(), gm);}
 
    double getTimePastAscNode(double gm) const{return aTrueToTimePastAscNode(getTrueAnomaly(), getArgPeri(), getSMA(), getEcc(), gm);}
    
    TimePoint getTimeOfAscNodePassage(const TimePoint& stateEpoch, double gm) const
    {
        return stateEpoch - getTimePastAscNode(gm);
    }
 
    double getLAN(Axes* inertialAxes, const TimePoint& timeOfAscNodePassage, Axes* bodyFixedAxes) const
    {
        return aRAANToLAN(getRAAN(), inertialAxes, timeOfAscNodePassage, bodyFixedAxes);
    }
    
public:
    double getA() const {return getSMA();}
 
    double getP() const {return rp_ * (1 + e_);}
 
    double getE() const {return getEcc();}
 
    double getI() const {return getInc();}
 
    double getArgPer() const {return getArgPeri();}
 
    double getTrueA() const {return getTrueAnomaly();}
 
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, rp)
    AST_DEF_ACCESS_METHOD(double, e)
    AST_DEF_ACCESS_METHOD(double, i)
    AST_DEF_ACCESS_METHOD(double, raan)
    AST_DEF_ACCESS_METHOD(double, argper)
    AST_DEF_ACCESS_METHOD(double, trueA)
};
 
 
class EquinElem
{
public:
    double a_;          
    double h_;          
    double k_;          
    double p_;          
    double q_;          
    double lambda_;     
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, a)
    AST_DEF_ACCESS_METHOD(double, h)
    AST_DEF_ACCESS_METHOD(double, k)
    AST_DEF_ACCESS_METHOD(double, p)
    AST_DEF_ACCESS_METHOD(double, q)
    AST_DEF_ACCESS_METHOD(double, lambda)
};
 
class ModEquinElem
{
public:
    double p_;       
    double f_;        
    double g_;        
    double h_;        
    double k_;        
    double L_;        
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, p)
    AST_DEF_ACCESS_METHOD(double, f)
    AST_DEF_ACCESS_METHOD(double, g)
    AST_DEF_ACCESS_METHOD(double, h)
    AST_DEF_ACCESS_METHOD(double, k)
    AST_DEF_ACCESS_METHOD(double, L)
};
 
 
 
class DelaunayElem
{
 
public:
    double L_;
    double G_;
    double H_;
    double l_;
    double g_;
    double h_;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, L)
    AST_DEF_ACCESS_METHOD(double, G)
    AST_DEF_ACCESS_METHOD(double, H)
    AST_DEF_ACCESS_METHOD(double, l)
    AST_DEF_ACCESS_METHOD(double, g)
    AST_DEF_ACCESS_METHOD(double, h)
};
 
 
AST_CORE_CAPI errc_t coe2rv(const double* coe, double gm, double* pos, double* vel);
 
AST_CORE_CAPI errc_t coe2mee(const double* coe, double* mee);
 
AST_CORE_CAPI void ee2rv(const double* ee, double gm, double* pos, double* vel);
 
AST_CORE_CAPI void mee2rv(const double* mee, double gm, double* pos, double* vel);
 
AST_CORE_CAPI errc_t rv2mee(const double* pos, const double* vel, double gm, double* mee);
 
AST_CORE_CAPI errc_t mee2coe(const double* mee, double* coe);
 
AST_CORE_CAPI void rv2ee(const double* pos, const double* vel, double gm, double* ee);
 
AST_CORE_CAPI errc_t rv2moe(const double* pos, const double* vel, double gm, double* moe);
 
AST_CORE_CAPI errc_t rv2coe(const double* pos, const double* vel, double gm, double* coe);
 
AST_CORE_CAPI errc_t ee2moe(const double* ee, double* moe);
 
AST_CORE_CAPI errc_t moe2ee(const double* moe, double* ee);
 
AST_CORE_CAPI errc_t moe2coe(const double* moe, double* coe);
 
AST_CORE_CAPI void coe2moe(const double* coe, double* moe);
 
AST_CORE_CAPI errc_t moe2rv(const double* moe, double gm, double* pos, double* vel);
 
AST_CORE_CAPI void moe2mee(const double* moe, double* mee);
 
AST_CORE_CAPI void coe2ee(const double* coe, double* ee);
 
AST_CORE_CAPI void ee2coe(const double* ee, double* coe);
 
AST_CORE_CAPI void ee2mee(const double* ee, double* mee);
 
AST_CORE_CAPI void mee2ee(const double* mee, double* ee);
 
AST_CORE_CAPI void mee2moe(const double* mee, double* moe);
 
 
AST_CORE_CAPI errc_t coe2dela(const double* coe, double gm, double* dela);
 
 
AST_CORE_CAPI errc_t dela2coe(const double* dela, double gm, double* coe);
 
 
AST_CORE_CAPI void aModEquinElemToCart(
    const ModEquinElem& mee, 
    double gm, 
    Vector3d& pos, 
    Vector3d& vel
);
 
AST_CORE_CAPI errc_t aCartToModEquinElem(
    const Vector3d& pos,
    const Vector3d& vel,
    double gm,
    ModEquinElem& mee
);
 
AST_CORE_CAPI errc_t aOrbElemToModEquinElem(
    const OrbElem& elem,
    ModEquinElem& mee
);
 
AST_CORE_CAPI errc_t aModEquinElemToOrbElem(
    const ModEquinElem& mee,
    OrbElem& elem
);
 
AST_CORE_CAPI errc_t    aCartToModOrbElem(
    const Vector3d& pos,
    const Vector3d& vel,
    double gm,
    ModOrbElem& modOrb);
 
AST_CORE_CAPI
errc_t aCartToOrbElem     (
    const Vector3d& pos,
    const Vector3d& vel,
    double gm,
    OrbElem& elem);
 
AST_CORE_CAPI
errc_t aEquinElemToModOrb (
    const EquinElem& equinElem,
    ModOrbElem& modOrb);
 
AST_CORE_CAPI
errc_t aModOrbToEquinElem (
    const ModOrbElem& modOrb,
    EquinElem& equinElem);
 
AST_CORE_CAPI
errc_t aModOrbElemToCart  (
    const ModOrbElem& modOrb,
    double gm,
    Vector3d& pos,
    Vector3d& vel);
 
AST_CORE_CAPI
errc_t aOrbElemToCart     (
    const OrbElem& elem,
    double gm,
    Vector3d& pos,
    Vector3d& vel);
 
AST_CORE_CAPI
void    aCartToEquinElem(
    const Vector3d& pos,
    const Vector3d& vel,
    double gm,
    EquinElem& equinElem);
 
AST_CORE_CAPI
void aEquinElemToCart(
    const EquinElem& equinElem,
    double gm,
    Vector3d& pos,
    Vector3d& vel);
 
 
AST_CORE_CAPI 
errc_t aOrbElemToDelaunay(
    const OrbElem& elem,
    double gm,
    DelaunayElem& delaunay);
 
 
AST_CORE_CAPI 
errc_t aDelaunayToOrbElem(
    const DelaunayElem& delaunay,
    double gm,
    OrbElem& elem);
 
 
A_ALWAYS_INLINE
ModOrbElem aCartToModOrbElem(const Vector3d& r, const Vector3d& v, double gm)
{
    ModOrbElem modOrbElem;
    aCartToModOrbElem(r, v, gm, modOrbElem);
    return modOrbElem;
}
 
 
AST_NAMESPACE_END
 
AST_DECL_TYPE_ALIAS(CartState)