OrbitElement.hpp

浏览该文件的文档.

 
 
#pragma once
 
#include "AstGlobal.h"
#include "AstCore/Vector.hpp"
#include "AstCore/OrbitParam.hpp"
#include "AstCore/TimePoint.hpp"
#include "AstUtil/Constants.hpp"
#include <string>
#include <cmath>                // for std::isfinite
 
AST_NAMESPACE_BEGIN
 
#if defined(A_GCC) || defined(A_CLANG)
#   pragma GCC diagnostic push
#   pragma GCC diagnostic ignored "-Weffc++"
#endif
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& position() const {return pos_;} 
    Vector3d& position() {return pos_;}
 
    const Vector3d& vel() const {return vel_;} 
    Vector3d& vel() {return vel_;}
    const Vector3d& velocity() const {return vel_;} 
    Vector3d& velocity() {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();}
 
    AST_CORE_API
    std::string toString() const;
public:
    bool isFinite() const{
        for (auto val: *this)
            if (!std::isfinite(val))
                return false;
        return true;
    }
};
#if defined(A_GCC) || defined(A_CLANG)
#   pragma GCC diagnostic pop
#endif
 
 
class OrbElem
{
// 设置为public使类型为聚合类型
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使类型为聚合类型
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 getLongitudeOfPeri() const {return aArgPeriToLongPeri(getArgPeri(), getRAAN());}
 
    double getMeanLongitude() const {return getLongitudeOfPeri() + getMeanAnomaly();}
 
    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使类型为聚合类型
public:
    double a_;          
    double h_;          
    double k_;          
    double p_;          
    double q_;          
    double lambda_;     
public:
    double meanLongitude() const {return 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使类型为聚合类型
public:
    double p_;        
    double f_;        
    double g_;        
    double h_;        
    double k_;        
    double L_;        
public:
    double trueLongitude() const {return 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使类型为聚合类型
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)
};
 
 
class BPlaneElem
{
// 设置为public使类型为聚合类型
public:
    double ra_;         
    double dec_;        
    double bDotR_;      
    double bDotT_;      
    double c3_;         
    double trueA_;      
public:
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, ra)
    AST_DEF_ACCESS_METHOD(double, dec)
    AST_DEF_ACCESS_METHOD(double, bDotR)
    AST_DEF_ACCESS_METHOD(double, bDotT)
    AST_DEF_ACCESS_METHOD(double, c3)
    AST_DEF_ACCESS_METHOD(double, trueA)
};
 
 
class SphericalElem
{
// 设置为public使类型为聚合类型
public:
    double ra_;         
    double dec_;        
    double r_;          
    double fpa_;        
    double azi_;        
    double v_;          
public:
    double getRA() const {return ra_;}
 
    double getDec() const {return dec_;}
 
    double getRadius() const {return r_;}
 
    double getFltPathAng() const {return fpa_;}
 
    double getFltPathAzi() const {return azi_;}
 
    double getVel() const {return v_;}
 
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, ra)
    AST_DEF_ACCESS_METHOD(double, dec)
    AST_DEF_ACCESS_METHOD(double, r)
    AST_DEF_ACCESS_METHOD(double, fpa)
    AST_DEF_ACCESS_METHOD(double, azi)
    AST_DEF_ACCESS_METHOD(double, v)
};
 
 
class MixedSphericalElem
{
// 设置为public使类型为聚合类型
public:
    double lon_;        
    double lat_;        
    double alt_;        
    double fpa_;        
    double azi_;        
    double v_;          
public:
    double getLon() const {return lon_;}
 
    double getLat() const {return lat_;}
 
    double getAlt() const {return alt_;}
 
    double getFltPathAng() const {return fpa_;}
 
    double getVertFltPathAng() const {return kHalfPI - fpa_;}
 
    double getFltPathAzi() const {return azi_;}
 
    double getVel() const {return v_;}
 
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, lon)
    AST_DEF_ACCESS_METHOD(double, lat)
    AST_DEF_ACCESS_METHOD(double, alt)
    AST_DEF_ACCESS_METHOD(double, fpa)
    AST_DEF_ACCESS_METHOD(double, azi)
    AST_DEF_ACCESS_METHOD(double, v)
};
 
 
class GeodeticElem
{
// 设置为public使类型为聚合类型
public:
    double lat_;        
    double lon_;        
    double alt_;        
    double latRate_;    
    double lonRate_;    
    double altRate_;    
public:
    double getLon() const {return lon_;}
 
    double getLat() const {return lat_;}
 
    double getAlt() const {return alt_;}
 
    double getLonRate() const {return lonRate_;}
 
    double getLatRate() const {return latRate_;}
 
    double getAltRate() const {return altRate_;}
 
    AST_CORE_API
    std::string toString() const;
public:
    A_DEF_POD_ITERABLE(double)
    AST_DEF_ACCESS_METHOD(double, lon)
    AST_DEF_ACCESS_METHOD(double, lat)
    AST_DEF_ACCESS_METHOD(double, alt)
    AST_DEF_ACCESS_METHOD(double, lonRate)
    AST_DEF_ACCESS_METHOD(double, latRate)
    AST_DEF_ACCESS_METHOD(double, altRate)
};
 
 
AST_CORE_API errc_t aCartToSpherical(
    const Vector3d& pos,
    const Vector3d& vel,
    SphericalElem& sph
);
 
 
AST_CORE_API errc_t aSphericalToCart(
    const SphericalElem& sph,
    Vector3d& pos,
    Vector3d& vel
);
 
 
AST_CORE_API errc_t aCartToMixedSpherical(
    const Vector3d& pos,
    const Vector3d& vel,
    const Rotation& framelToFixed,
    const BodyShape& shape,
    MixedSphericalElem& mixedSph
);
 
 
AST_CORE_API errc_t aMixedSphericalToCart(
    const MixedSphericalElem& mixedSph,
    const Rotation& fixedToframe,
    const BodyShape& shape,
    Vector3d& pos,
    Vector3d& vel
);
 
 
AST_CORE_API errc_t aCartToGeodetic(
    const Vector3d& pos,
    const Vector3d& vel,
    const BodyShape& shape,
    GeodeticElem& geodetic
);
 
 
AST_CORE_API errc_t aGeodeticToCart(
    const GeodeticElem& geodetic,
    const BodyShape& shape,
    Vector3d& pos,
    Vector3d& vel
);
 
 
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;
}
 
 
enum class EBPlaneRefVector
{
    eBodyOrbitNormal,           
    eSpacecraftOrbitNormal,     
    eBodyPole,                  
    eCustom,                    
};
 
 
 
AST_CORE_CAPI errc_t aCartToBPlane(
    const Vector3d& pos,
    const Vector3d& vel,
    double gm,
    const Vector3d& refVector,
    BPlaneElem& bPlane
);
 
 
AST_CORE_CAPI errc_t aBPlaneToCart(
    const BPlaneElem& bPlane,
    double gm,
    const Vector3d& refVector,
    Vector3d& pos,
    Vector3d& vel
);
 
 
AST_NAMESPACE_END
 
AST_DECL_TYPE_ALIAS(CartState)