Single track orbit determination analysis for low Earth orbit with approximated J2 dynamics

Jose M. Montilla111Substitute Professor, Aerospace Engineering and Fluid Mechanics Department, [email protected]; Jan A. Siminski222Space Debris Specialist, Space Debris Office, ESOC, [email protected]; Rafael Vazquez333Professor, Aerospace Engineering and Fluid Mechanics Department, [email protected];
Abstract

In the domain of Space Situational Awareness (SSA), the challenges pertaining to orbit determination and catalog correlation are notably pronounced, partly attributable to the escalating presence of non-cooperative satellites engaging in unspecified maneuvers at irregular intervals. This study introduces an initial orbit determination methodology reliant upon data obtained from a single surveillance radar, such as the Spanish Space Surveillance and Tracking Surveillance Radar (S3TSR). The need for fast algorithms within an operational context is considered here as the main design driver. The result is a least-squares fitting procedure that incorporates an analytically formulated approximation of the dynamics under the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation, valid for short-term propagation. The algorithm makes use of all available observables, including range-rate, which makes it distinct from other similar methods. The method is compared in a battery of synthetic tests against a classical range and angles fitting method (GTDS) to study the effect of the track length and density of measurements on the full state estimation. The presented methodology is quite versatile, and it is leveraged to improve the estimation quality by adding information of the object's orbital plane obtained from predictions. The resulting method has been named OPOD.

keywords:
\KWDInitial Orbit Determination, Maneuver detection, Space Situational Awareness
journal: Advances in Space Research
\affiliation

[1]organization=Universidad de Sevilla, Escuela Técnica Superior de Ingeniería, addressline=Camino de los Descubrimientos s.n, city=Sevilla, postcode=41092, country=Spain

\affiliation

[2]organization=ESA/ESOC, addressline=Robert-Bosch-Str 5, city=Darmstadt, postcode=64293, country=Germany

1 Introduction

Over the last sixty years, human activities in space have led to a significant increase in orbiting objects [9], a concern that has grown more pressing with the emergence of mega-constellations for communication, like Starlink and OneWeb. This mounting congestion in Earth's low orbit emphasizes the urgent need for nations and space agencies to reinforce tracking and cataloging efforts. Within this context, there arises a critical necessity for robust and efficient Orbit determination (OD) algorithms. These algorithms play a pivotal role in satellite tracking and cataloging procedures, swiftly identifying correlated tracks to maintain an accurate and up-to-date satellite database. Their reliability is essential in bolstering Space Situational Awareness (SSA) and ensuring the safety and sustainability of orbital operations. The development of such algorithms for correlation and maneuver detection represents a crucial step in mitigating the escalating risks posed by the growing complexity of space activities.

OD as a discipline is almost as old as orbital mechanics itself. Indeed, Johannes Kepler utilized Tycho Brahe' s meticulous observations of Mars to establish the planet' s elliptical orbit and spatial orientation, formulating in the process his three laws of planetary motion. The discipline evolved during the years, with notable contributions from prominent figures such as Newton, Euler, Lambert or Gauss [15]. Classically, a common strategy employed in numerous orbital determination scenarios involves an Initial Orbit Determination (IOD) phase, generating an estimate which is latter refined. A summary of classical methods can be found in [29]. These IOD procedures encompass Laplace' s and Gauss'methods [10], double r-iteration [10], or Gooding' s method [13]. All these IOD methodologies necessitate measurements encompassing at least six independent parameters to generate a six-parameter orbit. For instance, the determination of an elliptical orbit typically demands three angle pairs [13]. Introducing constraints on the type of orbits, such as removing certain parameters, may potentially reduce the required number of independent measurement parameters (a circular orbit requires two angle pairs). The quality of the initial estimation is influenced by the spacing of the measurements, benefiting if they originate from different observation arcs, which are referred here as tracks444A series of sequential observations delayed by seconds, which in turn are composed by a set of measurements (of different nature) at a common epoch..

More generally, even during the IOD phase introducing more information can be leveraged to improve the quality of the estimation. One example of this is the well known range and angles method of the Goddard Trajectory Determination System (GTDS) [20], used in this work as a reference for single track IOD. Also related to the method introduced here, in [33] the authors apply a classical differential correction method for IOD with dense observation arcs and numerical propagation models. The present work on the other hand is focused in taking advantage of analytical methods for scenarios with low density radar tracks. In [18] the IOD classical approach is expanded by also including precise range data from another GEO object, thus improving the achievable accuracy in determining the semi-major axis (SMA). The idea of doing the track initialization with angles and angle-rates data is explored in [8], which is later used for data association by means of admissible regions and Mahalanobis Distance (MD). The sub-problem of very short track IOD is treated in [35], where the inclusion of extra radial measurements is leveraged to determine the velocity. The use of data from two different stations is considered in [30] with analytical methods and incorporating phase-derived velocity and acceleration.

Subsequently, the initial estimate derived from the IOD is refined using a batch processor, such as a square-root information filter [29], before transitioning to sequential estimation techniques like an Extended Kalman Filter (EKF) [19] or an Unscented Kalman Filter (UKF) [34]. Filtering techniques are very prominent for the integration of new information into past estimations, and also for the purpose of maneuver detection [11]. For example, [27] relies solely in angular information obtained from ground station, and manages to reduce the number of Gaussian mixture components with the use of Modified Equinoctial elements. [25] presents a review of the state of the art for IOD+OD methods, emphasizing the lack of an universal solution, as the applicability and performance of a given methodology is generally a compromise between speed and accuracy (dependent of the available data). [25] also proposes a single step IOD+OD method for full sate orbital estimation (including covariance) for optical measurements as a batch least-squares. An important aspect of the present work has been to understand the capability of the proposed method to achieve a reliable uncertainty characterization. In a similar note, in [7] the authors address the dynamics' modeling errors to properly achieve uncertainty realism with a batch least-square OD algorithm. Other methods for dealing with correct uncertainty characterization in IOD have been proposed by [2, 3], based on the use of Taylor differential algebra (DA) schemes for the map** of uncertainties to orbital elements space, and applied to various orbital regimes and measurement types.

This study aims to create reliable IOD methods that could be later used in the automatic procedures of cataloging uncorrelated tracks and posterior maneuver detection in the context of the S3TSR [12]. This radar was installed and validated by Indra with the funding of CDTI (Centro de Desarrollo Tecnológico e Industrial) under the technical and contractual management of ESA. Maintaining an up-to-date satellite database relying solely in the data acquired by a single radar is a challenging scenario, and that is the assumption considered in this work. Building upon the authors' prior investigation [23, 24], the primary concern is to effectively utilize all the information obtained from the observations of one radar track only. To achieve this, the entire set of measurements provided by the surveillance radar is employed, encompassing not only the range and range-rate, but also the not so precise line-of-sight information (azimuth and elevation). Consequently, an IOD process is necessary for the radar-acquired data, resulting in an estimation of the full state of the satellite. The main driver and ultimate motivation of this work is maneuver detection–specifically, the capability to accurately determine whether an object has performed an undisclosed maneuver since the last known state was determined. Non-disclosed maneuvers are the main roadblock in the SSA environment, rendering past estimations less relevant an complicating correlation tasks. The use of the developed IOD algorithms for maneuver detection is however not pursued here and will be the subject of a subsequent publication.

In the context of this study, the emphasis on radar-based orbit determination has been to keep all aspects pertaining to it as analytical as possible. Initially the use of attributables was considered [23]. The attributable has the advantage of using a polynomial model for the least-squares algorithm, which makes the method simple and fast, and the performance is excellent for long tracks. Choosing the state representation when doing the fitting is not straightforward though. For instance, the distinct qualitative evolution of the observables in measurement space make this a bad choice, as each is better approximated by a different order polynomial. The inertial position, or even position in relation to the radar frame of reference are smooth curves that can be approximated by the same order polynomial in the sense of a least-squares fitting [28]. On the other hand, attributables use no information of the dynamics that the fitted trajectory is following, which is known a priory with some certainty and could increase the accuracy of the estimation. It also requires to choose the order of the fitting, which is dependent on the track length for a given method.

The use of attributables is thus replaced by a procedure that includes information of the dynamics, similar to how the GTDS range and angles method uses Keplerian dynamics for the estimation [31, 20]. The main driving aspect for seeking an alternative to the well-proven GTDS algorithm is the need to leverage all available observables, including range-rate data. This has resulted in the creation of a fully analytical approximate method that incorporates the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation, detailed within this text. Interestingly, the unexpected requirement to incorporate Earth's flattening in short track orbital determination emerged as a notable outcome of this study, extensively explored within the ensuing results. For the purpose of long term non-Keplerian propagation other semi-analytical [1] or even analytical methods [22] could be leveraged, but the approximate nature of these averaged methods is not suited for the short track IOD application sought here. On the other hand, exact numerical methods for uncertainty propagation [17] do not fulfill the computational efficiency requirement in the context of large scale real-time track association [25]. The alternative proposed here presents a trade-off between error and speed that is perfectly suited for short propagations. The generalized equinoctial orbital elements in [4] have been used in this paper due to the explicit inclusion of potential derived perturbations in the equations of motion. Coupled with the natural slow evolution of these orbital representation, the direct application of a Taylor expansion for short term propagation becomes an interesting option. This study produces the analytical time derivatives of these orbital elements, up to the fourth order, and calculates the error state transition matrix through the Taylor expansion of the solution. Subsequently, this is harnessed to formulate a differential correction algorithm utilized in IOD with the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT zonal harmonic included as a perturbation, along with an extended application involving past orbital data.

Thus, the primary contribution concerns the full state estimation algorithm. A basic linear least-squares method is employed to fit radar observables directly. Within it, the state and uncertainty computation is being carried out with an analytical (approximated) J2 propagator that has been developed for this purpose. As an extension, this approach is improved by integrating information about the anticipated orbital plane of the object, a method denoted as OPOD. In the Low Earth Orbit (LEO) regime, this orbital plane is shown to be consistently predicted based on a prior estimation, even accounting for the possibility of a maneuver. The novel methodologies introduced in this work are compared to a well-established orbit determination method, showcasing significant enhancements in synthetic testing for IOD. This progress is achieved while maintaining the analytical nature of the procedure, a crucial design constraint for the operational applicability of this approach.

Next, an overview of the paper's organization is presented. In Section 2 the full state estimation algorithm is detailed first as a general linear least-square method, so that it can be particularized to the three main analytical methods compared latter. This section includes an extra methodology that leverages past orbital information to improve the estimation. Section 3 compiles detailed synthetic testing of the estimation methods, which are then applied to several scenarios that introduce variability in the track length and the frequency of measurements. The document is closed with some conclusions in Section 4. The A has been included with most of the formulation needed in the presented work.

2 Estimation from a single radar track

This section contains the main contribution of this work, namely the algorithms for IOD that use a J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT dynamical model for fitting any kind of satellite state-derived variable, and leveraged for fitting radar observables directly. After stating the IOD problem under consideration and setting the notation in Section 2.1, Section 2.2 reviews a general linear least-squares algorithm applicable to the stated problem for any kind of observable and propagation model. Then Section 2.3 particularizes the general algorithm to that of the GTDS, where position measurements (from range and angles observations) are fitted with Keplerian dynamics. In Section 2.4, radar observables alone are fitted also with a simple Kepler model. However, for a more accurate approximation of the derivatives in the differential correction algorithm, a Taylor expansion is employed. In Section 2.5 the generalized equinoctial orbital elements are leveraged for an approximation of the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT dynamics through a Taylor expansion, directly applicable for the short-track IOD problem under consideration. Finally, the inclusion of orbital plane information is proposed in Section 2.6 as an enhancement of the orbit determination algorithm, an immediate modification of the general method that simply requires the adequate observation function and derivatives.

2.1 Problem statement and notation

Refer to caption
Fig. 1: The estimation problem from a single radar track is represented here as an iterative fitting of the radar observables. The observations (plots) correspond to a set of range, azimuth, elevation and range-rate values (ρm,Azm,elm,ρ˙m)subscript𝜌𝑚𝐴subscript𝑧𝑚𝑒subscript𝑙𝑚subscript˙𝜌𝑚\left(\rho_{m},{Az}_{m},{el}_{m},\dot{\rho}_{m}\right)( italic_ρ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_A italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_e italic_l start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ), all of which create a track of n𝑛nitalic_n consecutive observations from the same Resident Space Object. Given the inertial frame of reference (I), the measurements are captured from a radar station with frame (R) of known position (𝑷Rsubscript𝑷𝑅\bm{P}_{R}bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT), velocity (𝑽Rsubscript𝑽𝑅\bm{V}_{R}bold_italic_V start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT) and orientation with respect to the inertial one (TIRsuperscriptsubscriptT𝐼𝑅\text{T}_{I}^{R}T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT), for any given instant tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT.

The aim of the methodology presented here is to obtain an estimation of the full state of the observed satellite from the information of a single radar track, see Figure 1 for a representation of the scenario. This involves defining a radar station with known inertial position (𝑹rsubscript𝑹𝑟\bm{R}_{r}bold_italic_R start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT), velocity (𝑽rsubscript𝑽𝑟\bm{V}_{r}bold_italic_V start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT) and antenna orientation (TIRsuperscriptsubscriptT𝐼𝑅\text{T}_{I}^{R}T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT) for any required instant. The radar has a designated Field of Regard (FoR) characterized by a specific revisit time for the measurement action. When a Resident Space Object (RSO) goes through the sensor's FoR it generates a track composed by series of observations or plots, which in turn are a set of measurements taken at a common epoch tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT. Here the sub-index m𝑚mitalic_m is used for any of the measurement instants of a radar track, where m[1,n]𝑚1𝑛m\in\left[1,n\right]italic_m ∈ [ 1 , italic_n ] and n𝑛nitalic_n is the number of individual plots. Typically, radar observables for LEO objects are range ρmsubscript𝜌𝑚\rho_{m}italic_ρ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, azimuth Azm𝐴subscript𝑧𝑚{Az}_{m}italic_A italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, elevation elm𝑒subscript𝑙𝑚{el}_{m}italic_e italic_l start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT and range-rate ρ˙msubscript˙𝜌𝑚\dot{\rho}_{m}over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, all of which are leveraged here for the purpose of IOD. Each measurement has error, characterized by a known standard deviation and included in a covariance matrix CzmsubscriptCsubscript𝑧𝑚\text{C}_{z_{m}}C start_POSTSUBSCRIPT italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_POSTSUBSCRIPT for the set, where some correlations between the different observables could be considered as well.

It is assumed that the observation function 𝒓m=OBSfun(ρm,Azm,elm)subscript𝒓𝑚subscriptOBS𝑓𝑢𝑛subscript𝜌𝑚𝐴subscript𝑧𝑚𝑒subscript𝑙𝑚\bm{r}_{m}=\text{OBS}_{fun}\left(\rho_{m},{Az}_{m},{el}_{m}\right)bold_italic_r start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = OBS start_POSTSUBSCRIPT italic_f italic_u italic_n end_POSTSUBSCRIPT ( italic_ρ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_A italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_e italic_l start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) allows to consider the inertial position as a measurement instead. The covariance of such position measurement CrmsubscriptCsubscript𝑟𝑚\text{C}_{r_{m}}C start_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_POSTSUBSCRIPT has to be calculated from the original radar uncertainty (CzmsubscriptCsubscript𝑧𝑚\text{C}_{z_{m}}C start_POSTSUBSCRIPT italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_POSTSUBSCRIPT). A linear transformation from measurement space could be applied, following [31]. On the other hand, the chosen alternative is to rely on the Unscented Transform (UT), as defined in [11], and use the OBSfunsubscriptOBS𝑓𝑢𝑛\text{OBS}_{fun}OBS start_POSTSUBSCRIPT italic_f italic_u italic_n end_POSTSUBSCRIPT function directly to map the sampled sigma points around the mean value (ρm,Azm,elm)subscript𝜌𝑚𝐴subscript𝑧𝑚𝑒subscript𝑙𝑚\left(\rho_{m},{Az}_{m},{el}_{m}\right)( italic_ρ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_A italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_e italic_l start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ). The sigma points are then reconstructed in inertial space to obtain the covariance matrix CrmsubscriptCsubscript𝑟𝑚\text{C}_{r_{m}}C start_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_POSTSUBSCRIPT. This choice results in a more conservative representation of the uncertainty than the linear method.

At the middle instant between t1subscript𝑡1t_{1}italic_t start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT and tnsubscript𝑡𝑛t_{n}italic_t start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT the epoch of the radar track is defined as t0=t1+(tnt1)/2subscript𝑡0subscript𝑡1subscript𝑡𝑛subscript𝑡12t_{0}=t_{1}+(t_{n}-t_{1})/2italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = italic_t start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + ( italic_t start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT - italic_t start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) / 2, where the estimation of the satellite's state 𝒚^0=[𝒓^0𝒗^0]subscript^𝒚0delimited-[]subscript^𝒓0subscript^𝒗0\hat{\bm{y}}_{0}=\left[\hat{\bm{r}}_{0}\,\hat{\bm{v}}_{0}\right]over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = [ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ] and its covariance CysubscriptC𝑦\text{C}_{y}C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT are computed with a fitting methodology. Note that 𝒓^0subscript^𝒓0\hat{\bm{r}}_{0}over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT and 𝒗^0subscript^𝒗0\hat{\bm{v}}_{0}over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT are the estimated inertial position and velocity. This approach requires the calculation of predicted measurements, z^msubscript^𝑧𝑚\hat{z}_{m}over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT in general, from the estimate 𝒚^0subscript^𝒚0\hat{\bm{y}}_{0}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, which in turns necessitates the propagation of the orbital state to the instant tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT. The propagation step is abstracted for now within the function 𝒚^m=[𝒓^m𝒗^m]=𝒫(𝒚^0,Δtm)subscript^𝒚𝑚delimited-[]subscript^𝒓𝑚subscript^𝒗𝑚𝒫subscript^𝒚0Δsubscript𝑡𝑚\hat{\bm{y}}_{m}=\left[\hat{\bm{r}}_{m}\,\hat{\bm{v}}_{m}\right]=\mathcal{P}% \left(\hat{\bm{y}}_{0},\Delta t_{m}\right)over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = [ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ] = caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ), where Δtm=tmt0Δsubscript𝑡𝑚subscript𝑡𝑚subscript𝑡0\Delta t_{m}=t_{m}-t_{0}roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT - italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT is the duration of the propagation from the reference instant t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, which is omitted 555The propagation generally requires to specify the reference epoch t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, but potential-based dynamics that go up to the second zonal harmonic do not depend on the reference instant, so only the total propagation time ΔtmΔsubscript𝑡𝑚\Delta t_{m}roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT is included in the formulation for brevity.. For the complete set of tools needed the function z=h(𝒚,t)𝑧𝒚𝑡z=h\left(\bm{y},t\right)italic_z = italic_h ( bold_italic_y , italic_t ) is defined as the conversion of an inertial state 𝒚𝒚\bm{y}bold_italic_y at an instant t𝑡titalic_t to any observable z𝑧zitalic_z (depending on the type of fitting). The function hhitalic_h allows to compute the aforementioned predicted measurement z^m=h(𝒚^m,tm)subscript^𝑧𝑚subscript^𝒚𝑚subscript𝑡𝑚\hat{z}_{m}=h\left(\hat{\bm{y}}_{m},t_{m}\right)over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ).

[31] utilizes a reference method for fitting position measurements (so that 𝒓^m=h(𝒚^m,tm)subscript^𝒓𝑚subscript^𝒚𝑚subscript𝑡𝑚\hat{\bm{r}}_{m}=h\left(\hat{\bm{y}}_{m},t_{m}\right)over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT )) in a very efficient way, by simply assuming the motion of the spacecraft is Keplerian in nature and iteratively fitting the trajectory spawned from the reference state 𝒚^0(i)superscriptsubscript^𝒚0𝑖\hat{\bm{y}}_{0}^{(i)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT. Following the notation of the source, the (i)𝑖\left(i\right)( italic_i ) super-index denotes the ithsuperscript𝑖𝑡i^{th}italic_i start_POSTSUPERSCRIPT italic_t italic_h end_POSTSUPERSCRIPT iteration of the differential correction process, so that the square sum of the position residuals (m=1n|𝒓m𝒓^m(i)|2\sum_{m=1}^{n}\lvert\bm{r}_{m}-\hat{\bm{r}}_{m}^{(i)}\lvert^{2}∑ start_POSTSUBSCRIPT italic_m = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT | bold_italic_r start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT - over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT | start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT) are minimized at every iteration until convergence occurs. This method has the advantage of including information that the radar is not providing, that is, the dynamics of the motion. As long as the length of the radar track is short enough this Keplerian approximation should be safe to assume, and it is exactly what the GTDS method applies [31, 20]. The result is a fast analytical algorithm that outputs a full state and its covariance, which in turn depends on the uncertainty of the measurements. The only disadvantage of the GTDS method is that range-rate information cannot be included, as it is exclusively a position fit.

Here, a general weighted least-square algorithm for fitting any type of measurement is first introduced in Section 2.2. This algorithm is subsequently adapted to the specific approach employed in [31] for position information only and a Kepler model for the dynamics (which includes some extra simplifications), denoted simply as the GTDS algorithm and reviewed in Section 2.3. The direct fitting of the radar observables with a Keplerian model is presented in Section 2.4 as an alternative to the GTDS method that incorporates range-rate data. The versatility of the general method permits the incorporation of alternative dynamic models. Section 2.5 presents the proposed fitting methodology where the dynamics are given by an (approximated) analytical J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT propagator, which is later improved by adding the orbital plane as a virtual measurement obtained from a past orbital estimation, see Section 2.6.

2.2 Iterative linearized least-squares fitting algorithm

To maintain a broad scope, the fitting algorithm is derived from a general scalar observable zmsubscript𝑧𝑚z_{m}italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT of any kind at time tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT. This measurement has some error (with known standard deviation σmsubscript𝜎𝑚\sigma_{m}italic_σ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT), so the predicted measurement z^m=h(𝒚^m,tm)subscript^𝑧𝑚subscript^𝒚𝑚subscript𝑡𝑚\hat{z}_{m}=h\left(\hat{\bm{y}}_{m},t_{m}\right)over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) from the estimated full state 𝒚^0subscript^𝒚0\hat{\bm{y}}_{0}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT is not equal in general, even without model inaccuracies in 𝒚^m=𝒫(𝒚^0,Δtm)subscript^𝒚𝑚𝒫subscript^𝒚0Δsubscript𝑡𝑚\hat{\bm{y}}_{m}=\mathcal{P}\left(\hat{\bm{y}}_{0},\Delta t_{m}\right)over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ). As a result it can be stated that zm=z^m+ξmsubscript𝑧𝑚subscript^𝑧𝑚subscript𝜉𝑚z_{m}=\hat{z}_{m}+\xi_{m}italic_z start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT + italic_ξ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, where ξmsubscript𝜉𝑚\xi_{m}italic_ξ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT is the residual of the observed value compared to the predicted one. The goal is to find the value of 𝒚^0subscript^𝒚0\hat{\bm{y}}_{0}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT that minimizes the sum of ξm2superscriptsubscript𝜉𝑚2\xi_{m}^{2}italic_ξ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT for all n𝑛nitalic_n measurements. More generally, it is necessary to consider some normalizing factor, as the different measurements may use different units, and thus not be comparable. Therefore, the objective is to minimize the sum of (wmξm)2superscriptsubscript𝑤𝑚subscript𝜉𝑚2(w_{m}\xi_{m})^{2}( italic_w start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT, where wm=1/σmsubscript𝑤𝑚1subscript𝜎𝑚w_{m}=1/\sigma_{m}italic_w start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = 1 / italic_σ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, as expressed in Equation 1. A prerequisite for this to properly define a least-squares problem is that the count of individual measurements to fit must exceed the dimension of the state (n>6𝑛6n>6italic_n > 6).

Jz=min𝒚^0m=1n(wmξm)2.subscript𝐽𝑧subscriptsubscript^𝒚0superscriptsubscript𝑚1𝑛superscriptsubscript𝑤𝑚subscript𝜉𝑚2J_{z}=\min_{\hat{\bm{y}}_{0}}\sum_{m=1}^{n}(w_{m}\xi_{m})^{2}.italic_J start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT = roman_min start_POSTSUBSCRIPT over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_POSTSUBSCRIPT ∑ start_POSTSUBSCRIPT italic_m = 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_n end_POSTSUPERSCRIPT ( italic_w start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT . (1)

This approach leads to a non-linear minimization problem that can be expensive to solve with no simplifications. Typically, it is advisable to opt for an iterative approach, where the result after i𝑖iitalic_i iterations, 𝒚^0(i)superscriptsubscript^𝒚0𝑖\hat{\bm{y}}_{0}^{(i)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT, is a close approximation to the solution of the general minimization problem. Assuming a good enough first estimate of 𝒚^0subscript^𝒚0\hat{\bm{y}}_{0}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT is known, an approximation of the the predicted observable z^msubscript^𝑧𝑚\hat{z}_{m}over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT can be calculated as a linearization around the value z^m(i)superscriptsubscript^𝑧𝑚𝑖\hat{z}_{m}^{(i)}over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT for a variation of the estimation at the current iteration Δ𝒚^0(i)Δsuperscriptsubscript^𝒚0𝑖\Delta\hat{\bm{y}}_{0}^{(i)}roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT (so that 𝒚^0(i+1)=𝒚^0(i)+Δ𝒚^0(i)superscriptsubscript^𝒚0𝑖1superscriptsubscript^𝒚0𝑖Δsuperscriptsubscript^𝒚0𝑖\hat{\bm{y}}_{0}^{(i+1)}=\hat{\bm{y}}_{0}^{(i)}+\Delta\hat{\bm{y}}_{0}^{(i)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT = over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT), see Equation 2.

h(𝒚^m,tm)h(𝒫(𝒚^0(i),Δtm),tm)+h𝒚^0(𝒚^0(i),tm)Δ𝒚^0(i)=h(𝒚^m(i),tm)+h𝒚(𝒚^m(i),tm)𝒫𝒚^0(𝒚^0(i),Δtm)Δ𝒚^0(i).h(\hat{\bm{y}}_{m},t_{m})\approx h\left(\mathcal{P}\left(\hat{\bm{y}}_{0}^{(i)% },\Delta t_{m}\right),t_{m}\right)+\frac{\partial h}{\partial\hat{\bm{y}}_{0}}% \biggr{\rfloor}_{(\hat{\bm{y}}_{0}^{(i)},t_{m})}\Delta\hat{\bm{y}}_{0}^{(i)}=h% (\hat{\bm{y}}_{m}^{(i)},t_{m})+\frac{\partial h}{\partial\bm{y}}\biggr{\rfloor% }_{(\hat{\bm{y}}_{m}^{(i)},t_{m})}\frac{\partial\mathcal{P}}{\partial\hat{\bm{% y}}_{0}}\biggr{\rfloor}_{(\hat{\bm{y}}_{0}^{(i)},\Delta t_{m})}\Delta\hat{\bm{% y}}_{0}^{(i)}.italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) ≈ italic_h ( caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) + divide start_ARG ∂ italic_h end_ARG start_ARG ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) + divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT divide start_ARG ∂ caligraphic_P end_ARG start_ARG ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT . (2)

Considering all the measurements 𝒛=[z1,,zn]𝒛superscriptsubscript𝑧1subscript𝑧𝑛\bm{z}=\left[z_{1},\cdots,z_{n}\right]^{\intercal}bold_italic_z = [ italic_z start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , ⋯ , italic_z start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT, and the predicted measurements 𝒛^(i)=[z^1(i),,z^n(i)]superscript^𝒛𝑖superscriptsuperscriptsubscript^𝑧1𝑖superscriptsubscript^𝑧𝑛𝑖\hat{\bm{z}}^{(i)}=\left[\hat{z}_{1}^{(i)},\cdots,\hat{z}_{n}^{(i)}\right]^{\intercal}over^ start_ARG bold_italic_z end_ARG start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = [ over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , ⋯ , over^ start_ARG italic_z end_ARG start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT from 𝒚^0(i)superscriptsubscript^𝒚0𝑖\hat{\bm{y}}_{0}^{(i)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT, the error Δ𝒛(i)=𝒛𝒛^(i)Δsuperscript𝒛𝑖𝒛superscript^𝒛𝑖\Delta\bm{z}^{(i)}=\bm{z}-\hat{\bm{z}}^{(i)}roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = bold_italic_z - over^ start_ARG bold_italic_z end_ARG start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT is defined. Now, the derivatives of the predicted observed value for the last iteration h/𝒚^0(𝒚^0(i),tm)\partial h/\partial\hat{\bm{y}}_{0}\rfloor_{(\hat{\bm{y}}_{0}^{(i)},t_{m})}∂ italic_h / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT are stacked in the matrix A to get the linear equation Δ𝒛(i)=AΔ𝒚0(i)+𝝃Δsuperscript𝒛𝑖AΔsuperscriptsubscript𝒚0𝑖𝝃\Delta\bm{z}^{(i)}=\text{A}\,\Delta\bm{y}_{0}^{(i)}+\bm{\xi}roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = A roman_Δ bold_italic_y start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + bold_italic_ξ, with 𝝃𝝃\bm{\xi}bold_italic_ξ being the the residuals vector for the iteration. With this expression, the same minimization problem as in Equation 1 can be posed and solved as a linear least-squares problem, see Equation 3, where the matrix Cy=(AWA)1subscriptC𝑦superscriptsuperscriptAWA1\text{C}_{y}=\left(\text{A}^{\intercal}\text{W}\text{A}\right)^{-1}C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT = ( A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT roman_W roman_A ) start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT is the covariance of the estimation.

Δ𝒛(i)=AΔ𝒚0(i)+𝝃Jz=minΔ𝒚^0(i)𝝃W𝝃=minΔ𝒚^0(i)(Δ𝒛(i)AΔ𝒚^0(i))W(Δ𝒛(i)AΔ𝒚^0(i)),Δ𝒚0(i)=(AWA)1(AWΔ𝒛(i)).\begin{split}\Delta\bm{z}^{(i)}=&\text{A}\,\Delta\bm{y}_{0}^{(i)}+\bm{\xi}\\ J_{z}=&\min_{\Delta\hat{\bm{y}}_{0}^{(i)}}\>\bm{\xi}^{\intercal}\text{W}\bm{% \xi}=\min_{\Delta\hat{\bm{y}}_{0}^{(i)}}\>(\Delta\bm{z}^{(i)}-\text{A}\,\Delta% \hat{\bm{y}}_{0}^{(i)})^{\intercal}\text{W}(\Delta\bm{z}^{(i)}-\text{A}\,% \Delta\hat{\bm{y}}_{0}^{(i)}),\\ \Delta\bm{y}_{0}^{(i)}=&\left(\text{A}^{\intercal}\text{W}\text{A}\right)^{-1}% (\text{A}^{\intercal}\text{W}\,\Delta\bm{z}^{(i)}).\end{split}start_ROW start_CELL roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = end_CELL start_CELL A roman_Δ bold_italic_y start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + bold_italic_ξ end_CELL end_ROW start_ROW start_CELL italic_J start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT = end_CELL start_CELL roman_min start_POSTSUBSCRIPT roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT end_POSTSUBSCRIPT bold_italic_ξ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT W bold_italic_ξ = roman_min start_POSTSUBSCRIPT roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT end_POSTSUBSCRIPT ( roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT - A roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT W ( roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT - A roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) , end_CELL end_ROW start_ROW start_CELL roman_Δ bold_italic_y start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = end_CELL start_CELL ( A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT roman_W roman_A ) start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT ( A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT W roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) . end_CELL end_ROW (3)

In a similar note to the general least-squares problem, see Equation 1, a normalization of the residuals is required. The matrix W=Cz1WsuperscriptsubscriptC𝑧1\text{W}=\text{C}_{z}^{-1}W = C start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT with the inverted measurements covariance is chosen. In this general formulation Cz=diag(σ12,,σn2)subscriptC𝑧diagsuperscriptsubscript𝜎12superscriptsubscript𝜎𝑛2\text{C}_{z}=\text{diag}\left(\sigma_{1}^{2},\cdots,\sigma_{n}^{2}\right)C start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT = diag ( italic_σ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , ⋯ , italic_σ start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ), although the addition of correlations is also possible. This differential correction approach is very convenient, as now solving the full optimization problem becomes equivalent to several iterations of a linear least-squares problem. The general convergence of this approach to the true global minimum is not assured, primarily owing to the potential presence of nearby local minima. However, provided the initial estimation is sufficiently close, it presents a favorable trade-off between speed and accuracy as analyzed by [32]. Given the output of every iteration as Δ𝒚^0(i)=[Δ𝒓^0(i)Δ𝒗^0(i)]Δsuperscriptsubscript^𝒚0𝑖delimited-[]Δsuperscriptsubscript^𝒓0𝑖Δsuperscriptsubscript^𝒗0𝑖\Delta\hat{\bm{y}}_{0}^{(i)}=\left[\Delta\hat{\bm{r}}_{0}^{(i)}\,\Delta\hat{% \bm{v}}_{0}^{(i)}\right]roman_Δ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = [ roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ], the stop** condition should be a function of the norm of position displacement |Δ𝒓^0(i)|Δsubscriptsuperscript^𝒓𝑖0|\Delta\hat{\bm{r}}^{(i)}_{0}|| roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT |, so that when the change is under some threshold the last iteration is the solution. The matrix of predicted observations derivatives A has to be recomputed for every iteration.

There has been no mention so far of the propagation method inside 𝒫(𝒚^0,Δtm)𝒫subscript^𝒚0Δsubscript𝑡𝑚\mathcal{P}(\hat{\bm{y}}_{0},\Delta t_{m})caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ), or the relation between the spacecraft state and the measurements nature in h(𝒚,t)𝒚𝑡h(\bm{y},t)italic_h ( bold_italic_y , italic_t ). Now three different fully analytical methods are considered. The analytical aspect is important, as the goal is to obtain an algorithm comparable to the GTDS method speed-wise, which is only possible for fast propagation functions.

2.3 Keplerian fitting of non-weighted Cartesian position - GTDS

The GTDS range and angles method is reviewed in this section as a particular case of the general algorithm of Section 2.2. In this method the fit is in inertial position, where measurements are represented by 𝒓msubscript𝒓𝑚\bm{r}_{m}bold_italic_r start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT at each instant tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, so the vector with all is 𝒛=[𝒓1,𝒓2,,𝒓n]𝒛superscriptsuperscriptsubscript𝒓1superscriptsubscript𝒓2superscriptsubscript𝒓𝑛\bm{z}=\left[\bm{r}_{1}^{\intercal},\bm{r}_{2}^{\intercal},\cdots,\bm{r}_{n}^{% \intercal}\right]^{\intercal}bold_italic_z = [ bold_italic_r start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT , bold_italic_r start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT , ⋯ , bold_italic_r start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT.

The predicted measurements 𝒓^msubscript^𝒓𝑚\hat{\bm{r}}_{m}over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT are thus an explicit function of the propagated estimation 𝒚^msubscript^𝒚𝑚\hat{\bm{y}}_{m}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT, so that 𝒓^m=h(𝒚^m,tm)subscript^𝒓𝑚subscript^𝒚𝑚subscript𝑡𝑚\hat{\bm{r}}_{m}=h\left(\hat{\bm{y}}_{m},t_{m}\right)over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = italic_h ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ). The propagation function 𝒫(𝒚^0,Δt)𝒫subscript^𝒚0Δ𝑡\mathcal{P}\left(\hat{\bm{y}}_{0},\Delta t\right)caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t ) assures Keplerian dynamics. Various methods are available for performing this analytical propagation; however, in this case, the formulation of the universal variable χ𝜒\chiitalic_χ as outlined in [32] has been selected. This is a general method, valid for all orbit types, which allows to compute the values of the f𝑓fitalic_f and g𝑔gitalic_g Kepler functions that linearly combine the initial conditions and get the propagated state, see Equation 4.

𝒚^m=𝒫(𝒚^0,Δtm)=[𝒓^(𝒚^0,Δtm)𝒗^(𝒚^0,Δtm)]=[f(𝒓^0,𝒗^0,Δtm)^𝒓0+g(𝒓^0,𝒗^0,Δtm)𝒗^0f˙(𝒓^0,𝒗^0,Δtm)𝒓^0+g˙(𝒓^0,𝒗^0,Δtm)𝒗^0].subscript^𝒚𝑚𝒫subscript^𝒚0Δsubscript𝑡𝑚matrix^𝒓subscript^𝒚0Δsubscript𝑡𝑚^𝒗subscript^𝒚0Δsubscript𝑡𝑚matrix𝑓subscript^𝒓0subscript^𝒗0Δsubscript𝑡𝑚bold-^absentsubscript𝒓0𝑔subscript^𝒓0subscript^𝒗0Δsubscript𝑡𝑚subscript^𝒗0˙𝑓subscript^𝒓0subscript^𝒗0Δsubscript𝑡𝑚subscript^𝒓0˙𝑔subscript^𝒓0subscript^𝒗0Δsubscript𝑡𝑚subscript^𝒗0\hat{\bm{y}}_{m}=\mathcal{P}\left(\hat{\bm{y}}_{0},\Delta t_{m}\right)=\begin{% bmatrix}\hat{\bm{r}}(\hat{\bm{y}}_{0},\Delta t_{m})\\ \hat{\bm{v}}(\hat{\bm{y}}_{0},\Delta t_{m})\end{bmatrix}=\begin{bmatrix}f(\hat% {\bm{r}}_{0},\hat{\bm{v}}_{0},\Delta t_{m})\bm{\hat{}}{\bm{r}}_{0}+g(\hat{\bm{% r}}_{0},\hat{\bm{v}}_{0},\Delta t_{m})\hat{\bm{v}}_{0}\\ \dot{f}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0},\Delta t_{m})\hat{\bm{r}}_{0}+\dot{g% }(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0},\Delta t_{m})\hat{\bm{v}}_{0}\end{bmatrix}.over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = caligraphic_P ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) = [ start_ARG start_ROW start_CELL over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_CELL end_ROW start_ROW start_CELL over^ start_ARG bold_italic_v end_ARG ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_CELL end_ROW end_ARG ] = [ start_ARG start_ROW start_CELL italic_f ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) overbold_^ start_ARG end_ARG bold_italic_r start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT + italic_g ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_f end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT + over˙ start_ARG italic_g end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL end_ROW end_ARG ] . (4)

The details to compute f𝑓fitalic_f and g𝑔gitalic_g values are in Algorithm 8 of [32]. In order to apply the iterative method the predicted position 𝒓^(𝒚^0,Δt)^𝒓subscript^𝒚0Δ𝑡\hat{\bm{r}}(\hat{\bm{y}}_{0},\Delta t)over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t ), in Equation 4, has to be linearized around 𝒓^0(i)superscriptsubscript^𝒓0𝑖\hat{\bm{r}}_{0}^{(i)}over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT and 𝒗^0(i)superscriptsubscript^𝒗0𝑖\hat{\bm{v}}_{0}^{(i)}over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT for a variation Δ𝒓^0(i)Δsuperscriptsubscript^𝒓0𝑖\Delta\hat{\bm{r}}_{0}^{(i)}roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT and Δ𝒗^0(i)Δsuperscriptsubscript^𝒗0𝑖\Delta\hat{\bm{v}}_{0}^{(i)}roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT respectively, as shown in Equation 5. In the sequel, the dependence over ΔtΔ𝑡\Delta troman_Δ italic_t has been dropped.

𝒓^(𝒓^0,𝒗^0)𝒓^(𝒓^0(i),𝒗^0(i))+𝒓^𝒓^0(i)Δ𝒓^0(i)+𝒓^𝒗^0(i)Δ𝒗^0(i),𝒓^𝒓^0(i)=f(i)𝒓^0𝒓^0+𝒓^0(i)f𝒓^0(i)+𝒗^0(i)g𝒓^0(i),𝒓^𝒗^0(i)=g(i)𝒗^0𝒗^0+𝒓^0(i)f𝒗^0(i)+𝒗^0(i)g𝒗^0(i).\begin{split}\hat{\bm{r}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\approx&\,\hat{\bm% {r}}(\hat{\bm{r}}_{0}^{(i)},\hat{\bm{v}}_{0}^{(i)})+\frac{\partial\hat{\bm{r}}% }{\partial\hat{\bm{r}}_{0}}\biggr{\rfloor}^{(i)}\Delta\hat{\bm{r}}_{0}^{(i)}+% \frac{\partial\hat{\bm{r}}}{\partial\hat{\bm{v}}_{0}}\biggr{\rfloor}^{(i)}% \Delta\hat{\bm{v}}_{0}^{(i)},\\ \frac{\partial\hat{\bm{r}}}{\partial\hat{\bm{r}}_{0}}\biggr{\rfloor}^{(i)}=&f^% {(i)}\frac{\partial\hat{\bm{r}}_{0}}{\partial\hat{\bm{r}}_{0}}+\hat{\bm{r}}_{0% }^{(i)}\frac{\partial f}{\partial\hat{\bm{r}}_{0}}\biggr{\rfloor}^{(i)}+\hat{% \bm{v}}_{0}^{(i)}\frac{\partial g}{\partial\hat{\bm{r}}_{0}}\biggr{\rfloor}^{(% i)},\\ \frac{\partial\hat{\bm{r}}}{\partial\hat{\bm{v}}_{0}}\biggr{\rfloor}^{(i)}=&g^% {(i)}\frac{\partial\hat{\bm{v}}_{0}}{\partial\hat{\bm{v}}_{0}}+\hat{\bm{r}}_{0% }^{(i)}\frac{\partial f}{\partial\hat{\bm{v}}_{0}}\biggr{\rfloor}^{(i)}+\hat{% \bm{v}}_{0}^{(i)}\frac{\partial g}{\partial\hat{\bm{v}}_{0}}\biggr{\rfloor}^{(% i)}.\end{split}start_ROW start_CELL over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) ≈ end_CELL start_CELL over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) + divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , end_CELL end_ROW start_ROW start_CELL divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = end_CELL start_CELL italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG + over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ italic_f end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ italic_g end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , end_CELL end_ROW start_ROW start_CELL divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT = end_CELL start_CELL italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG + over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ italic_f end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ italic_g end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT . end_CELL end_ROW (5)

In order to compute the derivatives that appear in Equation 5, the derivatives of the f𝑓fitalic_f and g𝑔gitalic_g functions are apparently necessary. That said, at this point the GTDS method applies the simplification of f/𝒓0=f/𝒗0=g/𝒓0=g/𝒗0=𝟎𝑓subscript𝒓0𝑓subscript𝒗0𝑔subscript𝒓0𝑔subscript𝒗0superscript0\partial f/\partial\bm{r}_{0}=\partial f/\partial\bm{v}_{0}=\partial g/% \partial\bm{r}_{0}=\partial g/\partial\bm{v}_{0}=\bm{0}^{\intercal}∂ italic_f / ∂ bold_italic_r start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = ∂ italic_f / ∂ bold_italic_v start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = ∂ italic_g / ∂ bold_italic_r start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = ∂ italic_g / ∂ bold_italic_v start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = bold_0 start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT, which essentially bypasses the need of any diferentiation. The derivatives in Equation 5 are thus reduced to 𝒓^/𝒓^0(i)f(i)I3\partial\hat{\bm{r}}/\partial\hat{\bm{r}}_{0}\rfloor^{(i)}\approx f^{(i)}\text% {I}_{3}∂ over^ start_ARG bold_italic_r end_ARG / ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ≈ italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT I start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT and 𝒓^/𝒗^0(i)g(i)I3\partial\hat{\bm{r}}/\partial\hat{\bm{v}}_{0}\rfloor^{(i)}\approx g^{(i)}\text% {I}_{3}∂ over^ start_ARG bold_italic_r end_ARG / ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ≈ italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT I start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT. The matrix I3subscriptI3\text{I}_{3}I start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT is the identity matrix of order 3. Applying this technique to the linearization of the predicted position results in:

𝒓^(𝒓^0,𝒗^0)^𝒓subscript^𝒓0subscript^𝒗0absent\displaystyle\hat{\bm{r}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\approxover^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) ≈ 𝒓^(𝒓^0(i),𝒗^0(i))+𝒓^𝒓^0(i)Δ𝒓^0(i)+𝒓^𝒗^0(i)Δ𝒗^0(i)\displaystyle\,\hat{\bm{r}}(\hat{\bm{r}}_{0}^{(i)},\hat{\bm{v}}_{0}^{(i)})+% \frac{\partial\hat{\bm{r}}}{\partial\hat{\bm{r}}_{0}}\biggr{\rfloor}^{(i)}% \Delta\hat{\bm{r}}_{0}^{(i)}+\frac{\partial\hat{\bm{r}}}{\partial\hat{\bm{v}}_% {0}}\biggr{\rfloor}^{(i)}\Delta\hat{\bm{v}}_{0}^{(i)}over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) + divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT (6)
\displaystyle\approx f(i)𝒓^0(i)+g(i)𝒗^0(i)+f(i)Δ𝒓^0(i)+g(i)Δ𝒗^0(i)superscript𝑓𝑖superscriptsubscript^𝒓0𝑖superscript𝑔𝑖superscriptsubscript^𝒗0𝑖superscript𝑓𝑖Δsuperscriptsubscript^𝒓0𝑖superscript𝑔𝑖Δsuperscriptsubscript^𝒗0𝑖\displaystyle f^{(i)}\hat{\bm{r}}_{0}^{(i)}+g^{(i)}\hat{\bm{v}}_{0}^{(i)}+f^{(% i)}\Delta\hat{\bm{r}}_{0}^{(i)}+g^{(i)}\Delta\hat{\bm{v}}_{0}^{(i)}italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT
=\displaystyle== f(i)(𝒓^0(i)+Δ𝒓^0(i))+g(i)(𝒗^0(i)+Δ𝒗^0(i))=f(i)𝒓^0(i+1)+g(i)𝒗^0(i+1).superscript𝑓𝑖superscriptsubscript^𝒓0𝑖Δsuperscriptsubscript^𝒓0𝑖superscript𝑔𝑖superscriptsubscript^𝒗0𝑖Δsuperscriptsubscript^𝒗0𝑖superscript𝑓𝑖superscriptsubscript^𝒓0𝑖1superscript𝑔𝑖superscriptsubscript^𝒗0𝑖1\displaystyle f^{(i)}(\hat{\bm{r}}_{0}^{(i)}+\Delta\hat{\bm{r}}_{0}^{(i)})+g^{% (i)}(\hat{\bm{v}}_{0}^{(i)}+\Delta\hat{\bm{v}}_{0}^{(i)})=f^{(i)}\hat{\bm{r}}_% {0}^{(i+1)}+g^{(i)}\hat{\bm{v}}_{0}^{(i+1)}.italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + roman_Δ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) + italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ( over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + roman_Δ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT ) = italic_f start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT + italic_g start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT .

After the linearization and later simplification the predicted measurement at tmsubscript𝑡𝑚t_{m}italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT can be expressed as a linear function of the state of the next iteration:

𝒓^m=𝒓^(𝒓^0,𝒗^0,Δtm)f(𝒓^0(i),𝒗^0(i),Δtm)𝒓^0(i+1)+g(𝒓^0(i),𝒗^0(i),Δtm)𝒗^0(i+1)=fm(i)I3𝒓^0(i+1)+gm(i)I3𝒗^0(i+1)=[fm00gm000fm00gm000fm00gm](i)[𝒓^0(i+1)𝒗^0(i+1)].subscript^𝒓𝑚^𝒓subscript^𝒓0subscript^𝒗0Δsubscript𝑡𝑚𝑓superscriptsubscript^𝒓0𝑖superscriptsubscript^𝒗0𝑖Δsubscript𝑡𝑚superscriptsubscript^𝒓0𝑖1𝑔superscriptsubscript^𝒓0𝑖superscriptsubscript^𝒗0𝑖Δsubscript𝑡𝑚superscriptsubscript^𝒗0𝑖1superscriptsubscript𝑓𝑚𝑖subscriptI3superscriptsubscript^𝒓0𝑖1superscriptsubscript𝑔𝑚𝑖subscriptI3superscriptsubscript^𝒗0𝑖1superscriptmatrixsubscript𝑓𝑚00subscript𝑔𝑚000subscript𝑓𝑚00subscript𝑔𝑚000subscript𝑓𝑚00subscript𝑔𝑚𝑖matrixsuperscriptsubscript^𝒓0𝑖1superscriptsubscript^𝒗0𝑖1\begin{split}\hat{\bm{r}}_{m}=\hat{\bm{r}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0},% \Delta t_{m})\approx&f(\hat{\bm{r}}_{0}^{(i)},\hat{\bm{v}}_{0}^{(i)},\Delta t_% {m})\hat{\bm{r}}_{0}^{(i+1)}+g(\hat{\bm{r}}_{0}^{(i)},\hat{\bm{v}}_{0}^{(i)},% \Delta t_{m})\hat{\bm{v}}_{0}^{(i+1)}\\ =&f_{m}^{(i)}\text{I}_{3}\hat{\bm{r}}_{0}^{(i+1)}+g_{m}^{(i)}\text{I}_{3}\hat{% \bm{v}}_{0}^{(i+1)}\\ =&\begin{bmatrix}f_{m}&0&0&g_{m}&0&0\\ 0&f_{m}&0&0&g_{m}&0\\ 0&0&f_{m}&0&0&g_{m}\\ \end{bmatrix}^{(i)}\begin{bmatrix}\hat{\bm{r}}_{0}^{(i+1)}\\ \hat{\bm{v}}_{0}^{(i+1)}\end{bmatrix}.\end{split}start_ROW start_CELL over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT = over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) ≈ end_CELL start_CELL italic_f ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT + italic_g ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT end_CELL end_ROW start_ROW start_CELL = end_CELL start_CELL italic_f start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT I start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT + italic_g start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT I start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT end_CELL end_ROW start_ROW start_CELL = end_CELL start_CELL [ start_ARG start_ROW start_CELL italic_f start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT end_CELL end_ROW end_ARG ] start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT [ start_ARG start_ROW start_CELL over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT end_CELL end_ROW start_ROW start_CELL over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT end_CELL end_ROW end_ARG ] . end_CELL end_ROW (7)

By utilizing the form in Eq. (7) it is possible to express the vector of (approximated) predicted positions (𝒛^^𝒛\hat{\bm{z}}over^ start_ARG bold_italic_z end_ARG) by linearly combining the matrix A, see Equation (8), with the estimation 𝒚^0(i+1)superscriptsubscript^𝒚0𝑖1\hat{\bm{y}}_{0}^{(i+1)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT. The sub-indices in the elements of A refer to the measurement instant, and the (i)𝑖(i)( italic_i ) super-index refers to this matrix being computed at every iteration.

A=[f100g1000f100g1000f100g1fn00gn000fn00gn000fn00gn](i).Asuperscriptmatrixsubscript𝑓100subscript𝑔1000subscript𝑓100subscript𝑔1000subscript𝑓100subscript𝑔1subscript𝑓𝑛00subscript𝑔𝑛000subscript𝑓𝑛00subscript𝑔𝑛000subscript𝑓𝑛00subscript𝑔𝑛𝑖\text{A}=\begin{bmatrix}f_{1}&0&0&g_{1}&0&0\\ 0&f_{1}&0&0&g_{1}&0\\ 0&0&f_{1}&0&0&g_{1}\\ \vdots&\vdots&\vdots&\vdots&\vdots&\vdots\\ f_{n}&0&0&g_{n}&0&0\\ 0&f_{n}&0&0&g_{n}&0\\ 0&0&f_{n}&0&0&g_{n}\\ \end{bmatrix}^{(i)}.A = [ start_ARG start_ROW start_CELL italic_f start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL ⋮ end_CELL start_CELL ⋮ end_CELL start_CELL ⋮ end_CELL start_CELL ⋮ end_CELL start_CELL ⋮ end_CELL start_CELL ⋮ end_CELL end_ROW start_ROW start_CELL italic_f start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL end_ROW start_ROW start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_f start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL start_CELL 0 end_CELL start_CELL 0 end_CELL start_CELL italic_g start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_CELL end_ROW end_ARG ] start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT . (8)

The position residuals in 𝒛=A𝒚^0(i+1)+𝝃𝒛Asuperscriptsubscript^𝒚0𝑖1𝝃\bm{z}=\text{A}\hat{\bm{y}}_{0}^{(i+1)}+\bm{\xi}bold_italic_z = A over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT + bold_italic_ξ are thus a explicit function of the estimation 𝒚^0(i+1)superscriptsubscript^𝒚0𝑖1\hat{\bm{y}}_{0}^{(i+1)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT. By solving the linear least-squares in Eq. (3) with W𝑊Witalic_W being the identity matrix (non-weighted), the solution in Equation (9) is that of the GTDS method. Emphasis has to be put on the choice of not weighting position residuals despite the availability of an uncertainty characterization. The result is a fit that minimizes errors in all directions equally. The covariance of the estimation is computed from the matrix H=(AA)1AHsuperscriptsuperscriptAA1superscriptA\text{H}=\left(\text{A}^{\intercal}\text{A}\right)^{-1}\text{A}^{\intercal}H = ( A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT A ) start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT as a linear approximation after the estimation is computed (in the last iteration). For a more compact form to the solution of Eq. (9) see [31].

𝒚0(i+1)=(AA)1A𝒛=H𝒛,Cy=HCrH,where Cr=diag(Cr1,,Crn).formulae-sequencesuperscriptsubscript𝒚0𝑖1superscriptsuperscriptAA1superscriptA𝒛H𝒛formulae-sequencesubscriptC𝑦subscriptHC𝑟superscriptHsubscriptwhere C𝑟diagsubscriptCsubscript𝑟1subscriptCsubscript𝑟𝑛\begin{split}\bm{y}_{0}^{(i+1)}&=\left({\text{A}}^{\intercal}\text{A}\right)^{% -1}{\text{A}}^{\intercal}\bm{z}=\text{H}\,\bm{z},\\ \text{C}_{y}&=\text{H}\text{C}_{r}\text{H}^{\intercal},\,\text{where }\text{C}% _{r}=\text{diag}\left(\text{C}_{r_{1}},\cdots,\text{C}_{r_{n}}\right).\end{split}start_ROW start_CELL bold_italic_y start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i + 1 ) end_POSTSUPERSCRIPT end_CELL start_CELL = ( A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT A ) start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT A start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_z = H bold_italic_z , end_CELL end_ROW start_ROW start_CELL C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT end_CELL start_CELL = roman_H roman_C start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT H start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT , where roman_C start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT = diag ( C start_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_POSTSUBSCRIPT , ⋯ , C start_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT end_POSTSUBSCRIPT ) . end_CELL end_ROW (9)

2.4 Keplerian fitting of radar observables

This method is proposed as a variation of GTDS where measurements are fitted directly with Keplerian dynamics, which allows to incorporate the range-rate information into the fitting process. The measurement vector comprises all observables directly, represented as 𝒛=[ρ1,Az1,el1,ρ˙1,,ρn,Azn,eln,ρ˙n]𝒛superscriptsubscript𝜌1𝐴subscript𝑧1𝑒subscript𝑙1subscript˙𝜌1subscript𝜌𝑛𝐴subscript𝑧𝑛𝑒subscript𝑙𝑛subscript˙𝜌𝑛\bm{z}=\left[\rho_{1},Az_{1},{el}_{1},\dot{\rho}_{1},\cdots,\rho_{n},Az_{n},{% el}_{n},\dot{\rho}_{n}\right]^{\intercal}bold_italic_z = [ italic_ρ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_A italic_z start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_e italic_l start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , ⋯ , italic_ρ start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT , italic_A italic_z start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT , italic_e italic_l start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT , over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT italic_n end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT. The [ρ,Az,el,ρ˙]=h(𝒚,t)𝜌𝐴𝑧𝑒𝑙˙𝜌𝒚𝑡\left[\rho,{Az},{el},\dot{\rho}\right]=h(\bm{y},t)[ italic_ρ , italic_A italic_z , italic_e italic_l , over˙ start_ARG italic_ρ end_ARG ] = italic_h ( bold_italic_y , italic_t ) function for these measurements is in Equation (10), where 𝒚=[𝒓𝒗]𝒚delimited-[]𝒓𝒗\bm{y}=\left[\bm{r}\,\bm{v}\right]bold_italic_y = [ bold_italic_r bold_italic_v ], t𝑡titalic_t is omitted for brevity, and the relative inertial position 𝝆=𝒓𝑷R𝝆𝒓subscript𝑷𝑅\bm{\rho}=\bm{r}-\bm{P}_{R}bold_italic_ρ = bold_italic_r - bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT and velocity 𝒖=𝒗𝑽R𝒖𝒗subscript𝑽𝑅\bm{u}=\bm{v}-\bm{V}_{R}bold_italic_u = bold_italic_v - bold_italic_V start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT are defined for a compact notation. The unit vectors forming the base of a Cartesian frame are denoted as (𝒆1,𝒆2,𝒆3)subscript𝒆1subscript𝒆2subscript𝒆3\left(\bm{e}_{1},\bm{e}_{2},\bm{e}_{3}\right)( bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , bold_italic_e start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT ). It is important to note that incorporating range-rate necessitates the utilization of both predicted velocity and position. In the case of the Keplerian model, this entails computing the f˙˙𝑓\dot{f}over˙ start_ARG italic_f end_ARG and g˙˙𝑔\dot{g}over˙ start_ARG italic_g end_ARG functions, as shown in Equation (4) (see [32] Algorithm 8).

ρ𝜌\displaystyle\rhoitalic_ρ =[(𝒓𝑷R)(𝒓𝑷R)]1/2=[𝝆𝝆]1/2,absentsuperscriptdelimited-[]superscript𝒓subscript𝑷𝑅𝒓subscript𝑷𝑅12superscriptdelimited-[]superscript𝝆𝝆12\displaystyle=\left[\left(\bm{r}-\bm{P}_{R}\right)^{\intercal}\left(\bm{r}-\bm% {P}_{R}\right)\right]^{1/2}=\left[\bm{\rho}^{\intercal}\bm{\rho}\right]^{1/2},= [ ( bold_italic_r - bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ( bold_italic_r - bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT ) ] start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT = [ bold_italic_ρ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ρ ] start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT , (10)
Az𝐴𝑧\displaystyle Azitalic_A italic_z =atan2(𝒆1𝝆R,𝒆2𝝆R)=atan2(𝒆1TIR𝝆,𝒆2TIR𝝆),\displaystyle=\text{atan2}{\left({\bm{e}_{1}^{\intercal}\bm{\rho}\rfloor_{R}},% {\bm{e}_{2}^{\intercal}\bm{\rho}\rfloor_{R}}\right)}=\text{atan2}{\left({\bm{e% }_{1}^{\intercal}\text{T}_{I}^{R}\bm{\rho}},{\bm{e}_{2}^{\intercal}\text{T}_{I% }^{R}\bm{\rho}}\right)},= atan2 ( bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ρ ⌋ start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT , bold_italic_e start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ρ ⌋ start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT ) = atan2 ( bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT bold_italic_ρ , bold_italic_e start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT bold_italic_ρ ) ,
el𝑒𝑙\displaystyle elitalic_e italic_l =arcsin(𝒆3𝝆Rρ)=arcsin(𝒆3TIR𝝆ρ),\displaystyle=\arcsin{\left(\frac{\bm{e}_{3}^{\intercal}\bm{\rho}\rfloor_{R}}{% \rho}\right)}=\arcsin{\left(\frac{\bm{e}_{3}^{\intercal}\text{T}_{I}^{R}\bm{% \rho}}{\rho}\right)},= roman_arcsin ( divide start_ARG bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ρ ⌋ start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT end_ARG start_ARG italic_ρ end_ARG ) = roman_arcsin ( divide start_ARG bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT bold_italic_ρ end_ARG start_ARG italic_ρ end_ARG ) ,
ρ˙˙𝜌\displaystyle\dot{\rho}over˙ start_ARG italic_ρ end_ARG =1ρ(𝒓𝑷R)(𝒗𝑽R)=𝝆𝒖ρ.absent1𝜌superscript𝒓subscript𝑷𝑅𝒗subscript𝑽𝑅superscript𝝆𝒖𝜌\displaystyle=\frac{1}{\rho}\left(\bm{r}-\bm{P}_{R}\right)^{\intercal}\left(% \bm{v}-\bm{V}_{R}\right)=\frac{\bm{\rho}^{\intercal}\bm{u}}{\rho}.= divide start_ARG 1 end_ARG start_ARG italic_ρ end_ARG ( bold_italic_r - bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT ) start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ( bold_italic_v - bold_italic_V start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT ) = divide start_ARG bold_italic_ρ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_u end_ARG start_ARG italic_ρ end_ARG .

The computation of h/𝒚^0(𝒚^0(i),tm)=h/𝒚(𝒚^m(i),tm)𝒫/𝒚^0(𝒚^0(i),Δtm)\partial h/\partial\hat{\bm{y}}_{0}\rfloor_{(\hat{\bm{y}}_{0}^{(i)},t_{m})}=% \partial h/\partial{\bm{y}}\rfloor_{(\hat{\bm{y}}_{m}^{(i)},t_{m})}\partial{% \mathcal{P}}/\partial\hat{\bm{y}}_{0}\rfloor_{(\hat{\bm{y}}_{0}^{(i)},\Delta t% _{m})}∂ italic_h / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT = ∂ italic_h / ∂ bold_italic_y ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT ∂ caligraphic_P / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ⌋ start_POSTSUBSCRIPT ( over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) end_POSTSUBSCRIPT is divided in two parts. For one, the observation function derivatives, denoted as h/𝒚𝒚\partial h/\partial\bm{y}∂ italic_h / ∂ bold_italic_y, are detailed in the A.1 for the radar observables. The predicted full state derivatives (𝒫/𝒚^0𝒫subscript^𝒚0\partial{\mathcal{P}}/\partial\hat{\bm{y}}_{0}∂ caligraphic_P / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT) are also required. The position part is present already in Section 2.3, see Equation (5). Nevertheless, the GTDS method approximates these derivatives by neglecting the Kepler function derivatives contribution, a simplification no longer valid for the fitting of radar observables. The predicted measurements are now a much more non-linear function of the estimation, so in order to improve convergence the approximation of GTDS is not used. Furthermore, the predicted velocity derivatives are also required, see Equation (11). In conclusion, the present method requires the computation of all the Kepler function derivatives, or a better approximation, and the rest of the section delves on this.

𝒗^𝒓^0(i)=f˙(i)𝒓^0𝒓^0+𝒓^0(i)f˙𝒓^0(i)+𝒗^0(i)g˙𝒓^0(i),𝒗^𝒗^0(i)=g˙(i)𝒗^0𝒗^0+𝒓^0(i)f˙𝒗^0(i)+𝒗^0(i)g˙𝒗^0(i).\begin{split}\frac{\partial\hat{\bm{v}}}{\partial\hat{\bm{r}}_{0}}\biggr{% \rfloor}^{(i)}&=\dot{f}^{(i)}\frac{\partial\hat{\bm{r}}_{0}}{\partial\hat{\bm{% r}}_{0}}+\hat{\bm{r}}_{0}^{(i)}\frac{\partial\dot{f}}{\partial\hat{\bm{r}}_{0}% }\biggr{\rfloor}^{(i)}+\hat{\bm{v}}_{0}^{(i)}\frac{\partial\dot{g}}{\partial% \hat{\bm{r}}_{0}}\biggr{\rfloor}^{(i)},\\ \frac{\partial\hat{\bm{v}}}{\partial\hat{\bm{v}}_{0}}\biggr{\rfloor}^{(i)}&=% \dot{g}^{(i)}\frac{\partial\hat{\bm{v}}_{0}}{\partial\hat{\bm{v}}_{0}}+\hat{% \bm{r}}_{0}^{(i)}\frac{\partial\dot{f}}{\partial\hat{\bm{v}}_{0}}\biggr{% \rfloor}^{(i)}+\hat{\bm{v}}_{0}^{(i)}\frac{\partial\dot{g}}{\partial\hat{\bm{v% }}_{0}}\biggr{\rfloor}^{(i)}.\end{split}start_ROW start_CELL divide start_ARG ∂ over^ start_ARG bold_italic_v end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT end_CELL start_CELL = over˙ start_ARG italic_f end_ARG start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG + over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over˙ start_ARG italic_f end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over˙ start_ARG italic_g end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT , end_CELL end_ROW start_ROW start_CELL divide start_ARG ∂ over^ start_ARG bold_italic_v end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT end_CELL start_CELL = over˙ start_ARG italic_g end_ARG start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG + over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over˙ start_ARG italic_f end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT + over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT divide start_ARG ∂ over˙ start_ARG italic_g end_ARG end_ARG start_ARG ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ⌋ start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT . end_CELL end_ROW (11)

An analytical approximation for the derivatives of f𝑓fitalic_f, g𝑔gitalic_g, f˙˙𝑓\dot{f}over˙ start_ARG italic_f end_ARG and g˙˙𝑔\dot{g}over˙ start_ARG italic_g end_ARG has been developed for this work that applies a Taylor expansion around the values 𝒓^0subscript^𝒓0\hat{\bm{r}}_{0}over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT and 𝒗^0subscript^𝒗0\hat{\bm{v}}_{0}over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT at the reference epoch, see Equation (12). The notation used for partial derivatives here is a slight modification of Newton's notation, where s/t=s˙=s(1)𝑠𝑡˙𝑠1𝑠\partial s/\partial t=\dot{s}=\overset{\scriptscriptstyle(1)}{s}∂ italic_s / ∂ italic_t = over˙ start_ARG italic_s end_ARG = start_OVERACCENT ( 1 ) end_OVERACCENT start_ARG italic_s end_ARG. This is a deliberate choice that allows for a compact expression of a high order time derivative differentiated with respect to another variable x𝑥xitalic_x. See the A.5 for a justification and example of use.

𝒓^(𝒓^0,𝒗^0,Δt)=𝒓^0+𝒗^0Δt+𝒓^¨(𝒓^0,𝒗^0)Δt22!+𝒓^˙˙˙(𝒓^0,𝒗^0)Δt33!+𝒓^(4)(𝒓^0,𝒗^0)Δt44!+𝒗^(𝒓^0,𝒗^0,Δt)=𝒗^0+𝒓^¨(𝒓^0,𝒗^0)Δt+𝒓^˙˙˙(𝒓^0,𝒗^0)Δt22!+𝒓^(4)(𝒓^0,𝒗^0)Δt33!+^𝒓subscript^𝒓0subscript^𝒗0Δ𝑡subscript^𝒓0subscript^𝒗0Δ𝑡¨^𝒓subscript^𝒓0subscript^𝒗0Δsuperscript𝑡22˙˙˙^𝒓subscript^𝒓0subscript^𝒗0Δsuperscript𝑡334^𝒓subscript^𝒓0subscript^𝒗0Δsuperscript𝑡44^𝒗subscript^𝒓0subscript^𝒗0Δ𝑡subscript^𝒗0¨^𝒓subscript^𝒓0subscript^𝒗0Δ𝑡˙˙˙^𝒓subscript^𝒓0subscript^𝒗0Δsuperscript𝑡224^𝒓subscript^𝒓0subscript^𝒗0Δsuperscript𝑡33\begin{split}\hat{\bm{r}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0},\Delta t)&=\hat{% \bm{r}}_{0}+\hat{\bm{v}}_{0}\Delta t+\ddot{\hat{\bm{r}}}(\hat{\bm{r}}_{0},\hat% {\bm{v}}_{0})\frac{\Delta t^{2}}{2!}+\dddot{\hat{\bm{r}}}(\hat{\bm{r}}_{0},% \hat{\bm{v}}_{0})\frac{\Delta t^{3}}{3!}+\overset{\scriptscriptstyle(4)}{\hat{% \bm{r}}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\frac{\Delta t^{4}}{4!}+\cdots\\ \hat{\bm{v}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0},\Delta t)&=\hat{\bm{v}}_{0}+% \ddot{\hat{\bm{r}}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\Delta t+\dddot{\hat{\bm% {r}}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\frac{\Delta t^{2}}{2!}+\overset{% \scriptscriptstyle(4)}{\hat{\bm{r}}}(\hat{\bm{r}}_{0},\hat{\bm{v}}_{0})\frac{% \Delta t^{3}}{3!}+\cdots\end{split}start_ROW start_CELL over^ start_ARG bold_italic_r end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t ) end_CELL start_CELL = over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT + over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT roman_Δ italic_t + over¨ start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) divide start_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 ! end_ARG + over˙˙˙ start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) divide start_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG start_ARG 3 ! end_ARG + start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) divide start_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG start_ARG 4 ! end_ARG + ⋯ end_CELL end_ROW start_ROW start_CELL over^ start_ARG bold_italic_v end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t ) end_CELL start_CELL = over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT + over¨ start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) roman_Δ italic_t + over˙˙˙ start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) divide start_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 ! end_ARG + start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG ( over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT ) divide start_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG start_ARG 3 ! end_ARG + ⋯ end_CELL end_ROW (12)

Obtaining the Kepler functions is a matter of formulating the expansion in Equation (12) as a linear combination of 𝒓^0subscript^𝒓0\hat{\bm{r}}_{0}over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT and 𝒗^0subscript^𝒗0\hat{\bm{v}}_{0}over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, as the multiplying coefficients are the Kepler functions by definition. For this purpose, the derivatives 𝒓^(k)𝑘^𝒓\overset{\scriptscriptstyle(k)}{\hat{\bm{r}}}start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG of the series can be obtained from the equations of motion 𝒓¨=μ𝒓/r3=u𝒓¨𝒓𝜇𝒓superscript𝑟3𝑢𝒓\ddot{\bm{r}}=-\mu\bm{r}/r^{3}=-u\bm{r}over¨ start_ARG bold_italic_r end_ARG = - italic_μ bold_italic_r / italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT = - italic_u bold_italic_r, expressed as a linear combination of 𝒓𝒓\bm{r}bold_italic_r and 𝒗=𝒓˙𝒗˙𝒓\bm{v}=\dot{\bm{r}}bold_italic_v = over˙ start_ARG bold_italic_r end_ARG evaluated at the reference epoch, as outlined in Equation (13).

𝒓^¨0subscript¨^𝒓0\displaystyle\ddot{\hat{\bm{r}}}_{0}over¨ start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT =μr3𝒓=u𝒓^0,absent𝜇superscript𝑟3𝒓𝑢subscript^𝒓0\displaystyle=\frac{-\mu}{r^{3}}\bm{r}=-u\hat{\bm{r}}_{0},= divide start_ARG - italic_μ end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG bold_italic_r = - italic_u over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , 𝒓^0subscript^𝒓0\displaystyle\overset{\dots}{\hat{\bm{r}}}_{0}over… start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT =u˙𝒓^0u𝒗^0,absent˙𝑢subscript^𝒓0𝑢subscript^𝒗0\displaystyle=-\dot{u}\hat{\bm{r}}_{0}-u\hat{\bm{v}}_{0},= - over˙ start_ARG italic_u end_ARG over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT - italic_u over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , 𝒓^(4)0subscript4^𝒓0\displaystyle\overset{\scriptscriptstyle(4)}{\hat{\bm{r}}}_{0}start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG over^ start_ARG bold_italic_r end_ARG end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT =u¨𝒓^0+(u22u˙)𝒗^0.absent¨𝑢subscript^𝒓0superscript𝑢22˙𝑢subscript^𝒗0\displaystyle=-\ddot{u}\hat{\bm{r}}_{0}+(u^{2}-2\dot{u})\hat{\bm{v}}_{0}.= - over¨ start_ARG italic_u end_ARG over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT + ( italic_u start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 2 over˙ start_ARG italic_u end_ARG ) over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT . (13)

The value of u𝑢uitalic_u and its time derivatives are a function of the scalar r=(𝒓𝒓)1/2𝑟superscriptsuperscript𝒓𝒓12r=(\bm{r}^{\intercal}\bm{r})^{1/2}italic_r = ( bold_italic_r start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_r ) start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT and its derivatives, see Equation (2.4).

u𝑢\displaystyle uitalic_u =μr3,absent𝜇superscript𝑟3\displaystyle=\frac{\mu}{r^{3}},= divide start_ARG italic_μ end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG , r𝑟\displaystyle ritalic_r =(𝒓𝒓)1/2,absentsuperscriptsuperscript𝒓𝒓12\displaystyle=(\bm{r}^{\intercal}\bm{r})^{1/2},= ( bold_italic_r start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_r ) start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT ,
u˙˙𝑢\displaystyle\dot{u}over˙ start_ARG italic_u end_ARG =3ur˙r,absent3𝑢˙𝑟𝑟\displaystyle=-3u\frac{\dot{r}}{r},= - 3 italic_u divide start_ARG over˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_r end_ARG , r˙˙𝑟\displaystyle\dot{r}over˙ start_ARG italic_r end_ARG =𝒓𝒗r,absentsuperscript𝒓𝒗𝑟\displaystyle=\frac{\bm{r}^{\intercal}\bm{v}}{r},= divide start_ARG bold_italic_r start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_v end_ARG start_ARG italic_r end_ARG , (14)
u¨¨𝑢\displaystyle\ddot{u}over¨ start_ARG italic_u end_ARG =3[u˙r˙r+u(r¨rr˙2r2)],absent3delimited-[]˙𝑢˙𝑟𝑟𝑢¨𝑟𝑟superscript˙𝑟2superscript𝑟2\displaystyle=-3\left[\dot{u}\frac{\dot{r}}{r}+u\left(\frac{\ddot{r}}{r}-\frac% {\dot{r}^{2}}{r^{2}}\right)\right],= - 3 [ over˙ start_ARG italic_u end_ARG divide start_ARG over˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_r end_ARG + italic_u ( divide start_ARG over¨ start_ARG italic_r end_ARG end_ARG start_ARG italic_r end_ARG - divide start_ARG over˙ start_ARG italic_r end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) ] , r¨¨𝑟\displaystyle\ddot{r}over¨ start_ARG italic_r end_ARG =v2ur2r˙2r.absentsuperscript𝑣2𝑢superscript𝑟2superscript˙𝑟2𝑟\displaystyle=\frac{v^{2}-ur^{2}-\dot{r}^{2}}{r}.= divide start_ARG italic_v start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_u italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - over˙ start_ARG italic_r end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_r end_ARG .

Finally, by introducing the elements of Equation (13) into Equation (12) it is straightforward to obtain the solution as a linear combination of the initial conditions, which allows to extract the Taylor expansions of f𝑓fitalic_f, g𝑔gitalic_g, f˙˙𝑓\dot{f}over˙ start_ARG italic_f end_ARG and g˙˙𝑔\dot{g}over˙ start_ARG italic_g end_ARG, see Equation 15.

f=𝑓absent\displaystyle f=italic_f = 1u2Δt2u˙6Δt3u¨u224Δt4+1𝑢2Δsuperscript𝑡2˙𝑢6Δsuperscript𝑡3¨𝑢superscript𝑢224Δsuperscript𝑡4\displaystyle 1-\frac{u}{2}\Delta t^{2}-\frac{\dot{u}}{6}\Delta t^{3}-\frac{% \ddot{u}-u^{2}}{24}\Delta t^{4}+\cdots1 - divide start_ARG italic_u end_ARG start_ARG 2 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - divide start_ARG over˙ start_ARG italic_u end_ARG end_ARG start_ARG 6 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT - divide start_ARG over¨ start_ARG italic_u end_ARG - italic_u start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 24 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT + ⋯ (15)
g=𝑔absent\displaystyle g=italic_g = Δtu6Δt3u˙12Δt4+Δ𝑡𝑢6Δsuperscript𝑡3˙𝑢12Δsuperscript𝑡4\displaystyle\Delta t-\frac{u}{6}\Delta t^{3}-\frac{\dot{u}}{12}\Delta t^{4}+\cdotsroman_Δ italic_t - divide start_ARG italic_u end_ARG start_ARG 6 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT - divide start_ARG over˙ start_ARG italic_u end_ARG end_ARG start_ARG 12 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT + ⋯
f˙=˙𝑓absent\displaystyle\dot{f}=over˙ start_ARG italic_f end_ARG = uΔtu˙2Δt2+u2u¨6Δt3+𝑢Δ𝑡˙𝑢2Δsuperscript𝑡2superscript𝑢2¨𝑢6Δsuperscript𝑡3\displaystyle-u\Delta t-\frac{\dot{u}}{2}\Delta t^{2}+\frac{u^{2}-\ddot{u}}{6}% \Delta t^{3}+\cdots- italic_u roman_Δ italic_t - divide start_ARG over˙ start_ARG italic_u end_ARG end_ARG start_ARG 2 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + divide start_ARG italic_u start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - over¨ start_ARG italic_u end_ARG end_ARG start_ARG 6 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT + ⋯
g˙=˙𝑔absent\displaystyle\dot{g}=over˙ start_ARG italic_g end_ARG = 1u2Δt2u˙3Δt3+1𝑢2Δsuperscript𝑡2˙𝑢3Δsuperscript𝑡3\displaystyle 1-\frac{u}{2}\Delta t^{2}-\frac{\dot{u}}{3}\Delta t^{3}+\cdots1 - divide start_ARG italic_u end_ARG start_ARG 2 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - divide start_ARG over˙ start_ARG italic_u end_ARG end_ARG start_ARG 3 end_ARG roman_Δ italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT + ⋯

However, these analytical approximations of the Kepler functions are employed exclusively to compute the derivatives required in eqs. 5 and 11. The detailed expressions have been omitted to avoid an excessive extension, but these are straightforward to derive from Eq. (2.4). Thus, the element 𝒫/𝒚^0=[𝒓^/𝒓^0𝒓^/𝒗^0𝒗^/𝒓^0𝒗^/𝒗^0]𝒫subscript^𝒚0delimited-[]^𝒓subscript^𝒓0^𝒓subscript^𝒗0^𝒗subscript^𝒓0^𝒗subscript^𝒗0\partial\mathcal{P}/\partial\hat{\bm{y}}_{0}=\left[\begin{smallmatrix}\partial% \hat{\bm{r}}/\partial\hat{\bm{r}}_{0}&\partial\hat{\bm{r}}/\partial\hat{\bm{v}% }_{0}\\ \partial\hat{\bm{v}}/\partial\hat{\bm{r}}_{0}&\partial\hat{\bm{v}}/\partial% \hat{\bm{v}}_{0}\end{smallmatrix}\right]∂ caligraphic_P / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT = [ start_ROW start_CELL ∂ over^ start_ARG bold_italic_r end_ARG / ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL start_CELL ∂ over^ start_ARG bold_italic_r end_ARG / ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL ∂ over^ start_ARG bold_italic_v end_ARG / ∂ over^ start_ARG bold_italic_r end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL start_CELL ∂ over^ start_ARG bold_italic_v end_ARG / ∂ over^ start_ARG bold_italic_v end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_CELL end_ROW ] in Equation (2) can be computed at each ΔtmΔsubscript𝑡𝑚\Delta t_{m}roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT with the necessary degree of approximation.

Now that the derivatives of the predicted measurement h/𝒚^0subscript^𝒚0\partial h/\partial\hat{\bm{y}}_{0}∂ italic_h / ∂ over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT can be computed, all the elements to solve the linear least-squares problem in Equation (3) are available. In particular, the errors in Δ𝒛(i)Δsuperscript𝒛𝑖\Delta\bm{z}^{(i)}roman_Δ bold_italic_z start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT are computed directly with the propagated estimates of the last iteration 𝒚^m(i)superscriptsubscript^𝒚𝑚𝑖\hat{\bm{y}}_{m}^{(i)}over^ start_ARG bold_italic_y end_ARG start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ( italic_i ) end_POSTSUPERSCRIPT, using Eq. (4), evaluated in the observation function in Eq. (10). This is the second analytical method that is used for comparison in the results.

2.5 J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT fitting of radar observables

Finally, a third algorithm considering the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation has been developed. Several analytical methods exist for propagation that include the perturbation of an oblate planet, see [22], always at the cost of losing precision, in the form of mean orbital elements and with validity only for a small range of eccentricities. For the purpose of this work an exact solution is considered, even if valid only for a short time span. The approach employs the generalized equinoctial orbital elements described in [4], henceforth GEqOE.

2.5.1 GEqOE formulation

Given a perturbation force derivable from a potential energy 𝒰𝒰\mathscr{U}script_U, the GEqOE have the perturbing potential embedded in their definition, thus generalizing the classical equinoctial elements [5]. The formulation produces the generalized semi-major axis (a𝑎aitalic_a) and Laplace vector (μ𝒈𝜇𝒈\mu\bm{g}italic_μ bold_italic_g) that define a non-osculating ellipse in the orbital plane. Projecting 𝒈𝒈\bm{g}bold_italic_g along the in-plane axes define the elements p1subscript𝑝1p_{1}italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT and p2subscript𝑝2p_{2}italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT (generalized versions of the hhitalic_h and k𝑘kitalic_k equinoctial elements). Kepler's equation is written as a function of the generalized mean longitude \mathcal{L}caligraphic_L. The generalized mean motion ν𝜈\nuitalic_ν is derived from the total energy, which includes 𝒰𝒰\mathscr{U}script_U. Finally, the elements q1subscript𝑞1q_{1}italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT and q2subscript𝑞2q_{2}italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT (analogous to the classical p𝑝pitalic_p and q𝑞qitalic_q) complete the set of six GEqOE 𝝌=[ν,p1,p2,q1,q2,]𝝌𝜈subscript𝑝1subscript𝑝2subscript𝑞1subscript𝑞2\bm{\chi}=\left[\nu,p_{1},p_{2},q_{1},q_{2},\mathcal{L}\right]bold_italic_χ = [ italic_ν , italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , caligraphic_L ]. The first order time derivatives of these elements are given as an explicit function of the perturbing potential 𝒰𝒰\mathscr{U}script_U and the dissipative force 𝑷𝑷\bm{P}bold_italic_P. The general formulation is leveraged here to derive a Taylor expansion of the solution in a simplified case of these perturbations.

Equation 16 provides a specific instance of the GEqOE time derivatives with just the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT component of the potential perturbation 𝒰𝒰\mathscr{U}script_U. Notice that the evolution of the generalized mean motion ν𝜈\nuitalic_ν is reduced to a constant value, which comes from particularizing 𝒰𝒰\mathscr{U}script_U to an stationary field in an inertial frame666This is a simplification compatible with the inclusion of zonal harmonics only, where the gravitational potential has axial symmetry., and having no dissipating forces. The inclusion of drag is left out of the proposed algorithm due to the short propagation time spans of the present application.

ν˙=0,p˙1=p2(hcr2Iz^)1c(Xa+2p2)𝒰,p˙2=p1(Iz^hcr2)+1c(Ya+2p1)𝒰,q˙1=IYr,q˙2=IXr,˙=ν+hcr2Iz^1c[1α+α(1ra)]𝒰.formulae-sequence˙𝜈0formulae-sequencesubscript˙𝑝1subscript𝑝2𝑐superscript𝑟2𝐼^𝑧1𝑐𝑋𝑎2subscript𝑝2𝒰formulae-sequencesubscript˙𝑝2subscript𝑝1𝐼^𝑧𝑐superscript𝑟21𝑐𝑌𝑎2subscript𝑝1𝒰formulae-sequencesubscript˙𝑞1𝐼𝑌𝑟formulae-sequencesubscript˙𝑞2𝐼𝑋𝑟˙𝜈𝑐superscript𝑟2𝐼^𝑧1𝑐delimited-[]1𝛼𝛼1𝑟𝑎𝒰\begin{split}\dot{\nu}&=0,\\ \dot{p}_{1}&=p_{2}\left(\frac{h-c}{r^{2}}-I\hat{z}\right)-\frac{1}{c}\left(% \frac{X}{a}+2p_{2}\right)\mathscr{U},\\ \dot{p}_{2}&=p_{1}\left(I\hat{z}-\frac{h-c}{r^{2}}\right)+\frac{1}{c}\left(% \frac{Y}{a}+2p_{1}\right)\mathscr{U},\\ \dot{q}_{1}&=-I\frac{Y}{r},\\ \dot{q}_{2}&=-I\frac{X}{r},\\ \dot{\mathcal{L}}&=\nu+\frac{h-c}{r^{2}}-I\hat{z}-\frac{1}{c}\left[\frac{1}{% \alpha}+\alpha\left(1-\frac{r}{a}\right)\right]\mathscr{U}.\\ \end{split}start_ROW start_CELL over˙ start_ARG italic_ν end_ARG end_CELL start_CELL = 0 , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL = italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( divide start_ARG italic_h - italic_c end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG - italic_I over^ start_ARG italic_z end_ARG ) - divide start_ARG 1 end_ARG start_ARG italic_c end_ARG ( divide start_ARG italic_X end_ARG start_ARG italic_a end_ARG + 2 italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) script_U , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT end_CELL start_CELL = italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( italic_I over^ start_ARG italic_z end_ARG - divide start_ARG italic_h - italic_c end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) + divide start_ARG 1 end_ARG start_ARG italic_c end_ARG ( divide start_ARG italic_Y end_ARG start_ARG italic_a end_ARG + 2 italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) script_U , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL = - italic_I divide start_ARG italic_Y end_ARG start_ARG italic_r end_ARG , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT end_CELL start_CELL = - italic_I divide start_ARG italic_X end_ARG start_ARG italic_r end_ARG , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG caligraphic_L end_ARG end_CELL start_CELL = italic_ν + divide start_ARG italic_h - italic_c end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG - italic_I over^ start_ARG italic_z end_ARG - divide start_ARG 1 end_ARG start_ARG italic_c end_ARG [ divide start_ARG 1 end_ARG start_ARG italic_α end_ARG + italic_α ( 1 - divide start_ARG italic_r end_ARG start_ARG italic_a end_ARG ) ] script_U . end_CELL end_ROW (16)

Equation (17) includes some needed definitions throughout the this section, and Algorithms (1-2) in the A.6 provide the conversion of inertial position and velocity to (and from) the set of GEqOE.

𝒰𝒰\displaystyle\mathscr{U}script_U =Ar3(13z^2),absent𝐴superscript𝑟313superscript^𝑧2\displaystyle=-\frac{A}{r^{3}}(1-3\hat{z}^{2}),= - divide start_ARG italic_A end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG ( 1 - 3 over^ start_ARG italic_z end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) , A𝐴\displaystyle Aitalic_A =μJ2R22,absent𝜇subscript𝐽2superscriptsubscript𝑅direct-sum22\displaystyle=\frac{\mu J_{2}R_{\oplus}^{2}}{2},= divide start_ARG italic_μ italic_J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_R start_POSTSUBSCRIPT ⊕ end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 end_ARG , (17)
z^^𝑧\displaystyle\hat{z}over^ start_ARG italic_z end_ARG =zr=2(Yq2Xq1)r(1+q12+q22),absent𝑧𝑟2𝑌subscript𝑞2𝑋subscript𝑞1𝑟1superscriptsubscript𝑞12superscriptsubscript𝑞22\displaystyle=\frac{z}{r}=\frac{2\left(Yq_{2}-Xq_{1}\right)}{r(1+q_{1}^{2}+q_{% 2}^{2})},= divide start_ARG italic_z end_ARG start_ARG italic_r end_ARG = divide start_ARG 2 ( italic_Y italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - italic_X italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) end_ARG start_ARG italic_r ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG , I𝐼\displaystyle Iitalic_I =3Ahr3z^(1q12q22),absent3𝐴superscript𝑟3^𝑧1superscriptsubscript𝑞12superscriptsubscript𝑞22\displaystyle=\frac{3A}{hr^{3}}\hat{z}(1-q_{1}^{2}-q_{2}^{2}),= divide start_ARG 3 italic_A end_ARG start_ARG italic_h italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG over^ start_ARG italic_z end_ARG ( 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) ,
h\displaystyle hitalic_h =c22r2𝒰,absentsuperscript𝑐22superscript𝑟2𝒰\displaystyle=\sqrt{c^{2}-2r^{2}\mathscr{U}},= square-root start_ARG italic_c start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 2 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT script_U end_ARG , c𝑐\displaystyle citalic_c =(μ2ν)1/31p12p22.absentsuperscriptsuperscript𝜇2𝜈131superscriptsubscript𝑝12superscriptsubscript𝑝22\displaystyle=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\sqrt{1-p_{1}^{2}-p_{2}^{2% }}.= ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT square-root start_ARG 1 - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG .

The numerical integration of the ordinary differential equation (ODE) system in Eq. (16) requires the computation of the X𝑋Xitalic_X and Y𝑌Yitalic_Y values. Given the initial values of the GEqOE the first step is to solve the generalized Kepler's Equation (18).

=𝒦+p1cos𝒦p2sin𝒦.𝒦subscript𝑝1𝒦subscript𝑝2𝒦\mathcal{L}=\mathcal{K}+p_{1}\cos{\mathcal{K}}-p_{2}\sin{\mathcal{K}}.caligraphic_L = caligraphic_K + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_cos caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin caligraphic_K . (18)

The output 𝒦𝒦\mathcal{K}caligraphic_K is then used to compute r𝑟ritalic_r, X𝑋Xitalic_X and Y𝑌Yitalic_Y from Eq. (19), where a=(μ/ν2)1/3𝑎superscript𝜇superscript𝜈213a=\left(\mu/\nu^{2}\right)^{1/3}italic_a = ( italic_μ / italic_ν start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT and α=1/1p12p22𝛼11superscriptsubscript𝑝12superscriptsubscript𝑝22\alpha=1/\sqrt{1-p_{1}^{2}-p_{2}^{2}}italic_α = 1 / square-root start_ARG 1 - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG. These are the steps needed to numerically solve the GEqOE dynamics. Instead, the goal of this section is to derive an analytical solution that can be evaluated once to obtain the propagated states and derivatives for the fitting problem in Eq. (3).

r=a(1p1sin𝒦p2cos𝒦,)X=a[αp1p2sin𝒦+(1αp12)cos𝒦p2],Y=a[αp1p2cos𝒦+(1αp22)sin𝒦p1].\begin{split}r=&a\left(1-p_{1}\sin{\mathcal{K}}-p_{2}\cos{\mathcal{K}},\right)% \\ X=&a\left[\alpha p_{1}p_{2}\sin{\mathcal{K}}+(1-\alpha p_{1}^{2})\cos{\mathcal% {K}}-p_{2}\right],\\ Y=&a\left[\alpha p_{1}p_{2}\cos{\mathcal{K}}+(1-\alpha p_{2}^{2})\sin{\mathcal% {K}}-p_{1}\right].\\ \end{split}start_ROW start_CELL italic_r = end_CELL start_CELL italic_a ( 1 - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_sin caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_cos caligraphic_K , ) end_CELL end_ROW start_ROW start_CELL italic_X = end_CELL start_CELL italic_a [ italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin caligraphic_K + ( 1 - italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) roman_cos caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ] , end_CELL end_ROW start_ROW start_CELL italic_Y = end_CELL start_CELL italic_a [ italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_cos caligraphic_K + ( 1 - italic_α italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) roman_sin caligraphic_K - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ] . end_CELL end_ROW (19)

In [4] the authors report the natural slower evolution of the GEqOE, which results in a much reduced numerical integration error when compared with other orbital elements representation. Applying a Taylor expansion in this particular state representation is thus much preferred to the alternatives. Differentiation with respect the initial GEqOE values 𝝌0subscript𝝌0\bm{\chi}_{0}bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT can then be applied to obtain the matrix of derivatives 𝝌𝝌0𝝌subscript𝝌0\frac{\partial\bm{\chi}}{\partial\bm{\chi}_{0}}divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG. The methodology employed to achieve this is explained next.

2.5.2 Taylor expansion in GEqOE

A special notation is be used from now on in order to allow for a systematic differentiation of the ODEs in Eq. (16). For one, the function 𝒻s=1/ssubscript𝒻𝑠1𝑠\mathscr{f}_{s}=1/sscript_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 1 / italic_s is defined as the inverse of the scalar s𝑠sitalic_s. This is useful, as there are many parts of the equations of motion that involve division, and it is most convenient in order to apply the chain rule with the multiplying element 𝒻ssubscript𝒻𝑠\mathscr{f}_{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT instead. For example, see Equation (20) for the time derivative of r𝑟ritalic_r expressed with the true longitude L𝐿Litalic_L [4], and rewrite it as r˙=μ𝒻crpl˙𝑟𝜇subscript𝒻𝑐subscript𝑟𝑝𝑙\dot{r}=\mu\mathscr{f}_{c}r_{pl}over˙ start_ARG italic_r end_ARG = italic_μ script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT.

r˙=μc(p2sinLp1cosL).˙𝑟𝜇𝑐subscript𝑝2𝐿subscript𝑝1𝐿\dot{r}=\frac{\mu}{c}\left(p_{2}\sin{L}-p_{1}\cos{L}\right).over˙ start_ARG italic_r end_ARG = divide start_ARG italic_μ end_ARG start_ARG italic_c end_ARG ( italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin italic_L - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_cos italic_L ) . (20)

Now the time derivative r¨¨𝑟\ddot{r}over¨ start_ARG italic_r end_ARG can be put down as r¨=μ(𝒻˙crpl+𝒻cr˙pl)¨𝑟𝜇subscript˙𝒻𝑐subscript𝑟𝑝𝑙subscript𝒻𝑐subscript˙𝑟𝑝𝑙\ddot{r}=\mu\left(\dot{\mathscr{f}}_{c}r_{pl}+\mathscr{f}_{c}\dot{r}_{pl}\right)over¨ start_ARG italic_r end_ARG = italic_μ ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT ). It is only a matter of having the elements needed in order to compute 𝒻˙s=s˙/s2subscript˙𝒻𝑠˙𝑠superscript𝑠2\dot{\mathscr{f}}_{s}=-\dot{s}/s^{2}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = - over˙ start_ARG italic_s end_ARG / italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT, the derivative of s𝑠sitalic_s itself. Thus, a function that computes time derivatives of 𝒻ssubscript𝒻𝑠\mathscr{f}_{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT has been implemented which takes as input the vector [s,s˙,s¨,]𝑠˙𝑠¨𝑠\left[s,\dot{s},\ddot{s},\cdots\right][ italic_s , over˙ start_ARG italic_s end_ARG , over¨ start_ARG italic_s end_ARG , ⋯ ] and computes the derivative up to the desired order, see the A.2 for the detailed expressions.

cosL=Xr,sinL=Yr,X˙=r˙cosLhrsinL,Y˙=r˙sinL+hrcosL.formulae-sequence𝐿𝑋𝑟formulae-sequence𝐿𝑌𝑟formulae-sequence˙𝑋˙𝑟𝐿𝑟𝐿˙𝑌˙𝑟𝐿𝑟𝐿\begin{split}\cos{L}=&\frac{X}{r},\\ \sin{L}=&\frac{Y}{r},\\ \dot{X}=&\,\dot{r}\cos{L}-\frac{h}{r}\sin{L},\\ \dot{Y}=&\,\dot{r}\sin{L}+\frac{h}{r}\cos{L}.\end{split}start_ROW start_CELL roman_cos italic_L = end_CELL start_CELL divide start_ARG italic_X end_ARG start_ARG italic_r end_ARG , end_CELL end_ROW start_ROW start_CELL roman_sin italic_L = end_CELL start_CELL divide start_ARG italic_Y end_ARG start_ARG italic_r end_ARG , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_X end_ARG = end_CELL start_CELL over˙ start_ARG italic_r end_ARG roman_cos italic_L - divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_sin italic_L , end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_Y end_ARG = end_CELL start_CELL over˙ start_ARG italic_r end_ARG roman_sin italic_L + divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_cos italic_L . end_CELL end_ROW (21)

Another useful tool is the function s=ss˙subscript𝑠𝑠˙𝑠\mathscr{g}_{s}=s\dot{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = italic_s over˙ start_ARG italic_s end_ARG, which appears when a derivative of s2superscript𝑠2s^{2}italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT is performed. See the A.3 for the expressions of ssubscript𝑠\mathscr{g}_{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT time derivatives.

Computing the first order derivatives of the Taylor expansion reduces to evaluating the ODEs. For the next orders, the expressions in eqs. 20 and 21 become useful. The methodology is simplified further by applying an extra intermediate step. The differentiation of the ODEs in Eq. (16) is going to need in turn the derivatives of the elements in Eq. (17), and this becomes tedious when going beyond the second order Taylor expansion. The solution has been to split them in parts that are easy to derive and work with. See for example Eq. (22), where this has been done for the variable z^^𝑧\hat{z}over^ start_ARG italic_z end_ARG and its many components. The time derivative of 𝒻𝒟subscript𝒻𝒟\mathscr{f}_{\mathcal{D}}script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT is computed from 𝒟˙˙𝒟\dot{\mathcal{D}}over˙ start_ARG caligraphic_D end_ARG.

z^^𝑧\displaystyle\hat{z}over^ start_ARG italic_z end_ARG =2(Yq2Xq1)r(1+q12+q22)=𝒞𝒟=𝒞𝒻𝒟,absent2𝑌subscript𝑞2𝑋subscript𝑞1𝑟1superscriptsubscript𝑞12superscriptsubscript𝑞22𝒞𝒟𝒞subscript𝒻𝒟\displaystyle=\frac{2\left(Yq_{2}-Xq_{1}\right)}{r(1+q_{1}^{2}+q_{2}^{2})}=% \frac{\mathcal{C}}{\mathcal{D}}=\mathcal{C}\mathscr{f}_{\mathcal{D}},= divide start_ARG 2 ( italic_Y italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - italic_X italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) end_ARG start_ARG italic_r ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG = divide start_ARG caligraphic_C end_ARG start_ARG caligraphic_D end_ARG = caligraphic_C script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , z^˙˙^𝑧\displaystyle\dot{\hat{z}}over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG =𝒞˙𝒻𝒟+𝒞𝒻𝒟˙,absent˙𝒞subscript𝒻𝒟𝒞˙subscript𝒻𝒟\displaystyle=\dot{\mathcal{C}}\mathscr{f}_{\mathcal{D}}+\mathcal{C}\dot{% \mathscr{f}_{\mathcal{D}}},= over˙ start_ARG caligraphic_C end_ARG script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + caligraphic_C over˙ start_ARG script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT end_ARG , (22)
𝒞𝒞\displaystyle\mathcal{C}caligraphic_C =2(Yq2Xq1),absent2𝑌subscript𝑞2𝑋subscript𝑞1\displaystyle=2\left(Yq_{2}-Xq_{1}\right),= 2 ( italic_Y italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - italic_X italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) , 𝒞˙˙𝒞\displaystyle\dot{\mathcal{C}}over˙ start_ARG caligraphic_C end_ARG =2(Y˙q2+Yq˙2X˙q1Xq˙1),absent2˙𝑌subscript𝑞2𝑌subscript˙𝑞2˙𝑋subscript𝑞1𝑋subscript˙𝑞1\displaystyle=2\left(\dot{Y}q_{2}+Y\dot{q}_{2}-\dot{X}q_{1}-X\dot{q}_{1}\right),= 2 ( over˙ start_ARG italic_Y end_ARG italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_Y over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - over˙ start_ARG italic_X end_ARG italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - italic_X over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) ,
𝒟𝒟\displaystyle\mathcal{D}caligraphic_D =r(1+q12+q22)=rqs,absent𝑟1superscriptsubscript𝑞12superscriptsubscript𝑞22𝑟subscript𝑞𝑠\displaystyle=r(1+q_{1}^{2}+q_{2}^{2})=rq_{s},= italic_r ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) = italic_r italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT , 𝒟˙˙𝒟\displaystyle\dot{\mathcal{D}}over˙ start_ARG caligraphic_D end_ARG =r˙qs+rq˙s,absent˙𝑟subscript𝑞𝑠𝑟subscript˙𝑞𝑠\displaystyle=\dot{r}q_{s}+r\dot{q}_{s},= over˙ start_ARG italic_r end_ARG italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + italic_r over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT ,
qssubscript𝑞𝑠\displaystyle q_{s}italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =(1+q12+q22),absent1superscriptsubscript𝑞12superscriptsubscript𝑞22\displaystyle=(1+q_{1}^{2}+q_{2}^{2}),= ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) , q˙ssubscript˙𝑞𝑠\displaystyle\dot{q}_{s}over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(q1q˙1+q2q˙2).absent2subscript𝑞1subscript˙𝑞1subscript𝑞2subscript˙𝑞2\displaystyle=2\left(q_{1}\dot{q}_{1}+q_{2}\dot{q}_{2}\right).= 2 ( italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

With this in mind, the expressions of the equations of motion become those in Eq. (23), where 𝓈L=sinLsubscript𝓈𝐿𝐿\mathscr{s}_{L}=\sin{L}script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT = roman_sin italic_L, 𝒸L=cosLsubscript𝒸𝐿𝐿\mathscr{c}_{L}=\cos{L}script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT = roman_cos italic_L and Γ=𝒻α+α(1r/a)Γsubscript𝒻𝛼𝛼1𝑟𝑎\Gamma=\mathscr{f}_{\alpha}+\alpha\left(1-r/a\right)roman_Γ = script_f start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT + italic_α ( 1 - italic_r / italic_a ). The full derivation up to fourth order and all the symbols definitions can be found in the A.4.

ν˙˙𝜈\displaystyle\dot{\nu}over˙ start_ARG italic_ν end_ARG =0,absent0\displaystyle=0,= 0 , p˙1subscript˙𝑝1\displaystyle\dot{p}_{1}over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =p2(𝒹wh)𝒻cξ1𝒰,absentsubscript𝑝2𝒹subscript𝑤subscript𝒻𝑐subscript𝜉1𝒰\displaystyle=p_{2}\left(\mathscr{d}-w_{h}\right)-\mathscr{f}_{c}\xi_{1}% \mathscr{U},= italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( script_d - italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT script_U , p˙2subscript˙𝑝2\displaystyle\dot{p}_{2}over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =p1(wh𝒹)+𝒻cξ2𝒰,absentsubscript𝑝1subscript𝑤𝒹subscript𝒻𝑐subscript𝜉2𝒰\displaystyle=p_{1}\left(w_{h}-\mathscr{d}\right)+\mathscr{f}_{c}\xi_{2}% \mathscr{U},= italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - script_d ) + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT script_U , (23)
q˙1subscript˙𝑞1\displaystyle\dot{q}_{1}over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =I𝓈L,absent𝐼subscript𝓈𝐿\displaystyle=-I\mathscr{s}_{L},= - italic_I script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , q˙2subscript˙𝑞2\displaystyle\dot{q}_{2}over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =I𝒸L,absent𝐼subscript𝒸𝐿\displaystyle=-I\mathscr{c}_{L},= - italic_I script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , ˙˙\displaystyle\dot{\mathcal{L}}over˙ start_ARG caligraphic_L end_ARG =ν+𝒹wh𝒻cΓ𝒰.absent𝜈𝒹subscript𝑤subscript𝒻𝑐Γ𝒰\displaystyle=\nu+\mathscr{d}-w_{h}-\mathscr{f}_{c}\Gamma\mathscr{U}.= italic_ν + script_d - italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ script_U .

Once all the derivatives have been computed at the epoch (middle of the track), a Taylor expansion can be used to propagate to all ΔtmΔsubscript𝑡𝑚\Delta t_{m}roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT with a simple polynomial evaluation. The result for each evaluation is the state vector 𝝌(𝝌0,Δtm)=[ν,p1,p2,q1,q2,]𝝌subscript𝝌0Δsubscript𝑡𝑚superscript𝜈subscript𝑝1subscript𝑝2subscript𝑞1subscript𝑞2\bm{\chi}\left(\bm{\chi}_{0},\Delta t_{m}\right)=\left[\nu,p_{1},p_{2},q_{1},q% _{2},\mathcal{L}\right]^{\intercal}bold_italic_χ ( bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) = [ italic_ν , italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , caligraphic_L ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT, which can then be converted to Cartesian using the inverse transformation in Algorithm 2.

The next step is to perform the analytical derivative of 𝝌(𝝌0,Δtm)𝝌subscript𝝌0Δsubscript𝑡𝑚\bm{\chi}\left(\bm{\chi}_{0},\Delta t_{m}\right)bold_italic_χ ( bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT , roman_Δ italic_t start_POSTSUBSCRIPT italic_m end_POSTSUBSCRIPT ) with respect to 𝝌0subscript𝝌0\bm{\chi}_{0}bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, so that 𝝌𝝌0𝝌subscript𝝌0\frac{\partial\bm{\chi}}{\partial\bm{\chi}_{0}}divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG can be obtained. This is not a trivial task, as the expressions of the coefficients of the expansion, see the A.4, are extensive. Furthermore, many contain the 𝒻ssubscript𝒻𝑠\mathscr{f}_{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT and ssubscript𝑠\mathscr{g}_{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT functions (and its time derivatives), which need to be differentiated with respect to a generic orbital element, and the A.5 includes the analytical formulation of these. In order to avoid an excessive extension this work lacks the complete derivation of 𝝌𝝌0𝝌subscript𝝌0\frac{\partial\bm{\chi}}{\partial\bm{\chi}_{0}}divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG. The analytical derivatives of the coefficients in the A.4 have been validated by the use of Taylor differential algebra with Hipparchus. Again, this is only for validation, as the fully analytical implementation performs better.

The output 𝝌𝝌0𝝌subscript𝝌0\frac{\partial\bm{\chi}}{\partial\bm{\chi}_{0}}divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG is the error transition matrix from and to GEqOE, but the fitting algorithm works with Cartesian states and derivatives. In order to perform this conversion the jacobians of both transformations, RV2GEQOE (𝝌𝑿)𝝌𝑿\left(\frac{\partial\bm{\chi}}{\partial\bm{X}}\right)( divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_X end_ARG ) and GEQOE2RV (𝑿𝝌)𝑿𝝌\left(\frac{\partial\bm{X}}{\partial\bm{\chi}}\right)( divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_χ end_ARG ), are required. These are available in analytical form in [4], and the implementation has been validated by the application of automatic differentiation over Algorithms (1-2). Now, in order to obtain 𝑿𝑿0𝑿subscript𝑿0\frac{\partial\bm{X}}{\partial\bm{X}_{0}}divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_X start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG, it is simply a matter of multiplying by the corresponding jacobian evaluated at the correct instant, see Equation (24).

𝑿𝑿0=𝑿𝝌t(𝝌𝝌0)𝝌𝑿t0.\frac{\partial\bm{X}}{\partial\bm{X}_{0}}=\frac{\partial\bm{X}}{\partial\bm{% \chi}}\biggr{\rfloor}_{t}\left(\frac{\partial\bm{\chi}}{\partial\bm{\chi}_{0}}% \right)\frac{\partial\bm{\chi}}{\partial\bm{X}}\biggr{\rfloor}_{t_{0}}.divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_X start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG = divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_χ end_ARG ⌋ start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT ( divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_χ start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG ) divide start_ARG ∂ bold_italic_χ end_ARG start_ARG ∂ bold_italic_X end_ARG ⌋ start_POSTSUBSCRIPT italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_POSTSUBSCRIPT . (24)

Notice that the evaluation of 𝑿𝝌t\frac{\partial\bm{X}}{\partial\bm{\chi}}\biggr{\rfloor}_{t}divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_χ end_ARG ⌋ start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT is done at the state computed by the Taylor expansion itself. The correctness of the analytical approximation of 𝑿𝑿0𝑿subscript𝑿0\frac{\partial\bm{X}}{\partial\bm{X}_{0}}divide start_ARG ∂ bold_italic_X end_ARG start_ARG ∂ bold_italic_X start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT end_ARG has been checked by numerically integrating the variational equations with the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation added. This completes the analytical method with the addition of the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation.

2.6 Adding extra information: Orbital Plane-based Orbit Determination - OPOD

The main setback in doing precise initial orbital state determination with the information available in a single radar track is precisely the scarcity of data. This will later affect the sensitivity of derived metrics for maneuver detection. This section presents an alternative approach in order to improve the quality and reliability of the estimation. The idea behind it is that in LEO maneuvers are usually performed to maintain altitude, and thus do not act on the orbital plane itself. This is in part due to how expensive it is to change the inclination i𝑖iitalic_i of the orbit, or its right ascension of the ascending node ΩΩ\Omegaroman_Ω (RAAN). It is assumed that the object of the track has a known past orbit, which makes it possible to predict the orbital plane with relatively high precision. Here it is assumed that the process noise (drag uncertainty primarily) acts in a direction that does not affect directly the i𝑖iitalic_i and ΩΩ\Omegaroman_Ω prediction. The predictability of both is assumed for the moment, in particular with the presence of maneuvers, allowing to perform Orbital Plane-based Orbit Determination (OPOD).

The measurement function h(𝒚,t)𝒚𝑡h(\bm{y},t)italic_h ( bold_italic_y , italic_t ) for these new observables, as well as the analytical derivative with respect to the Cartesian state h/𝒚𝒚\partial h/\partial\bm{y}∂ italic_h / ∂ bold_italic_y are deduced next. Consider the specific angular momentum as the cross product of position and velocity both given in an inertial frame (I), 𝒉=𝒓×𝒗𝒉𝒓𝒗\bm{h}=\bm{r}\times\bm{v}bold_italic_h = bold_italic_r × bold_italic_v. The inclination i can be computed as a function of 𝒓𝒓\bm{r}bold_italic_r and 𝒗𝒗\bm{v}bold_italic_v from Equation (25).

h\displaystyle hitalic_h =(𝒉𝒉)1/2,absentsuperscriptsuperscript𝒉𝒉12\displaystyle=\left(\bm{h}^{\intercal}\bm{h}\right)^{1/2},= ( bold_italic_h start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_h ) start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT , hzsubscript𝑧\displaystyle h_{z}italic_h start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT =𝒆3𝒉,absentsuperscriptsubscript𝒆3𝒉\displaystyle=\bm{e}_{3}^{\intercal}\bm{h},= bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_h , i=arccos(hzh).𝑖subscript𝑧\displaystyle i=\arccos{\left(\frac{h_{z}}{h}\right)}.italic_i = roman_arccos ( divide start_ARG italic_h start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT end_ARG start_ARG italic_h end_ARG ) . (25)

The right ascension of the ascending node ΩΩ\Omegaroman_Ω is computed from Eq. (26).

𝒏superscript𝒏\displaystyle\bm{n}^{*}bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT =𝒆3×𝒉,absentsubscript𝒆3𝒉\displaystyle=\bm{e}_{3}\times\bm{h},= bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT × bold_italic_h , nsuperscript𝑛\displaystyle n^{*}italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT =(𝒏𝒏)1/2,absentsuperscriptsuperscript𝒏absentsuperscript𝒏12\displaystyle=\left(\bm{n}^{*\intercal}\bm{n}^{*}\right)^{1/2},= ( bold_italic_n start_POSTSUPERSCRIPT ∗ ⊺ end_POSTSUPERSCRIPT bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT ) start_POSTSUPERSCRIPT 1 / 2 end_POSTSUPERSCRIPT , 𝒏𝒏\displaystyle\bm{n}bold_italic_n =𝒏n,absentsuperscript𝒏superscript𝑛\displaystyle=\frac{\bm{n}^{*}}{n^{*}},= divide start_ARG bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG , ΩΩ\displaystyle\Omegaroman_Ω =arccos(𝒆1𝒏).absentsuperscriptsubscript𝒆1𝒏\displaystyle=\arccos{\left(\bm{e}_{1}^{\intercal}\bm{n}\right)}.= roman_arccos ( bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_n ) . (26)

For the derivation of i𝑖iitalic_i and ΩΩ\Omegaroman_Ω with respect to position and velocity the cross product of a 3×n3𝑛3\times n3 × italic_n matrix M𝑀Mitalic_M by a 3×1313\times 13 × 1 vector 𝒅𝒅\bm{d}bold_italic_d is defined as the cross product of each column in M by 𝒅𝒅\bm{d}bold_italic_d. Consequently, the i-eth column of D=M×𝒅DM𝒅\text{D}=\text{M}\times\bm{d}D = M × bold_italic_d meets Di=Mi×𝒅subscriptD𝑖subscriptM𝑖𝒅\text{D}_{i}=\text{M}_{i}\times\bm{d}D start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT = M start_POSTSUBSCRIPT italic_i end_POSTSUBSCRIPT × bold_italic_d. In other words, the cross product of matrix and vector acts column-wise for the next derivation. The differentiation with respect to the state for the inclination results in the following:

𝒉𝒓=𝒉𝒓absent\displaystyle\frac{\partial\bm{h}}{\partial\bm{r}}=divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_r end_ARG = 𝒓𝒓×𝒗+𝒓×𝒗𝒓=I×𝒗,𝒓𝒓𝒗𝒓𝒗𝒓𝐼𝒗\displaystyle\,\frac{\partial\bm{r}}{\partial\bm{r}}\times\bm{v}+\bm{r}\times% \frac{\partial\bm{v}}{\partial\bm{r}}=I\times\bm{v},divide start_ARG ∂ bold_italic_r end_ARG start_ARG ∂ bold_italic_r end_ARG × bold_italic_v + bold_italic_r × divide start_ARG ∂ bold_italic_v end_ARG start_ARG ∂ bold_italic_r end_ARG = italic_I × bold_italic_v ,
𝒉𝒗=𝒉𝒗absent\displaystyle\frac{\partial\bm{h}}{\partial\bm{v}}=divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_v end_ARG = 𝒓𝒗×𝒗+𝒓×𝒗𝒗=I×𝒓,𝒓𝒗𝒗𝒓𝒗𝒗𝐼𝒓\displaystyle\,\frac{\partial\bm{r}}{\partial\bm{v}}\times\bm{v}+\bm{r}\times% \frac{\partial\bm{v}}{\partial\bm{v}}=-I\times\bm{r},divide start_ARG ∂ bold_italic_r end_ARG start_ARG ∂ bold_italic_v end_ARG × bold_italic_v + bold_italic_r × divide start_ARG ∂ bold_italic_v end_ARG start_ARG ∂ bold_italic_v end_ARG = - italic_I × bold_italic_r ,
𝒉𝒚=𝒉𝒚absent\displaystyle\frac{\partial\bm{h}}{\partial\bm{y}}=divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG = [𝒉𝒓,𝒉𝒗],𝒉𝒓𝒉𝒗\displaystyle\,\left[\frac{\partial\bm{h}}{\partial\bm{r}},\frac{\partial\bm{h% }}{\partial\bm{v}}\right],[ divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_r end_ARG , divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_v end_ARG ] ,
hz𝒚=subscript𝑧𝒚absent\displaystyle\frac{\partial h_{z}}{\partial\bm{y}}=divide start_ARG ∂ italic_h start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG = 𝒆3𝒉𝒚,superscriptsubscript𝒆3𝒉𝒚\displaystyle\,\bm{e}_{3}^{\intercal}\frac{\partial\bm{h}}{\partial\bm{y}},bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG ,
h𝒚=𝒚absent\displaystyle\frac{\partial h}{\partial\bm{y}}=divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG = 𝒉h𝒉𝒚,superscript𝒉𝒉𝒚\displaystyle\,\frac{\bm{h}^{\intercal}}{h}\frac{\partial\bm{h}}{\partial\bm{y% }},divide start_ARG bold_italic_h start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT end_ARG start_ARG italic_h end_ARG divide start_ARG ∂ bold_italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG ,
i𝒚=𝑖𝒚absent\displaystyle\frac{\partial i}{\partial\bm{y}}=divide start_ARG ∂ italic_i end_ARG start_ARG ∂ bold_italic_y end_ARG = 11cos2i[hz𝒚cosih𝒚]1h.11superscript2𝑖delimited-[]subscript𝑧𝒚𝑖𝒚1\displaystyle\,-\frac{1}{\sqrt{1-\cos^{2}i}}\left[\frac{\partial h_{z}}{% \partial\bm{y}}-\cos{i}\frac{\partial h}{\partial\bm{y}}\right]\frac{1}{h}.- divide start_ARG 1 end_ARG start_ARG square-root start_ARG 1 - roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_i end_ARG end_ARG [ divide start_ARG ∂ italic_h start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG - roman_cos italic_i divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG ] divide start_ARG 1 end_ARG start_ARG italic_h end_ARG .

For the right ascension of the ascending node on the other hand:

𝒏𝒚=superscript𝒏𝒚absent\displaystyle\frac{\partial\bm{n}^{*}}{\partial\bm{y}}=divide start_ARG ∂ bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG = 𝒆3×h𝒚=h𝒚×𝒆3,subscript𝒆3𝒚𝒚subscript𝒆3\displaystyle\,\bm{e}_{3}\times\frac{\partial h}{\partial\bm{y}}=-\frac{% \partial h}{\partial\bm{y}}\times\bm{e}_{3},bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT × divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG = - divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG × bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT ,
n𝒚=superscript𝑛𝒚absent\displaystyle\frac{\partial n^{*}}{\partial\bm{y}}=divide start_ARG ∂ italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG = 𝒏n𝒏𝒚,superscript𝒏absentsuperscript𝑛superscript𝒏𝒚\displaystyle\,\frac{\bm{n}^{*\intercal}}{n^{*}}\frac{\partial\bm{n}^{*}}{% \partial\bm{y}},divide start_ARG bold_italic_n start_POSTSUPERSCRIPT ∗ ⊺ end_POSTSUPERSCRIPT end_ARG start_ARG italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG divide start_ARG ∂ bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG ,
𝒏𝒚=𝒏𝒚absent\displaystyle\frac{\partial\bm{n}}{\partial\bm{y}}=divide start_ARG ∂ bold_italic_n end_ARG start_ARG ∂ bold_italic_y end_ARG = [𝒏𝒚𝒏n𝒚]1n,delimited-[]superscript𝒏𝒚𝒏superscript𝑛𝒚1superscript𝑛\displaystyle\,\left[\frac{\partial\bm{n}^{*}}{\partial\bm{y}}-\bm{n}\frac{% \partial n^{*}}{\partial\bm{y}}\right]\frac{1}{n^{*}},[ divide start_ARG ∂ bold_italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG - bold_italic_n divide start_ARG ∂ italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG start_ARG ∂ bold_italic_y end_ARG ] divide start_ARG 1 end_ARG start_ARG italic_n start_POSTSUPERSCRIPT ∗ end_POSTSUPERSCRIPT end_ARG ,
Ω𝒚=Ω𝒚absent\displaystyle\frac{\partial\Omega}{\partial\bm{y}}=divide start_ARG ∂ roman_Ω end_ARG start_ARG ∂ bold_italic_y end_ARG = 11+cos2Ω𝒆1𝒏𝒚.11superscript2Ωsuperscriptsubscript𝒆1𝒏𝒚\displaystyle\,-\frac{1}{\sqrt{1+\cos^{2}\Omega}}\bm{e}_{1}^{\intercal}\frac{% \partial\bm{n}}{\partial\bm{y}}.- divide start_ARG 1 end_ARG start_ARG square-root start_ARG 1 + roman_cos start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT roman_Ω end_ARG end_ARG bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT divide start_ARG ∂ bold_italic_n end_ARG start_ARG ∂ bold_italic_y end_ARG .

The addition of these virtual measurements can be applied to either the Keplerian or J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT fitting of radar measurements, but not the GTDS method as it only works with position information.

3 Simulated results

For this section, synthetic simulations of the satellite's trajectory and consequent radar measurements are leveraged to derive results on the IOD methods' performance. The satellite dynamic' s are simulated using high-fidelity models that account for the shape, attitude and solar array orientation, and include all perturbations relevant for the time spans of the simulations. The radar simulation is a simplified model that uses a fixed noise characterization for all range values. The implementation of the dynamical models and radar simulation make use of the Orekit library [21], as explained in Section 3.1. After that, Section 3.2 presents the necessary preliminary testing of the radar-only IOD methods, establishing a baseline for the performance and its dependency with the track length. Then, Section 3.3 performs the same preliminary testing on the orbital-plane enhanced method, denoted as OPOD, showing the effect of adding orbital plane information on the estimation, and the dependency with the assumed uncertainty in the presence of maneuvers. Section 3.4 presents the synthetic testing methodology and the particular scenarios that generate all the track data used in Section 3.5. In this latest section a k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT metric is defined to test the correct uncertainty characterization of the estimation errors.

3.1 Dynamical modeling and radar characterization

For a classical IOD method reliant upon sensor data alone it would be enough to simply simulate the “real” satellite trajectories and generate samples of radar tracks. The testing methodology has been made a bit more complex to accommodate for the OPOD algorithm as well (reliant upon predicted orbital plane), thus needing two distinct dynamics. Table 1 includes the dynamical models needed for all numerical simulations performed in this work. Notice that the main difference between Real and Prediction dynamics resides in the type of atmosphere model and the degree and order of the harmonics included. Both the NRLMSISE-00 [26] and DTM-2000 [6] are empirical atmospheres that feed on tabulated solar weather data, particularly mean and instantaneous solar flux, and geomagnetic indices dependent on the solar activity. Still, these are different in order to faithfully consider the ignorance of the real atmosphere at any time.

On the other hand, satellite models are distinguished between high-fidelity (HF), see Table 2, and low-fidelity (LF), see Table 3. In this case the differences are more pronounced, as the LF satellites use a simple spherical drag model, where in the HF case their orientation is relevant, and always fixed to the LVLH frame777X axis aligned with position, Z axis aligned with orbital momentum. Suffice to say, for the simulation of real satellite trajectories a HF model is paired with Real dynamics, while propagations intended for predicting the orbital plane use a LF model in conjunction with Prediction dynamics. In contrast, within the IOD process propagations use the analytical models developed in Section 2.

Table 1: The two dynamical models defined, one for the real trajectory and other for the prediction, the third one is used in a special scenario for checking purposes. SRP stands for Solar Radiation pressure.
Model Earth harmonics Atmosphere Sun Moon SRP
Real [150,150]150150[150,150][ 150 , 150 ] DTM-2000 yes yes yes
Prediction [40,40]4040[40,40][ 40 , 40 ] NRLMSISE-00 yes yes yes
Test [2,2]22[2,2][ 2 , 2 ] None no no no

The name of the satellites are just a reference to the real-world equivalent in terms of the orbit type. The Sentinel-1A resides in a 700700700700 Km orbit, while Swarm-C is at an altitude of 430430430430 Km. Starlink-1 and 2 are lower inclination orbits at around 540540540540 Km. Table 4 includes the initial conditions that are used for the synthetic scenarios of each. The aim of including these satellites is to generate variety in the length of the radar track.

Out of all the HF satellites defined in Table 2 only Sentinel-1A and Swarm-C have a corresponding LF model for prediction computations (see Table 3). Thus, the algorithm that includes predicted orbital plane data (OPOD) is tested on these satellites alone. The other three radar-only IOD methods (Sections 2.3, 2.4 and 2.5) are tested on all satellites.

Table 2: Parameters defining the realistic satellites Sentinel-1A, Swarm-C and Starlink-1/2 using Orekit's BoxAndSolarArraySpacecraft force model class. These parameters are: mass, dimensions of the box-shaped body, solar array area, solar array rotation axis in the body frame, drag coefficient, absorption coefficient and reflection coefficient. The satellite body is always aligned with the LVLH frame of reference.
HF Satellite m𝑚mitalic_m (Kg𝐾𝑔Kgitalic_K italic_g) xlsubscript𝑥𝑙x_{l}italic_x start_POSTSUBSCRIPT italic_l end_POSTSUBSCRIPT (m𝑚mitalic_m) ylsubscript𝑦𝑙y_{l}italic_y start_POSTSUBSCRIPT italic_l end_POSTSUBSCRIPT (m𝑚mitalic_m) zlsubscript𝑧𝑙z_{l}italic_z start_POSTSUBSCRIPT italic_l end_POSTSUBSCRIPT (m𝑚mitalic_m) Assubscript𝐴𝑠A_{s}italic_A start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT (m2superscript𝑚2m^{2}italic_m start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT) Axsubscript𝐴𝑥A_{x}italic_A start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT [-] CDsubscript𝐶𝐷C_{D}italic_C start_POSTSUBSCRIPT italic_D end_POSTSUBSCRIPT [-] acsubscript𝑎𝑐a_{c}italic_a start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT [-] rcsubscript𝑟𝑐r_{c}italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT [-]
Sentinel-1A 2270 1.02 1.34 3.2 25.46 y𝑦yitalic_y 1.5 0.8 0.5
Swarm-C 440 1.3 8 0.9 0.1 y𝑦yitalic_y 0.95 0.9 0.5
Starlink-1 1250 2.8 2.3 0.3 25.2 z𝑧zitalic_z 0.9 0.9 0.5
Starlink-2 800 2.5 2 0.2 20 z𝑧zitalic_z 0.92 0.9 0.5
Table 3: Parameters defining the low fidelity satellites Sentinel-1A1 and Swarm-C1 using Orekit's isotropic drag and radiation force model classes. These parameters are: mass, drag cross section, drag coefficient, solar radiation cross section and reflection coefficient.
LF Satellite m𝑚mitalic_m (Kg𝐾𝑔Kgitalic_K italic_g) S𝑆Sitalic_S (m2superscript𝑚2m^{2}italic_m start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT) CDsubscript𝐶𝐷C_{D}italic_C start_POSTSUBSCRIPT italic_D end_POSTSUBSCRIPT [-] SRPs𝑆𝑅subscript𝑃𝑠SRP_{s}italic_S italic_R italic_P start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT (m2superscript𝑚2m^{2}italic_m start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT) rcsubscript𝑟𝑐r_{c}italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT [-]
Sentinel-1A1 2200 9.5 2 10 1.4
Swarm-C1 420 4 2.56 4 1.4
Table 4: Initial condition (I.C.) for the reference orbit defined for the scenarios in Table 8, in Cartesian coordinates (Earth EME2000 inertial frame). The first is a Sentinel-1A type orbit. The other is used in the Swarm-C scenario. The initial epoch t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT is at 00:00:00 UT.
I.C. x𝑥xitalic_x (km𝑘𝑚kmitalic_k italic_m) y𝑦yitalic_y (km𝑘𝑚kmitalic_k italic_m) z𝑧zitalic_z (km𝑘𝑚kmitalic_k italic_m) vxsubscript𝑣𝑥v_{x}italic_v start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT (km/s𝑘𝑚𝑠km/sitalic_k italic_m / italic_s) vysubscript𝑣𝑦v_{y}italic_v start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT (km/s𝑘𝑚𝑠km/sitalic_k italic_m / italic_s) vzsubscript𝑣𝑧v_{z}italic_v start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT (km/s𝑘𝑚𝑠km/sitalic_k italic_m / italic_s) t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT
S1A-1 1459.975 436.989 -6916.264 -3.8952 -6.282 -1.219 01/05/2022
SWC-1 254.597 -241.108 6792.396 7.151 2.655 -0.1728 06/07/2020
SRL-1 4970.721 3941.433 602.664 -4.458 4.973 4.244 27/08/2023
SRL-2 5030.115 3838.607 754.660 -4.040 4.249 5.315 27/08/2023

The dynamics part of the synthetic testing is carried out with Orekit [21], a well proven and tested space dynamics library. This is also true for the measurement generation part. Orekit includes classes that can handle the type of sensor needed, taking into account these are two-way measurements (reflection time is part of the measurement generation). The particular characterization of the simulated field of regard (FoR) is part of the caption in Figure 2(b). Technically, this surveillance volume is defined in a limited range from the origin (minimum and maximum), but that is overlooked for this work, as the orbits considered are within it at all times. The generation of the measurements includes the addition of noise over the real values. This noise is a normal distribution in measurement space, has constant covariance for all measurements (a simplified noise model), and includes no biases. The limited orbital regimes considered here justify this straightforward model, in contrast to [31] where the radar survey is applied to a wide extent of orbital heights. It is important to highlight that the uncertainty characterization is supposed to be known perfectly when performing the estimation.

All the parameters characterizing a radar are specified in Table 5 for three different stations that are used in the synthetic testing. It must be highlighted that these three radar stations are used separately, that is, in different scenarios (the data each generates is never used in conjunction with the others). Using more than one radar in the synthetic data generation is meant to enrich the track length variability and data density over different scenarios.

Refer to caption
(a)
Refer to caption
(b)
Fig. 2: The orientation of the radar antenna is given by 3 consecutive rotations around its local x𝑥xitalic_x, y𝑦yitalic_y and z𝑧zitalic_z axes, in that order. Initially it is parallel to the XY𝑋𝑌XYitalic_X italic_Y plane of the topocentric frame of reference with the same origin, see (2(a)). The field of regard (FoR) is expressed in terms of the scanning angles U and V, which are the angles between the scanning beam and the local yz𝑦𝑧yzitalic_y italic_z and xz𝑥𝑧xzitalic_x italic_z planes respectively. Each is limited in the positive and negative side, and define a volume shaped as the outside of two concentric cones that meet at the vertex. When the limits of both angles are considered the result is the volume outside 4 cones that intersect with the two perpendicular to themselves, see (2(b)).
Table 5: Complete characterization of the radar stations used for the synthetic testing. The angles λ𝜆\lambdaitalic_λ and ϕitalic-ϕ\phiitalic_ϕ are the geodetic coordinates in the WGS84 ellipsoid, and hhitalic_h is the altitude over it. The observables have a standard deviation σ𝜎\sigmaitalic_σ, and the angular measurements have a correlation given by ξAz,elsubscript𝜉𝐴𝑧𝑒𝑙\xi_{Az,el}italic_ξ start_POSTSUBSCRIPT italic_A italic_z , italic_e italic_l end_POSTSUBSCRIPT. The revisit time rtsubscript𝑟𝑡r_{t}italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT is the time between measurements. Radar 1 has been modeled as an approximation of the S3T Surveillance Radar [16], but the FoR parameters (subject to changes during its real operation) have been omitted due to confidentiality reasons.
Name (λ,ϕ)𝜆italic-ϕ\left(\lambda,\phi\right)( italic_λ , italic_ϕ ) () hhitalic_h (m) (φx,φy,φz)subscript𝜑𝑥subscript𝜑𝑦subscript𝜑𝑧\left(\varphi_{x},\varphi_{y},\varphi_{z}\right)( italic_φ start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT , italic_φ start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT , italic_φ start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT ) () (Umin,Umax)subscriptU𝑚𝑖𝑛subscriptU𝑚𝑎𝑥\left(\text{U}_{min},\text{U}_{max}\right)( U start_POSTSUBSCRIPT italic_m italic_i italic_n end_POSTSUBSCRIPT , U start_POSTSUBSCRIPT italic_m italic_a italic_x end_POSTSUBSCRIPT ) () (Vmin,Vmax)subscriptV𝑚𝑖𝑛subscriptV𝑚𝑎𝑥\left(\text{V}_{min},\text{V}_{max}\right)( V start_POSTSUBSCRIPT italic_m italic_i italic_n end_POSTSUBSCRIPT , V start_POSTSUBSCRIPT italic_m italic_a italic_x end_POSTSUBSCRIPT ) () σρsubscript𝜎𝜌\sigma_{\rho}italic_σ start_POSTSUBSCRIPT italic_ρ end_POSTSUBSCRIPT (m) σρ˙subscript𝜎˙𝜌\sigma_{\dot{\rho}}italic_σ start_POSTSUBSCRIPT over˙ start_ARG italic_ρ end_ARG end_POSTSUBSCRIPT (m/s) σAzsubscript𝜎𝐴𝑧\sigma_{Az}italic_σ start_POSTSUBSCRIPT italic_A italic_z end_POSTSUBSCRIPT () σelsubscript𝜎𝑒𝑙\sigma_{el}italic_σ start_POSTSUBSCRIPT italic_e italic_l end_POSTSUBSCRIPT () ξAz,elsubscript𝜉𝐴𝑧𝑒𝑙\xi_{Az,el}italic_ξ start_POSTSUBSCRIPT italic_A italic_z , italic_e italic_l end_POSTSUBSCRIPT rtsubscript𝑟𝑡r_{t}italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT (s)
Radar 1 (5.59,37.17)5.5937.17\left(-5.59,37.17\right)( - 5.59 , 37.17 ) 142.32 - - - 7777 0.40.40.40.4 0.30.30.30.3 0.20.20.20.2 0.0430.0430.0430.043 7
Radar 2 (22.3,78.49)22.378.49\left(22.3,78.49\right)( 22.3 , 78.49 ) 22.14 (40,0,0)4000\left(40,0,0\right)( 40 , 0 , 0 ) (30,30)3030\left(-30,30\right)( - 30 , 30 ) (20,20)2020\left(-20,20\right)( - 20 , 20 ) 6.56.56.56.5 0.350.350.350.35 0.250.250.250.25 0.150.150.150.15 0.0430.0430.0430.043 4
Radar 3 (175.68,37.86)175.6837.86\left(175.68,-37.86\right)( 175.68 , - 37.86 ) 36.2 (30,0,0)3000\left(30,0,0\right)( 30 , 0 , 0 ) (20,20)2020\left(-20,20\right)( - 20 , 20 ) (45,45)4545\left(-45,45\right)( - 45 , 45 ) 6.56.56.56.5 0.350.350.350.35 0.250.250.250.25 0.150.150.150.15 0.0430.0430.0430.043 4

3.2 Preliminary testing of the IOD algorithms

With all aspects of the simulation in place, and the fitting methods that are to be compared, see Section 2, it is necessary to first apply and compare them in a controlled case. Understanding the limitations and characteristics of each does help to better comprehend the estimation statistics later on, see Section 3.5.1. The approach consists on taking a single radar track, and apply the three IOD algorithms over it (radar data alone is used). In order to study the effect of the track length on the estimation qualities (absolute error and uncertainty), a long track is chosen, and it is made shorter by taking out measurements from the extremes (two at a time), repeating the fitting each time.

The longest track generated by Radar 3 when simulating Sentinel-1A during 4 days has been chosen. It consists of 72 measurements and spans 284 seconds from the initial to the final measurement. This is the only track used for the test.

3.2.1 Fitting of noiseless measurements

First, it is relevant to consider not the noisy measurements, but the real values of these, in order to emphasize the base limitations of each method. Propagating the real position and velocity at the epoch of the test track with Kepler dynamics results in the errors of Figure 3 (Left). Position errors are on the order of 100100100100 meters, and more importantly, range errors go over 50505050 m. This is a trajectory that coincides with the real one at the epoch, and yet the Kepler model incurs in range errors one order of magnitude greater than the uncertainty of the radar measurements.

Refer to caption
Fig. 3: Position and range errors using a simple Kepler model for a very long radar track (284284284284 seconds sample track from Radar 3). The left plot is a propagation from the true state at the epoch (middle of the track). The center plot is the estimation resulting from applying the GTDS algorithm (Section 2.3), but using the real position values of the Sentinel-1A high fidelity simulation as measurements. The right plot is a fitting, also with real position values, but applying weights based on the measurements uncertainty of this radar (conversion from radar to inertial covariance with Unscented Transform).

Now, applying the GTDS algorithm over the real position measurements results in the estimation with errors of Figure 3 (Center). The value of the square sum of errors (𝝃𝝃superscript𝝃𝝃\bm{\xi}^{\intercal}\bm{\xi}bold_italic_ξ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ξ), is reduced here to its minimum value. No weights are applied, so on average the position errors are lower along the complete trajectory, and not just at the epoch. Range errors on the other hand are not necessarily lower, as this fitting has no preferential direction for the minimization of error.

The opposite is happening in Figure 3 (Right), where the position fitting is done by minimizing 𝝃W𝝃superscript𝝃W𝝃\bm{\xi}^{\intercal}\text{W}\bm{\xi}bold_italic_ξ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT W bold_italic_ξ, with W=Cr1WsuperscriptsubscriptC𝑟1\text{W}=\text{C}_{r}^{-1}W = C start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT start_POSTSUPERSCRIPT - 1 end_POSTSUPERSCRIPT. Position covariance computed with an UT has greater variance in the direction of range (radar-satellite vector) than the original uncertainty in measurement space. Even then, it is still a very thin disk, so the covariance is much less homogeneous than the non-weighted case (same as an uniform weight in all directions). Notice that this fit does no correspond to any of the methods highlighted in Section 2, but serves as a step prior to fitting observables directly. The error of the estimation is now on the order of the kilometer, while still being a fitting of exact position values. The only change is the increased weight of the error in the range direction, forcing the residuals (in that direction) to be much lower. The residuals on the perpendicular directions are not so relevant, and is even less important for measurements further apart from the radar, as the disk-shaped covariance gets wider. The problem resides in the pairing of Kepler dynamics with a strongly directional weighting. Figure 3 (Left) showed how this model is not capable of kee** low range residuals for such a long pass, so the fitting algorithm has to change the trajectory considerably. The result is a kilometer wide gap at the epoch for the resulting estimation (but with range errors on the order of 10101010 m).

This problem is made worse when the actual radar observables are fitted directly with a Kepler model888The derivatives of the predicted state are computed with the expansion of the Kepler functions up to the terms present in Equation (15), and the convergence speed is comparable to the GTDS method., see Figure 5 (Left), where now the epoch position error is 1.51.51.51.5 Km. This is due to the range being now even more relevant to the weighting, but also because a strong range-rate constraint is added to the algorithm. Kepler dynamics deviate even more from the real trajectory when both residuals are so relevant.

Table 6: Constants used for the analytical J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT propagator developed in Section 2.5.2.
μ𝜇\muitalic_μ (Km3/s2superscriptKm3superscripts2\text{Km}^{3}/\text{s}^{2}Km start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT / s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT) Resubscript𝑅𝑒R_{e}italic_R start_POSTSUBSCRIPT italic_e end_POSTSUBSCRIPT (Km) J2
398600.4418398600.4418398600.4418398600.4418 6378.1376378.1376378.1376378.137 1.0826266835531031.082626683553superscript1031.082626683553\cdot 10^{-3}1.082626683553 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT

The approximated J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT propagator in Section 2.5.2 is now tested up to the fourth term of the Taylor expansion (see Table 6 for the constants used). The absolute position errors compared to a numerical propagation are on the order of the centimeter for a 100100100100 seconds propagation, see Figure 4. Figure 5 (Center) shows the errors when the true state is propagated from the epoch using the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT propagator, with much better results now that the range residuals are barely over 1111 meter at worst. As a consequence the radar observables fitting is much more similar to the original trajectory, see Figure 5 (Right), which indicates this might be a superior method to the GTDS if only position errors are considered.

Refer to caption
(a)
Refer to caption
(b)
Fig. 4: The relative error of the GEqOE Taylor expansion improves by an order of magnitude with each added term to the series for the first 200 seconds. The normalizing value is the output of the numerical propagation with a tolerance of 1014superscript101410^{-14}10 start_POSTSUPERSCRIPT - 14 end_POSTSUPERSCRIPT (4(a)). After 100 seconds of propagation, the Cartesian error (using Algorithm 2) is on the order of 102superscript10210^{-2}10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT m in position and 102superscript10210^{-2}10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT mm/s in velocity for the fourth order approximation (4(b)).
Refer to caption
Fig. 5: Position and range errors using real radar measurements directly, including range-rate, in the same sample track as in Figure 3. The left plot shows the errors when the fitting is done using Kepler dynamics, see Section 2.4. The central plot shows the errors when the analytical J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT propagator is used from the true state at the epoch (t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT). The right plot is the result of applying the analytical fitting with J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT developed in Section 2.5.

Before including noise into the discussion, Figure 6 is presented for a complete comparison between the methods for different track lengths when measurements are noiseless. This is a representation of the error at the epoch (middle of the track) when the fitted trajectory gets shorter as measurements are extracted in pairs from the sides of the test track. The Keplerian fit of measurements is by far the worst of the three for the reasons already discussed, but very short tracks do not suffer so much in terms of position error. The observables fit with J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation seems to be the best in this regard, but GTDS has a small advantage in velocity errors. This can only occur under the condition of flawless fitted position measurements. Since the GTDS method assigns equal weight to all residuals, errors stemming from the basic dynamics are effectively averaged out.

Refer to caption
Fig. 6: Fitting errors (at t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT) for a radar track of decreasing duration using the three main IOD algorithms developed in Section 2. By leveraging the same radar track as in Figures 3 and 5, and taking off two measurements at a time from each side, the effect of ever shorter tracks in the estimation accuracy is studied here. In all fittings the measurements are the real values (either position for GTDS or radar observables in the other cases).

3.2.2 Fitting of noisy measurements

Noise is now introduced, see Figure 7, and results are averaged over a number of fittings to make them comparable. Despite shorter tracks being better represented with simplified dynamics, the uncertainty and measurement errors dominate the problem. In this instance there is not much difference between the methods for shorter than 100100100100 seconds tracks, at least in terms of average position error. There is a slight disadvantage for GTDS in terms of velocity errors throughout the first half of the interval, which can be attributed to the lack of range-rate information (very precise for this radar). As the track gets longer though, the Keplerian fitting of the measurements shows its fundamental flaw. It is interesting to see how adding information can deteriorate the estimation, and it is only due to the pairing of non-homogeneous data with an unsuitable model for the dynamics. The GTDS algorithm suffers also from the Kepler approximation, but much less so thanks to the lack of weighting, which enables the averaging of errors by default. The approximated J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT method is the best in general, particularly for the longest radar tracks.

Refer to caption
Fig. 7: Fitting errors for a radar track of decreasing duration using the three main IOD algorithms developed in Section 2, with the addition of noise and averaged over a number of samples. In all fittings the measurements (either position for GTDS or radar observables in the other cases) are noisy values sampled in measurement space .

These results are incomplete without taking a look at the evolution of the uncertainty for different track lengths, see Figure 8. Due in part to the absence of range-rate data, the GTDS is more conservative in the uncertainty aspect of the estimation, but it is also a consequence of the way uncertainty of measurements is used (indirectly), see Section 2.3. The information shown in Figure 8 does not consider correlations, so this is an incomplete picture of the covariance. In any case, the evolution is compatible with the errors, so this estimation method should behave correctly. The Keplerian fit of radar observables on the other hand suffers from overconfidence very soon for longer than 100100100100 seconds tracks, as the uncertainty keeps getting lower with more measurements added, but the error does not evolve accordingly, see Figure 7. A more comprehensive exploration of the uncertainty realism is conducted in Section 3.5.1 using a broader dataset.

Refer to caption
Fig. 8: Estimation uncertainty using the three algorithms developed in Section 2, with the addition of noise and averaged over a number of samples. The value of uncertainty displayed corresponds to the square root of the sum of eigenvalues for the position and velocity blocks of the uncertainty matrix CysubscriptC𝑦\text{C}_{y}C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT, so this is a conservative representation that does not consider correlations.

3.3 Preliminary testing of OPOD

The IOD method that includes information of inclination (i𝑖iitalic_i) and right ascension of the ascending node (ΩΩ\Omegaroman_Ω), see Section 2.6, is tested here. First a check is performed on the degree of predictability of the orbital plane and the expected uncertainty for two different LEO. The presence of maneuvers is also considered. Then the fitting methodology is tested when this information is included with different levels of virtual measurement uncertainty on the same test track used in Section 3.2 (and for different track lengths).

3.3.1 Orbital plane predictability check

The orbital plane predictability is tested first with a circular LEO of a=8600𝑎8600a=8600italic_a = 8600 Km semi-major axis and i=60𝑖superscript60i=60^{\circ}italic_i = 60 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT. A high fidelity propagation is compared to a very simple one in Figure 9(a), and the prediction error of i𝑖iitalic_i and ΩΩ\Omegaroman_Ω is shown. The high fidelity propagator uses the Real dynamics (see Table 1) with the Sentinel-1A HF model. The exact same initial conditions are also propagated with very simple dynamics (and the LF model of Sentinel-1A). No atmosphere is included in this case, and only the luni-solar perturbation and harmonics of degree and order 4 are used . In order to consider state uncertainty a Monte-Carlo approach has been used for simplicity here, sampling position and velocity with standard deviations on the order of σr30subscript𝜎𝑟30\sigma_{r}\approx 30italic_σ start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ≈ 30 m and σv0.2subscript𝜎𝑣0.2\sigma_{v}\approx 0.2italic_σ start_POSTSUBSCRIPT italic_v end_POSTSUBSCRIPT ≈ 0.2 m/s. The result in this first test is that the orbital plane is actually very predictable, despite the low computational effort required to run the prediction model. The angular errors for both i𝑖iitalic_i and ΩΩ\Omegaroman_Ω are on the order of 104superscript10410^{-4}10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT degrees at most, and the σ𝜎\sigmaitalic_σ values go up to around 103superscript10310^{-3}10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT. This is in contrast to the position error, not included in the graph, which evolves up to 13131313 Km after 5 days. This example is of low difficulty because the atmosphere plays almost no role at those altitudes. The second example, see Figure 9(b), uses the same initial conditions except for the semi-major axis, now at 6900690069006900 Km, and eccentricity, which is e=104𝑒superscript104e=10^{-4}italic_e = 10 start_POSTSUPERSCRIPT - 4 end_POSTSUPERSCRIPT. The closeness to the earth requires increased fidelity of its shape, so the harmonics used now are of degree and order 20. The atmosphere has to be included, but it is an static model (Modified Harris-Priester included in Orekit, see [14]), and the drag is modeled with a constant area and coefficient. This model is enough to get similar values of errors for the orbital plane, but now the predicted position has an error of 33333333 Km.

Refer to caption
(a)
Refer to caption
(b)
Fig. 9: The prediction error against a high fidelity propagator is low for both inclination and RAAN. The model only includes earth harmonics of order and degree 4 and luni-solar perturbation (no drag). These perturbations suffice to accurately predict the orbital plane for an orbit with a=8600𝑎8600a=8600italic_a = 8600 Km (9(a)). For the example of a=6900𝑎6900a=6900italic_a = 6900 Km a better model is required due to the atmosphere and earth shape being more relevant. Harmonics are of order and degree 20, and a simple Harris-Priester atmosphere model is used. This is enough to get good predictions of the orbital plane for the first 5 days, although the position error goes to 33333333 Km (9(b)).

These findings indicate that in the absence of maneuvers, even a low-fidelity propagator possesses the capability to accurately predict the orbital plane. The next step is to ascertain the possible effects of maneuvers in general over this part of the prediction. This has been done for a series of maneuvered cases, where variations in the maneuver instant and direction have been considered, for a total of 5 directions and 2 different instants after t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT. The only impulsive value used is 0.20.20.20.2 m/s, which from previous works [24] is considered a rather high value (easy to detect in general). The evolution of errors is shown in Figure 10 for all cases. One of the directions considered is the out-of-plane maneuver, and those cases, for two different instants, are noticeable as an immediate change in inclination and RAAN. The divergent ΩΩ\Omegaroman_Ω cases correspond to the prograde and regrograde maneuvers, which are also the most efficient ones at changing the semi-major axis of the orbit, and thus have a greater effect over the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT secular rate on ΩΩ\Omegaroman_Ω. These are good examples of what is the expected magnitude of the errors in orbital plane prediction, even when there have been maneuvers.

Refer to caption
Fig. 10: For 10 different maneuvered cases the predicted errors of i𝑖iitalic_i and ΩΩ\Omegaroman_Ω can become greater than in the non-maneuvered case, see Figure 9(b). Despite that, in the worst cases the order of magnitude of these errors does not evolve much over 51035superscript1035\cdot 10^{-3}5 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT degrees after 5 days.

With the previous discussion in mind, the proposed method in this section is to use both the predicted i𝑖iitalic_i and ΩΩ\Omegaroman_Ω at the epoch of the estimation as if they were extra measurements. Considering the possible effects of a maneuver in this prediction, it is important to use reasonable values for the uncertainties of these virtual measurements. Failing to do so would impose a constraint over the state incompatible with the measurements of a possibly maneuvered spacecraft, and induce error on the estimation. These values ought to be on the order of 51035superscript1035\cdot 10^{-3}5 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT degrees, but the validity and effect of the chosen value over the estimation is discussed next.

3.3.2 Effect of the i𝑖iitalic_i and ΩΩ\Omegaroman_Ω virtual measurements on the estimation error

This section tests the OPOD method and the effect of the chosen orbital plane uncertainty on the estimation error. Given the initial conditions S1A-1 (see Table 4), the HF model of Sentinel-1A is simulated with 4 different maneuvered cases. A very long track from Radar 3 that occurs 3.63.63.63.6 days after t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT is sampled (for each case) and used to derive average results when the track duration is modified. The predicted orbital plane is calculated using the LF model, and the obtained i𝑖iitalic_i and ΩΩ\Omegaroman_Ω values are the same for all the tests (the same initial conditions are always used). The test is exclusively with the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT fitting method.

Figure 11 is a summary of the improvements that are to be expected for different magnitudes of uncertainty considered. The orbit used here is higher than in the test case of Figure 10, on top of that the prediction model is of much higher fidelity for this experiment (see Table 1). Accounting for both factors prediction errors ought to be of lower magnitude (the secular effect of J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT is less dominant, about 10%percent1010\%10 % weaker).

Refer to caption
Fig. 11: Error evolution when the information of the orbital plane is added using the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT analytical estimation method. This is done for a single radar track that happens 3.63.63.63.6 days after t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT, and sampling measurements 500 times. Different maneuvered cases are compared. The effect of the uncertainty in the i𝑖iitalic_i and ΩΩ\Omegaroman_Ω information is the focus of this test.

The non-maneuvered case is the reference, as the errors here behave in a somewhat expected manner when the predicted i𝑖iitalic_i and ΩΩ\Omegaroman_Ω are very precise. Adding this information always improves the estimation, but when the uncertainty is big, as in 51025superscript1025\cdot 10^{-2}5 ⋅ 10 start_POSTSUPERSCRIPT - 2 end_POSTSUPERSCRIPT degrees for both angles, then the effect is considerably reduced. It can be compared to Figure 7 (Left) to notice the slight reduction of estimation error at all lengths, but more noticeable in shorter tracks. Then, as the uncertainty is reduced one order of magnitude, there is a great reduction of error, particularly for very short tracks (1 Km reduction in position error). Decreasing it even more only affects longer tracks, but the improvement is smaller and even non-existent when the uncertainty gets unreasonably low.

Maneuvers can have an effect on the accuracy of the estimation now, and it can be negative. Notice how for the Out-of-plane maneuver, which has an immediate effect on the orbital plane, the overconfidence in the extra information increases the prediction error for longer tracks. This is in contrast to the uncertainty of the estimation (not showed here), that is in fact decreasing when the σi,Ωsubscript𝜎𝑖Ω\sigma_{i,\Omega}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT is reduced, so that the estimation becomes overconfident in this case. This alone shows how using values of uncertainty smaller than σi,Ω=5103subscript𝜎𝑖Ω5superscript103\sigma_{i,\Omega}=5\cdot 10^{-3}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT degrees is not recommended for the magnitudes of maneuvers considered in the context of this work (a different value should be considered otherwise). Another example of this is the Prograde maneuver, which also sees a small increase in error when the orbital plane information is assumed to be too precise. The effect of this maneuver is primarily in ΩΩ\Omegaroman_Ω because of the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation, but not enough on this orbit to be more noticeable in the induced error. Finally, the Radial-out case is not affected enough to see an increase in error.

Thus, with maneuvers up to 0.20.20.20.2 m/s, it is safe to assume the predicted orbital plane error has a standard deviation of σi,Ω=5103subscript𝜎𝑖Ω5superscript103\sigma_{i,\Omega}=5\cdot 10^{-3}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 ⋅ 10 start_POSTSUPERSCRIPT - 3 end_POSTSUPERSCRIPT degrees for the purpose of estimating the state. The effect on the estimation statistics is studied for this augmented method separately from the others, see Section 3.5.2.

3.4 Synthetic scenarios

The goal of the testing presented here is to establish realistic expectations for the estimation algorithms with varying track lengths and data density. In each scenario, the satellite's true state at t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT sets the real orbit, which remains invariant. As mentioned before, testing the OPOD method requires to compute predicted orbital plane as well. In order to introduce variability on the prediction accuracy, a non-maneuvered case and various combinations of impulse value (Nimpsubscript𝑁𝑖𝑚𝑝N_{imp}italic_N start_POSTSUBSCRIPT italic_i italic_m italic_p end_POSTSUBSCRIPT), maneuver direction (Ndirsubscript𝑁𝑑𝑖𝑟N_{dir}italic_N start_POSTSUBSCRIPT italic_d italic_i italic_r end_POSTSUBSCRIPT), and maneuver instant after t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT (Ntsubscript𝑁𝑡N_{t}italic_N start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT) are part of the scenario configuration. Each of these NimpNdirNt+1subscript𝑁𝑖𝑚𝑝subscript𝑁𝑑𝑖𝑟subscript𝑁𝑡1N_{imp}N_{dir}N_{t}+1italic_N start_POSTSUBSCRIPT italic_i italic_m italic_p end_POSTSUBSCRIPT italic_N start_POSTSUBSCRIPT italic_d italic_i italic_r end_POSTSUBSCRIPT italic_N start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT + 1 cases (which spawn a real trajectory) generate a battery of tracks (Nintsubscript𝑁𝑖𝑛𝑡N_{int}italic_N start_POSTSUBSCRIPT italic_i italic_n italic_t end_POSTSUBSCRIPT) in a particular radar station within a given integration window. All the generated tracks are considered individually, and are then sampled Nmssubscript𝑁𝑚𝑠N_{ms}italic_N start_POSTSUBSCRIPT italic_m italic_s end_POSTSUBSCRIPT times (measurement noise) to generate statistics of the estimate distribution (which should be represented by CysubscriptC𝑦\text{C}_{y}C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT). This is done by computing the Mahalanobis Distance squared of the estimation error for all samples, denoted as k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT, and comparing its distribution to the theoretical one.

If the fitting methodology does not require information outside of the radar observables, all the scenario variability only serves to generate a greater amount of slightly different tracks. Notice how scenarios STARL-1 and STARL-2 do not consider maneuvers, as these scenarios have been included to increase the track length variety in the testing of the 3 main IOD algorithms. Thus, these two scenario do not require LF satellite model or uncertainty information over the initial state. The uncertainty aspect is relevant when doing the fitting that includes the predicted i𝑖iitalic_i and ΩΩ\Omegaroman_Ω, which in turns comes from a sampled initial state around the real one. A total of Nspsubscript𝑁𝑠𝑝N_{sp}italic_N start_POSTSUBSCRIPT italic_s italic_p end_POSTSUBSCRIPT different initial samples are propagated individually. One of the Nspsubscript𝑁𝑠𝑝N_{sp}italic_N start_POSTSUBSCRIPT italic_s italic_p end_POSTSUBSCRIPT predictions is randomly chosen for the computation of the estimation.

In particular, 5 different scenarios are used for the generation of statistics on the methods under study. Table 8 contains all defining aspects of these scenarios. The 2 maneuver instants considered are 0.10.10.10.1 and 0.50.50.50.5 days after t0subscript𝑡0t_{0}italic_t start_POSTSUBSCRIPT 0 end_POSTSUBSCRIPT. The uncertainty (Low) is locally defined and has values of 5555, 30.430.430.430.4 and 5555 meters in position, and 0.0020.0020.0020.002, 0.010.010.010.01 and 0.0060.0060.0060.006 m/s in velocity (diagonal covariance in the LVLH frame). Finally, the variation in integration window Nintsubscript𝑁𝑖𝑛𝑡N_{int}italic_N start_POSTSUBSCRIPT italic_i italic_n italic_t end_POSTSUBSCRIPT comes from the established maximum of 4444 days (10101010 for STARL-1 and 2), and from the combination of initial conditions and the radar station. During the maximum window, Nintsubscript𝑁𝑖𝑛𝑡N_{int}italic_N start_POSTSUBSCRIPT italic_i italic_n italic_t end_POSTSUBSCRIPT different radar tracks, are found and considered independently of each other. This is, non of them is used in conjunction with the others to increase the information available, but only by themselves.

Table 7: The six impulse directions used in all scenarios are defined in the LVLH frame (or QSW in OREKIT), so +x𝑥+x+ italic_x is the direction of the position vector and +z𝑧+z+ italic_z is in the orbit angular momentum. From 1 to 6 these are (approximately) prograde, retrograde, radial-in, radial-out, in-plane (45superscript4545^{\circ}45 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT from x𝑥-x- italic_x and +y𝑦+y+ italic_y in LVLH) and out-of-plane (at +z𝑧+z+ italic_z).
Direction dxsubscript𝑑𝑥d_{x}italic_d start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT dysubscript𝑑𝑦d_{y}italic_d start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT dzsubscript𝑑𝑧d_{z}italic_d start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT
1 0 0.9397 0.3420
2 0 -0.9397 0.3420
3 -0.9397 0 0.3420
4 0.9397 0 0.3420
5 -0.7071 0.7071 0
6 0 0 1
Table 8: Scenarios used for the synthetic data generation and metric testing. All of them use the same 6666 different maneuver directions, in Table 7. The 5 impulse values used are 20202020, 10101010, 8888, 5555, 2222 (cm/s), and the number of individual radar observations considered comes from the maximum integration window, 4 days, and the combination of I.C and radar station.
SC Name HF Satellite LF Satellite Radar Station I.C. I.Uncertainty Nspsubscript𝑁𝑠𝑝N_{sp}italic_N start_POSTSUBSCRIPT italic_s italic_p end_POSTSUBSCRIPT Nimpsubscript𝑁𝑖𝑚𝑝N_{imp}italic_N start_POSTSUBSCRIPT italic_i italic_m italic_p end_POSTSUBSCRIPT Ndirsubscript𝑁𝑑𝑖𝑟N_{dir}italic_N start_POSTSUBSCRIPT italic_d italic_i italic_r end_POSTSUBSCRIPT Ntsubscript𝑁𝑡N_{t}italic_N start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT Nintsubscript𝑁𝑖𝑛𝑡N_{int}italic_N start_POSTSUBSCRIPT italic_i italic_n italic_t end_POSTSUBSCRIPT Nmssubscript𝑁𝑚𝑠N_{ms}italic_N start_POSTSUBSCRIPT italic_m italic_s end_POSTSUBSCRIPT
SEN-1A-1 Sentinel-1A Sentinel-1A1 Radar 1 S1A-1 Low 50 5 6 2 4 600
SEN-1A-2 Sentinel-1A Sentinel-1A1 Radar 2 S1A-1 Low 35 5 6 2 15 600
SW-C-1 Swarm-C Swarm-C1 Radar 1 SWC-1 Low 50 5 6 2 4 600
STARL-1 Starlink-1 - Radar 1 SRL-1 - - 0 - - 13 600
STARL-2 Starlink-2 - Radar 1 SRL-2 - - 0 - - 16 600

3.5 k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT metric statistics

This section presents an in depth commentary on the performance of the estimation methods. A battery of tests are performed to check on the accuracy and uncertainty realism of the methods for the different radar tracks of the established scenarios. Before this, a single radar pass was studied, see Sections 3.2 and 3.3, and with no consideration for the correlation information. The current approach involves utilizing all radar tracks generated from the scenarios listed in Table 8. Following the methodology outlined in [28], an isolated k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT metric (independent of predictions) is employed to assess the accurate characterization of estimation uncertainty. This metric is k2=𝒅TCy𝒅superscript𝑘2superscript𝒅𝑇subscriptC𝑦𝒅k^{2}=\bm{d}^{T}\text{C}_{y}\bm{d}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT = bold_italic_d start_POSTSUPERSCRIPT italic_T end_POSTSUPERSCRIPT C start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT bold_italic_d, with 𝒅𝒅\bm{d}bold_italic_d being the vector of the difference between the fitted state and the ground truth.

When the fitting model is adequate and the relation between the estimated state and the measurements is close to linear the statistics of k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT for a set of samples in a particular track should be that of the chi-square distribution of the corresponding degrees of freedom p𝑝pitalic_p. The consequence is that the mean value of those k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT should meet μ=p𝜇𝑝\mu=pitalic_μ = italic_p, the variance should be σ2=2psuperscript𝜎22𝑝\sigma^{2}=2pitalic_σ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT = 2 italic_p, and 10%percent1010\%10 % of the distribution should be over χinv2(0.9,p)superscriptsubscript𝜒𝑖𝑛𝑣20.9𝑝\chi_{inv}^{2}(0.9,p)italic_χ start_POSTSUBSCRIPT italic_i italic_n italic_v end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( 0.9 , italic_p ). With χinv2(η,p)superscriptsubscript𝜒𝑖𝑛𝑣2𝜂𝑝\chi_{inv}^{2}(\eta,p)italic_χ start_POSTSUBSCRIPT italic_i italic_n italic_v end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_η , italic_p ) the chi-square inverse cumulative distribution function of p𝑝pitalic_p degrees of freedom evaluated at the percentage η𝜂\etaitalic_η of the distribution.

3.5.1 k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics on the IOD methods

Considering only the subset of simulations for Radar 1 in Table 8, the results of figs. 12, 13 and 14 compile these statistics, where it has been divided between the full state and the position and velocity parts (which are 3 degrees of freedom distributions in the ideal case). The horizontal black line indicates the expected value. Differentiating between the results for Radar 1 and 2 is a consequence of the different rates of measurement, which affect the density of plots for a given track length and thus the behavior of the fitting.

The initial and perhaps most surprising finding is that both measurement fittings perform poorly in very short tracks (less than 21 seconds or 4 measurements for this radar station). This is due to a combination of factors that, in order to better understand them, require a closer inspection to the errors distribution. Figure 15 shows the velocity errors for a very short track that has been fitted with GTDS and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT methods (sampling the track 600 times). The distribution is not that of the analytical covariance in the case of the measurement fit. The reason comes down to the linear approximation that is done for the iterative least-squares algorithm, which happens to be a bad approximation in this case. The position part seems to have the same problem, but looking to the corresponding error distribution (not shown here) it is apparent that the problem is of a different kind. In this case there is a slight bias in the estimation that happens to be perpendicular to the direction of smaller variance. This penalizes the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT considerably. The interplay of both phenomena leads to an unfavorable behavior in the full state metric, exhibiting abnormally high percentages of values exceeding χinv2(0.9,p)superscriptsubscript𝜒𝑖𝑛𝑣20.9𝑝\chi_{inv}^{2}(0.9,p)italic_χ start_POSTSUBSCRIPT italic_i italic_n italic_v end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( 0.9 , italic_p ). This signals a potential reliability issue for a maneuver detection metric that operates on any of the radar observables fittings, particularly in the context of very short tracks. The GTDS method on the other hand behaves as expected in this range of track lengths.

For longer than 5 measurements (in Radar 1) the situation improves considerably in both KEP and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT, the non-linearity of the velocity estimation ceases and the position bias also goes down. In the case of the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT fitting the consequence is a full state estimation that behaves in the way the analytical covariance is indicating, even when the track length goes to the higher values of the scenarios (these are for Starlink-2, which has the lower inclination and gets the lengthier tracks). The KEP method starts to degrade in the velocity estimation part, due to a bias, from 50 seconds and upwards. Position does not seem to be affected in these scenarios.

Despite not showing any visible degradation in the position and velocity estimations separately, the GTDS method has increased rates of k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT values with increasing track lengths, see Figure 14. This can only be due to unrealistic correlations of the full covariance, which makes the use of the full state estimation not recommendable, at least for tracks longer than 50 seconds and up to 120 seconds.

From these example scenarios (with a measurement rate of 7 seconds) it seems that short track state estimation is better done with an unweighted position fit (GTDS) but longer tracks can benefit from doing a direct fitting of the observables that includes the range-rate. This last statement is done under the premise of using the estimations as they are obtained from the methods explained in Section 2. That said, notice how the velocity errors in the X and Y directions are of much lower magnitude in the KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT fitting of Figure 15 compared to the GTDS. If the covariance of the estimation is modified to account for the non-linear behavior of the fit in short tracks, it might be a better alternative still, but this is out of the scope of this work. The same could be done with the position covariance, by inflating it slightly in the direction of the bias, to obtain more precise estimations.

Refer to caption
Fig. 12: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT mean values for Radar 1 (rt=7subscript𝑟𝑡7r_{t}=7italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 7 seconds). Each radar track in the scenarios SEN-1A-1, SW-C-1, STARL-1 and STARL-2 is sampled 600 times and the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics of the corresponding method are computed.
Refer to caption
Fig. 13: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT variance values for Radar 1 (rt=7subscript𝑟𝑡7r_{t}=7italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 7 seconds). Each radar track in the scenarios SEN-1A-1, SW-C-1, STARL-1 and STARL-2 is sampled 600 times and the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics of the corresponding method are computed.
Refer to caption
Fig. 14: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT percentage of anomalous estimations for Radar 1 (rt=7subscript𝑟𝑡7r_{t}=7italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 7 seconds). Each radar track in the scenarios SEN-1A-1, SW-C-1, STARL-1 and STARL-2 is sampled 600 times and the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics of the corresponding method are computed.
Refer to caption
Fig. 15: Distribution of the estimated velocity errors (against the real state) for a very short track. Both measurement fits (KEP and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT) show the same behavior when the fitted track is too short (2 to 4 measurements in Radar 1), where the real distribution of the velocity estimation differs from the analytical covariance of the linear least-squares method. This makes the estimated covariance not very realistic.

The results for Radar 2 (measurement rate of 4 seconds) are slightly modified, see figs. 16, 17 and 18. The scenario considered here (SEN-1A-2) includes longer tracks than before, so it shows an extended range of the metric performance as well. The main difference is apparent with the KEP method, which degrades sooner in the velocity aspect, and starts to deviate from the ideal distribution also in position for longer than 120 tracks (same behavior as was shown in Figure 7 for an example track of Radar 3). The combination of all these problems makes the KEP method almost unusable for the whole range of track lengths, at least if the full state metric is considered, see Figure 18. The GTDS shows similar behavior, although the degradation of the metric is exacerbated for tracks of around 90 seconds. Surprisingly, there is a recovery for tracks longer than 120 seconds, which were not present before. This indicates the position-velocity correlations are compatible with the error distribution for very long tracks. Despite that, generalizing this behavior for long single track estimation using GTDS is not a good idea. A separate test with Radar 3 has been performed, showing that this method might not always provide adequate correlations in the full state covariance with very long radar tracks.

With these results it is important to highlight the excellent performance of the KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT throughout (almost) the complete range, only failing in the very short tracks as before, see Figure 18. This method presents itself as the most interesting. It is not only a good estimator in terms of realism of covariance representation, but also with increased accuracy (due to the use of measurement uncertainty in the fitting and the inclusion of range-rate).

Refer to caption
Fig. 16: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT mean values for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds).
Refer to caption
Fig. 17: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT variance values for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds).
Refer to caption
Fig. 18: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT percentage of anomalous estimations for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds).

3.5.2 k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics on OPOD

The scenario SEN-1A-2 has been used again to test the performance of the estimation algorithms, but now including the predicted orbital plane information. In each sampled radar track the information of a propagated initial condition (randomly chosen from the sampling of the I.C) is used to include predicted inclination and RAAN to the fitting. This is only done with the radar observables fitting methods, as the GTDS is unweighted and does not allow for other types of measurement (other than position).

By looking at Figure 19 it is apparent that including the orbital plane information has little effect with the KEP fittings. Only the problematic with very short tracks is solved, but the degradation for longer ones is still present. On the other hand, the KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT method sees its only drawback fixed, and it now behaves more appropriately for all track lengths. It is true that in this case the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT values obtained are lower than expected, which becomes obvious in Figure 21, but a conservative covariance is in general more desirable to avoid false correlations. This is due to the virtual measurements being more consistent than what is indicated by the used value of uncertainty (σi,Ω=5e3subscript𝜎𝑖Ω5𝑒superscript3\sigma_{i,\Omega}=5e-3^{\circ}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 italic_e - 3 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT in all cases), signaling there is room for reducing the estimation uncertainty. As mentioned before the GTDS method results are unchanged (no extra information is added to the fit). One other aspect that has considerably improved and is not present in the k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT statistics is the accuracy of the estimations when compared to the GTDS method. This is not surprising, as the augmented methodology uses range-rate and also orbital plane data to generate a better estimation in all aspects (uncertainty realism included).

Refer to caption
Fig. 19: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT mean values for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds), including the information of the orbital plane with σi,Ω=5e3subscript𝜎𝑖Ω5𝑒superscript3\sigma_{i,\Omega}=5e-3^{\circ}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 italic_e - 3 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT in the KEP and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT methods.
Refer to caption
Fig. 20: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT variance values for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds), including the information of the orbital plane with σi,Ω=5e3subscript𝜎𝑖Ω5𝑒superscript3\sigma_{i,\Omega}=5e-3^{\circ}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 italic_e - 3 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT in the KEP and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT methods.
Refer to caption
Fig. 21: Estimation only k2superscript𝑘2k^{2}italic_k start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT percentage of anomalous estimations for Radar 2 (rt=4subscript𝑟𝑡4r_{t}=4italic_r start_POSTSUBSCRIPT italic_t end_POSTSUBSCRIPT = 4 seconds), including the information of the orbital plane with σi,Ω=5e3subscript𝜎𝑖Ω5𝑒superscript3\sigma_{i,\Omega}=5e-3^{\circ}italic_σ start_POSTSUBSCRIPT italic_i , roman_Ω end_POSTSUBSCRIPT = 5 italic_e - 3 start_POSTSUPERSCRIPT ∘ end_POSTSUPERSCRIPT in the KEP and KEP+J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT methods.

4 Conclusions

This work has introduced a novel approach to initial orbit determination, utilizing data sourced from a single radar track and combining it with the predicted orbital plane of the object. Emphasizing the imperative need for rapid algorithms in operational scenarios, this study focuses on the development of a least-squares fitting procedure. The procedure incorporates an analytically formulated approximation of dynamics under the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation, specifically designed for short-term propagation. Noteworthy for its inclusion of range-rate observables, the algorithm distinguishes itself from similar methods. A comprehensive evaluation is conducted through a series of synthetic tests, comparing its performance against a classical range and angles fitting method (GTDS). This investigation explores the impact of track length and measurement density on full state estimation.

When using data from a single radar, doing a proper full state estimation does not work as intended if the fitting is done using the radar observables directly, at least if Keplerian dynamics are used. The magnitude of the errors of this simple model is in fact high enough that precise range measurements become incompatible. A trajectory that meets the uncertainty imposed by the range and range-rate measurements tends to deviate from the real one when the the perpendicular constrains are much more imprecise, at least if the track is long enough. Solving this is a matter of improving the fidelity of the fitting dynamics by just including the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT perturbation. This has been accomplished while maintaining the fully analytical aspect of the methodology. The result is a very fast IOD method applicabe to maneuver detection, or simply find correlations between cataloged objects and track as an extended, more general application.

It has been shown that the proposed method behaves as expected for tracks longer than 40 seconds, especially when the density of data is high. There is still a problem for shorter arcs, where the non-linear relation between the estimate and the radar observables seems to affect the velocity part of the estimation in a non-negligible way. Some kind of covariance inflation post-process could be applied to the uncertainty output in order to leverage the estimation. While not pursued in this study, this aspect is currently under investigation.

Although it has more limited applications, the method developed here admits the inclusion of chosen parts of the predicted state as virtual measurements. Given that the orbital plane is less susceptible to changes in LEO (high ΔVΔ𝑉\Delta Vroman_Δ italic_V cost) and integration windows are short enough, it has been shown that the level of precision for the predicted i𝑖iitalic_i and ΩΩ\Omegaroman_Ω justify including them in the estimation process. The resulting method, denoted as OPOD, shows improved accuracy and final reliability for all track lengths. This method in particular shows promise for its application to maneuver detection metrics, which is the next step of the process and will be the subject of a future publication.

The analytical time derivatives of the GEqOE equations of motion developed for this work could be employed in an enhanced numerical propagator that makes use of higher order derivatives. This could be leveraged to improve its accuracy at each integration step, thus reducing the total number of steps needed for a given propagation length and tolerance. This is certainly an interesting line of research that is being pursued at the moment as an extended application of the work presented here.

Acknowledgments

Jose M. Montilla acknowledges the support from Universidad de Sevilla under VI PPIT-US. Special thanks are due to Guillermo Escribano for his help in develo** the ideas and methods in this work.

During the preparation of this work the author(s) used ChatGPT in order to revise and correct grammar and refine the language. After using this tool/service, the authors reviewed and edited the content as needed and take full responsibility for the content of the publication.

References

  • Amato et al. [2019] Amato, D., Bombardelli, C., Baù, G. et al. (2019). Non-averaged regularized formulations as an alternative to semi-analytical orbit propagation methods. Celestial Mechanics and Dynamical Astronomy, 131, 1–38.
  • Armellin & Di Lizia [2018] Armellin, R., & Di Lizia, P. (2018). Probabilistic optical and radar initial orbit determination. Journal of Guidance, Control, and Dynamics, 41(1), 101–118.
  • Armellin et al. [2016] Armellin, R., Di Lizia, P., & Zanetti, R. (2016). Dealing with uncertainties in angles-only initial orbit determination. Celestial Mechanics and Dynamical Astronomy, 125, 435–450.
  • Baù et al. [2021] Baù, G., Hernando-Ayuso, J., & Bombardelli, C. (2021). A generalization of the equinoctial orbital elements. Celestial Mechanics and Dynamical Astronomy, 133, 1–29.
  • Broucke & Cefola [1972] Broucke, R. A., & Cefola, P. J. (1972). On the equinoctial orbit elements. Celestial mechanics, 5(3), 303–310.
  • Bruinsma et al. [2003] Bruinsma, S., Thuillier, G., & Barlier, F. (2003). The DTM-2000 empirical thermosphere model with new data assimilation and constraints at lower boundary: accuracy and properties. Journal of atmospheric and solar-terrestrial physics, 65(9), 1053–1070.
  • Cano et al. [2023] Cano, A., Pastor, A., Escobar, D. et al. (2023). Covariance determination for improving uncertainty realism in orbit determination and propagation. Advances in Space Research, 72(7), 2759–2777.
  • DeMars et al. [2012] DeMars, K. J., Jah, M. K., & Schumacher, P. W. (2012). Initial orbit determination using short-arc angle and angle rate data. IEEE Transactions on Aerospace and Electronic Systems, 48(3), 2628–2637.
  • ESA [2023] ESA (2023). ESA’s space environment report 2023. URL: https://www.esa.int/Space_Safety/ESA_s_Space_Environment_Report_2023 accessed: 2024-01-10.
  • Escobal [1970] Escobal, P. (1970). Methods of orbit determination. Methods of orbit determination, .
  • Goff [2015] Goff, G. M. (2015). Orbit Estimation of Non-Cooperative Maneuvering Spacecraft. Ph.D. thesis Air Force Institute of Technology. URL: https://scholar.afit.edu/etd/202/.
  • Gomez et al. [2019] Gomez, R., Salmerón, J. M.-V., Besso, P. et al. (2019). Initial operations of the breakthrough Spanish Space Surveillance and Tracking Radar (S3TSR) in the European context. In 1st ESA NEO and Debris Detection Conference. Presented paper. Darmstadt, Germany. URL: https://conference.sdo.esoc.esa.int/proceedings/neosst1/paper/479.
  • Gooding [1993] Gooding, R. (1993). A new procedure for orbit determination based on three lines of sight (angles only). Defence Research Agency Farnborough, UK.
  • Hatten & Russell [2017] Hatten, N., & Russell, R. P. (2017). A smooth and robust Harris-Priester atmospheric density model for low Earth orbit applications. Advances in Space Research, 59(2), 571–586.
  • Hawking [2004] Hawking, S. (2004). The Illustrated on the shoulders of giants. Running Press.
  • Hernández et al. [2021] Hernández, C. P., Prada, M. A. R., Alessandrini, M. et al. (2021). Operational review and analysis of the S3T surveillance radar. In Proceedings of the 8th European Conference on Space Debris, ESA Space Debris Office, Darmstadt, Germany. volume 20.
  • Hernando-Ayuso et al. [2023] Hernando-Ayuso, J., Bombardelli, C., Baù, G. et al. (2023). Near-linear orbit uncertainty propagation using the generalized equinoctial orbital elements. Journal of Guidance, Control, and Dynamics, 46(4), 654–665.
  • Huang et al. [2021] Huang, J., Lei, X., Zhao, G. et al. (2021). Short-arc association and orbit determination for new geo objects with space-based optical surveillance. Aerospace, 8(10), 298.
  • Julier & Uhlmann [1997] Julier, S. J., & Uhlmann, J. K. (1997). New extension of the Kalman filter to nonlinear systems. In Signal processing, sensor fusion, and target recognition VI (pp. 182–193). Spie volume 3068.
  • Long et al. [1989] Long, A. C., Cappellari Jr, J., Velez, C. et al. (1989). Goddard trajectory determination system (GTDS) mathematical theory (revision 1). National Aeronautics and Space Administration/Goddard Space Flight Center, FDD/552-89/001 and CSC/TR-89/6001, .
  • Maisonobe et al. [2010] Maisonobe, L., Pommier, V., & Parraud, P. (2010). Orekit: An open source library for operational flight dynamics applications. In 4th international conference on astrodynamics tools and techniques (pp. 3–6). European Space Agency Paris.
  • Martinusi et al. [2015] Martinusi, V., Dell’Elce, L., & Kerschen, G. (2015). Analytic propagation of near-circular satellite orbits in the atmosphere of an oblate planet. Celestial Mechanics and Dynamical Astronomy, 123, 85–103.
  • Montilla et al. [2023a] Montilla, J. M., Sanchez, J. C., Vazquez, R. et al. (2023a). Manoeuvre detection in low earth orbit with radar data. Advances in Space Research, 72(7), 2689–2709.
  • Montilla et al. [2023b] Montilla, J. M., Vazquez, R., & Di Lizia, P. (2023b). Mixture-based cost metrics for maneuver detection using radar track data. In 33rd AAS/AIAA Space Flight Mechanics Meeting AAS 23-267 (pp. 1–16).
  • Pastor et al. [2021] Pastor, A., Sanjurjo-Rivo, M., & Escobar, D. (2021). Initial orbit determination methods for track-to-track association. Advances in Space Research, 68(7), 2677–2694.
  • Picone et al. [2002] Picone, J., Hedin, A., Drob, D. P. et al. (2002). NRLMSISE-00 empirical model of the atmosphere: Statistical comparisons and scientific issues. Journal of Geophysical Research: Space Physics, 107(A12), SIA–15.
  • Psiaki [2022] Psiaki, M. L. (2022). Gaussian mixture filter for angles-only orbit determination in modified equinoctial elements. Journal of Guidance, Control, and Dynamics, 45(1), 73–83.
  • Reihs et al. [2021] Reihs, B., Vananti, A., Schildknecht, T. et al. (2021). Application of attributables to the correlation of surveillance radar measurements. Acta astronautica, 182, 399–415.
  • Schutz et al. [2004] Schutz, B., Tapley, B., & Born, G. H. (2004). Statistical orbit determination. Elsevier.
  • Shang et al. [2018] Shang, H., Chen, D., Cao, H. et al. (2018). Initial orbit determination using very short arc data based on double-station observation. IEEE Transactions on Aerospace and Electronic Systems, 55(4), 1596–1611.
  • Siminski [2016] Siminski, J. (2016). Techniques for assessing space object cataloguing performance during design of surveillance systems. In 6th International Conference on Astrodynamics Tools and Techniques (ICATT) (pp. 14–17).
  • Vallado [2001] Vallado, D. A. (2001). Fundamentals of astrodynamics and applications volume 12. Springer Science & Business Media.
  • Vallado & Carter [1998] Vallado, D. A., & Carter, S. S. (1998). Accurate orbit determination from short-arc dense observational data. The Journal of the astronautical sciences, 46, 195–213.
  • Van Der Merwe [2004] Van Der Merwe, R. (2004). Sigma-point Kalman filters for probabilistic inference in dynamic state-space models. Oregon Health & Science University.
  • Zhang et al. [2019] Zhang, S., Fu, T., Chen, D. et al. (2019). An initial orbit determination method using single-site very short arc radar observations. IEEE Transactions on Aerospace and Electronic Systems, 56(3), 1856–1872.

Appendix A Auxiliary functions

A.1 Radar measurement function derivatives

The measurements provided by the radar in LEO are range (ρ𝜌\rhoitalic_ρ), azimuth (Az𝐴𝑧Azitalic_A italic_z), elevation (el𝑒𝑙elitalic_e italic_l) and range-rate (ρ˙˙𝜌\dot{\rho}over˙ start_ARG italic_ρ end_ARG). The observation function [ρ,Az,el,ρ˙]=h(𝒚,t)𝜌𝐴𝑧𝑒𝑙˙𝜌𝒚𝑡\left[\rho,{Az},{el},\dot{\rho}\right]=h(\bm{y},t)[ italic_ρ , italic_A italic_z , italic_e italic_l , over˙ start_ARG italic_ρ end_ARG ] = italic_h ( bold_italic_y , italic_t ) of these observables is in Equation (10). The fitting algorithms in Sections 2.4 and 2.5 require the derivatives of these measurements with respect to position (𝒓𝒓\bm{r}bold_italic_r) and velocity (𝒗𝒗\bm{v}bold_italic_v), denoted as h/𝒚𝒚\partial h/\partial\bm{y}∂ italic_h / ∂ bold_italic_y, see Equation (27).

h𝒚=[ρ𝒓ρ𝒗Az𝒓Az𝒗el𝒓el𝒗ρ˙𝒓ρ˙𝒗]𝒚matrixsubscript𝜌𝒓subscript𝜌𝒗𝐴subscript𝑧𝒓𝐴subscript𝑧𝒗𝑒subscript𝑙𝒓𝑒subscript𝑙𝒗subscript˙𝜌𝒓subscript˙𝜌𝒗\displaystyle\frac{\partial h}{\partial\bm{y}}=\begin{bmatrix}\rho_{\bm{r}}&% \rho_{\bm{v}}\\ Az_{\bm{r}}&Az_{\bm{v}}\\ {el}_{\bm{r}}&{el}_{\bm{v}}\\ \dot{\rho}_{\bm{r}}&\dot{\rho}_{\bm{v}}\end{bmatrix}divide start_ARG ∂ italic_h end_ARG start_ARG ∂ bold_italic_y end_ARG = [ start_ARG start_ROW start_CELL italic_ρ start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT end_CELL start_CELL italic_ρ start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL italic_A italic_z start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT end_CELL start_CELL italic_A italic_z start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL italic_e italic_l start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT end_CELL start_CELL italic_e italic_l start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT end_CELL end_ROW start_ROW start_CELL over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT end_CELL start_CELL over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT end_CELL end_ROW end_ARG ] (27)

The explicit functions of these derivatives are in Equation (28), which requires the knowledge of radar inertial position (𝑷Rsubscript𝑷𝑅\bm{P}_{R}bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT), velocity (𝑽Rsubscript𝑽𝑅\bm{V}_{R}bold_italic_V start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT) and orientation (TIRsuperscriptsubscriptT𝐼𝑅\text{T}_{I}^{R}T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT). Note that 𝝆=𝒓𝑷R𝝆𝒓subscript𝑷𝑅\bm{\rho}=\bm{r}-\bm{P}_{R}bold_italic_ρ = bold_italic_r - bold_italic_P start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT and 𝒖=𝒗𝑽R𝒖𝒗subscript𝑽𝑅\bm{u}=\bm{v}-\bm{V}_{R}bold_italic_u = bold_italic_v - bold_italic_V start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT.

ρ𝒓subscript𝜌𝒓\displaystyle\rho_{\bm{r}}italic_ρ start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT =𝝆ρ,absentsuperscript𝝆𝜌\displaystyle=\frac{\bm{\rho}^{\intercal}}{\rho},= divide start_ARG bold_italic_ρ start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT end_ARG start_ARG italic_ρ end_ARG , ρ𝒗subscript𝜌𝒗\displaystyle\rho_{\bm{v}}italic_ρ start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT =𝟎,absentsuperscript0\displaystyle=\bm{0}^{\intercal},= bold_0 start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT , (28)
Az𝒓𝐴subscript𝑧𝒓\displaystyle Az_{\bm{r}}italic_A italic_z start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT =11+tan2(Az)[𝒆1tan(Az)𝒆2]TIR𝒆2𝝆R,\displaystyle=\frac{1}{1+\tan^{2}(Az)}\left[\bm{e}_{1}^{\intercal}-\tan{(Az)}% \bm{e}_{2}^{\intercal}\right]\frac{\text{T}_{I}^{R}}{\bm{e}_{2}^{\intercal}\bm% {\rho}\rfloor_{R}},= divide start_ARG 1 end_ARG start_ARG 1 + roman_tan start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_A italic_z ) end_ARG [ bold_italic_e start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT - roman_tan ( italic_A italic_z ) bold_italic_e start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ] divide start_ARG T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT end_ARG start_ARG bold_italic_e start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT bold_italic_ρ ⌋ start_POSTSUBSCRIPT italic_R end_POSTSUBSCRIPT end_ARG , Az𝒗𝐴subscript𝑧𝒗\displaystyle Az_{\bm{v}}italic_A italic_z start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT =𝟎,absentsuperscript0\displaystyle=\bm{0}^{\intercal},= bold_0 start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ,
el𝒓𝑒subscript𝑙𝒓\displaystyle{el}_{\bm{r}}italic_e italic_l start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT =11sin2(el)[𝒆3TIRsin(el)ρ𝒓]1ρ,absent11superscript2𝑒𝑙delimited-[]superscriptsubscript𝒆3superscriptsubscriptT𝐼𝑅𝑒𝑙subscript𝜌𝒓1𝜌\displaystyle=\frac{1}{\sqrt{1-\sin^{2}(el)}}\left[\bm{e}_{3}^{\intercal}\text% {T}_{I}^{R}-\sin{(el)}\rho_{\bm{r}}\right]\frac{1}{\rho},= divide start_ARG 1 end_ARG start_ARG square-root start_ARG 1 - roman_sin start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_e italic_l ) end_ARG end_ARG [ bold_italic_e start_POSTSUBSCRIPT 3 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT T start_POSTSUBSCRIPT italic_I end_POSTSUBSCRIPT start_POSTSUPERSCRIPT italic_R end_POSTSUPERSCRIPT - roman_sin ( italic_e italic_l ) italic_ρ start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT ] divide start_ARG 1 end_ARG start_ARG italic_ρ end_ARG , el𝒗𝑒subscript𝑙𝒗\displaystyle{el}_{\bm{v}}italic_e italic_l start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT =𝟎,absentsuperscript0\displaystyle=\bm{0}^{\intercal},= bold_0 start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ,
ρ˙𝒓subscript˙𝜌𝒓\displaystyle\dot{\rho}_{\bm{r}}over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT =(𝒖ρ˙ρ𝒓)1ρ,absent𝒖˙𝜌subscript𝜌𝒓1𝜌\displaystyle=(\bm{u}-\dot{\rho}\rho_{\bm{r}})\frac{1}{\rho},= ( bold_italic_u - over˙ start_ARG italic_ρ end_ARG italic_ρ start_POSTSUBSCRIPT bold_italic_r end_POSTSUBSCRIPT ) divide start_ARG 1 end_ARG start_ARG italic_ρ end_ARG , ρ˙𝒗subscript˙𝜌𝒗\displaystyle\dot{\rho}_{\bm{v}}over˙ start_ARG italic_ρ end_ARG start_POSTSUBSCRIPT bold_italic_v end_POSTSUBSCRIPT =𝝆ρ.absent𝝆𝜌\displaystyle=\frac{\bm{\rho}}{\rho}.= divide start_ARG bold_italic_ρ end_ARG start_ARG italic_ρ end_ARG .

A.2 Time derivatives of the inverse function

In Section 2.5 the linear least-squares algorithm is particularized to a dynamical model that includes the J2 perturbation. This is done by utilizing the GEqOE from Baù et al. [2021], for which a Taylor expansion has been developed in order to maintain the analytical aspect of the fitting method. The expansion's coefficients are fully developed in the A.4, where there is an intensive use of the inverse function 𝒻s=1ssubscript𝒻𝑠1𝑠\mathscr{f}_{s}=\frac{1}{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG italic_s end_ARG as well as its time derivatives, included here for completeness.

𝒻˙s=s˙s2,𝒻¨s= 2s˙2s3s¨s2,𝒻s= 6s¨s˙s3s˙˙˙s26s˙3s4,𝒻(4)s= 8s(3)s˙s3+6s¨2s336s˙2s¨s4s(4)s224s˙4s5.formulae-sequencesubscript˙𝒻𝑠˙𝑠superscript𝑠2formulae-sequencesubscript¨𝒻𝑠2superscript˙𝑠2superscript𝑠3¨𝑠superscript𝑠2formulae-sequencesubscript𝒻𝑠6¨𝑠˙𝑠superscript𝑠3˙˙˙𝑠superscript𝑠26superscript˙𝑠3superscript𝑠4subscript4𝒻𝑠83𝑠˙𝑠superscript𝑠36superscript¨𝑠2superscript𝑠336superscript˙𝑠2¨𝑠superscript𝑠44𝑠superscript𝑠224superscript˙𝑠4superscript𝑠5\begin{split}\dot{\mathscr{f}}_{s}=&-\frac{\dot{s}}{s^{2}},\\ \ddot{\mathscr{f}}_{s}=&\,2\frac{\dot{s}^{2}}{s^{3}}-\frac{\ddot{s}}{s^{2}},\\ \overset{\dots}{\mathscr{f}}_{s}=&\,6\frac{\ddot{s}\dot{s}}{s^{3}}-\frac{% \dddot{s}}{s^{2}}-6\frac{\dot{s}^{3}}{s^{4}},\\ \overset{\scriptscriptstyle(4)}{\mathscr{f}}_{s}=&\,8\frac{\overset{% \scriptscriptstyle(3)}{s}\dot{s}}{s^{3}}+6\frac{\ddot{s}^{2}}{s^{3}}-36\frac{% \dot{s}^{2}\ddot{s}}{s^{4}}-\frac{\overset{\scriptscriptstyle(4)}{s}}{s^{2}}-2% 4\frac{\dot{s}^{4}}{s^{5}}.\end{split}start_ROW start_CELL over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL - divide start_ARG over˙ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG , end_CELL end_ROW start_ROW start_CELL over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 2 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - divide start_ARG over¨ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG , end_CELL end_ROW start_ROW start_CELL over… start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 6 divide start_ARG over¨ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - divide start_ARG over˙˙˙ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG - 6 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG , end_CELL end_ROW start_ROW start_CELL start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 8 divide start_ARG start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG + 6 divide start_ARG over¨ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - 36 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG - divide start_ARG start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG - 24 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 5 end_POSTSUPERSCRIPT end_ARG . end_CELL end_ROW (29)

A.3 Time derivatives of the function of s𝑠sitalic_s times s˙˙𝑠\dot{s}over˙ start_ARG italic_s end_ARG

As with the inverse function in the A.2, the function that multiplies s𝑠sitalic_s by its time derivative s˙˙𝑠\dot{s}over˙ start_ARG italic_s end_ARG, s=ss˙subscript𝑠𝑠˙𝑠\mathscr{g}_{s}=s\dot{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = italic_s over˙ start_ARG italic_s end_ARG, is repeatedly used in the derivation of the J2 Taylor propagator, see the A.4. The time derivatives of ssubscript𝑠\mathscr{g}_{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT have been included here.

˙s=s˙2+ss¨,¨s= 3s˙s¨+ss˙˙˙s= 3s¨2+4s˙s(3)+ss(4),(4)s= 10s¨s(3)+5s˙s(4)+ss(5).formulae-sequenceformulae-sequencesubscript˙𝑠superscript˙𝑠2𝑠¨𝑠subscript¨𝑠3˙𝑠¨𝑠𝑠˙˙˙𝑠subscript𝑠3superscript¨𝑠24˙𝑠3𝑠𝑠4𝑠subscript4𝑠10¨𝑠3𝑠5˙𝑠4𝑠𝑠5𝑠\begin{split}\dot{\mathscr{g}}_{s}=&\,\dot{s}^{2}+s\ddot{s},\\ \ddot{\mathscr{g}}_{s}=&\,3\dot{s}\ddot{s}+s\dddot{s}\\ \overset{\dots}{\mathscr{g}}_{s}=&\,3\ddot{s}^{2}+4\dot{s}\overset{% \scriptscriptstyle(3)}{s}+s\overset{\scriptscriptstyle(4)}{s},\\ \overset{\scriptscriptstyle(4)}{\mathscr{g}}_{s}=&\,10\ddot{s}\overset{% \scriptscriptstyle(3)}{s}+5\dot{s}\overset{\scriptscriptstyle(4)}{s}+s\overset% {\scriptscriptstyle(5)}{s}.\end{split}start_ROW start_CELL over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_s over¨ start_ARG italic_s end_ARG , end_CELL end_ROW start_ROW start_CELL over¨ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 3 over˙ start_ARG italic_s end_ARG over¨ start_ARG italic_s end_ARG + italic_s over˙˙˙ start_ARG italic_s end_ARG end_CELL end_ROW start_ROW start_CELL over… start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 3 over¨ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + 4 over˙ start_ARG italic_s end_ARG start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG + italic_s start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG , end_CELL end_ROW start_ROW start_CELL start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = end_CELL start_CELL 10 over¨ start_ARG italic_s end_ARG start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG + 5 over˙ start_ARG italic_s end_ARG start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG + italic_s start_OVERACCENT ( 5 ) end_OVERACCENT start_ARG italic_s end_ARG . end_CELL end_ROW (30)

A.4 Time derivatives of the J2subscriptJ2\text{J}_{2}J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT GEqOE equations of motion

In order to obtain an efficient propagator with J2 perturbation this work develops a Taylor expansion of the solution expressed in terms of GEqOE [Baù et al., 2021]. This is done in a systematic way by first simplifying the expressions of the equations of motion (first order derivatives) in a more compact form, see Equation (23). The resulting equations only have multiplying elements thanks to the use of the inverse function, see the A.2. This section includes the time derivatives of Eq. (23) up to fourth order. All the simplifications that have been applied are first defined in the A.4.1, allowing for a systematic application of the chain rule in the derivation. From A.4.1 to A.4.3 all the steps for the computation of the Taylor J2 propagator coefficients are included.

A.4.1 Second order derivatives

The second order time derivatives of the GEqOE can be computed with Equation (31).

ν¨¨𝜈\displaystyle\ddot{\nu}over¨ start_ARG italic_ν end_ARG =0,absent0\displaystyle=0,= 0 , q¨1subscript¨𝑞1\displaystyle\ddot{q}_{1}over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =I˙𝓈LI𝓈˙L,absent˙𝐼subscript𝓈𝐿𝐼subscript˙𝓈𝐿\displaystyle=-\dot{I}\mathscr{s}_{L}-I\dot{\mathscr{s}}_{L},= - over˙ start_ARG italic_I end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , (31)
p¨1subscript¨𝑝1\displaystyle\ddot{p}_{1}over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =p˙2(𝒹wh)+p2(𝒹˙w˙h)(𝒻˙cξ1+𝒻cξ˙1)𝒰𝒻cξ1𝒰˙,absentsubscript˙𝑝2𝒹subscript𝑤subscript𝑝2˙𝒹subscript˙𝑤subscript˙𝒻𝑐subscript𝜉1subscript𝒻𝑐subscript˙𝜉1𝒰subscript𝒻𝑐subscript𝜉1˙𝒰\displaystyle=\dot{p}_{2}\left(\mathscr{d}-w_{h}\right)+p_{2}\left(\dot{% \mathscr{d}}-\dot{w}_{h}\right)-\left(\dot{\mathscr{f}}_{c}\xi_{1}+\mathscr{f}% _{c}\dot{\xi}_{1}\right)\mathscr{U}-\mathscr{f}_{c}\xi_{1}\dot{\mathscr{U}},= over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( script_d - italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over˙ start_ARG script_d end_ARG - over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) - ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) script_U - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG script_U end_ARG , q¨2subscript¨𝑞2\displaystyle\ddot{q}_{2}over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =I˙𝒸LI𝒸˙L,absent˙𝐼subscript𝒸𝐿𝐼subscript˙𝒸𝐿\displaystyle=-\dot{I}\mathscr{c}_{L}-I\dot{\mathscr{c}}_{L},= - over˙ start_ARG italic_I end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT ,
p¨2subscript¨𝑝2\displaystyle\ddot{p}_{2}over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =p˙1(wh𝒹)+p1(w˙h𝒹˙)+(𝒻˙cξ2+𝒻cξ˙2)𝒰+𝒻cξ1𝒰˙,absentsubscript˙𝑝1subscript𝑤𝒹subscript𝑝1subscript˙𝑤˙𝒹subscript˙𝒻𝑐subscript𝜉2subscript𝒻𝑐subscript˙𝜉2𝒰subscript𝒻𝑐subscript𝜉1˙𝒰\displaystyle=\dot{p}_{1}\left(w_{h}-\mathscr{d}\right)+p_{1}\left(\dot{w}_{h}% -\dot{\mathscr{d}}\right)+\left(\dot{\mathscr{f}}_{c}\xi_{2}+\mathscr{f}_{c}% \dot{\xi}_{2}\right)\mathscr{U}+\mathscr{f}_{c}\xi_{1}\dot{\mathscr{U}},= over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - script_d ) + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over˙ start_ARG script_d end_ARG ) + ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) script_U + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG script_U end_ARG , ¨¨\displaystyle\ddot{\mathcal{L}}over¨ start_ARG caligraphic_L end_ARG =𝒹˙w˙h(𝒻˙cΓ+𝒻cΓ˙)𝒰𝒻cΓ𝒰˙.absent˙𝒹subscript˙𝑤subscript˙𝒻𝑐Γsubscript𝒻𝑐˙Γ𝒰subscript𝒻𝑐Γ˙𝒰\displaystyle=\dot{\mathscr{d}}-\dot{w}_{h}-\left(\dot{\mathscr{f}}_{c}\Gamma+% \mathscr{f}_{c}\dot{\Gamma}\right)\mathscr{U}-\mathscr{f}_{c}\Gamma\dot{% \mathscr{U}}.= over˙ start_ARG script_d end_ARG - over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG ) script_U - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ over˙ start_ARG script_U end_ARG .

All the elements that appear in Eq. (31) are computed with the following formulation. Equation (32) computes the first time derivative of z^^𝑧\hat{z}over^ start_ARG italic_z end_ARG, where 𝒻˙𝒟subscript˙𝒻𝒟\dot{\mathscr{f}}_{\mathcal{D}}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT is calculated from 𝒟˙˙𝒟\dot{\mathcal{D}}over˙ start_ARG caligraphic_D end_ARG.

z^^𝑧\displaystyle\hat{z}over^ start_ARG italic_z end_ARG =2(Yq2Xq1)r(1+q12+q22)=𝒞𝒟=𝒞𝒻𝒟,absent2𝑌subscript𝑞2𝑋subscript𝑞1𝑟1superscriptsubscript𝑞12superscriptsubscript𝑞22𝒞𝒟𝒞subscript𝒻𝒟\displaystyle=\frac{2\left(Yq_{2}-Xq_{1}\right)}{r(1+q_{1}^{2}+q_{2}^{2})}=% \frac{\mathcal{C}}{\mathcal{D}}=\mathcal{C}\mathscr{f}_{\mathcal{D}},= divide start_ARG 2 ( italic_Y italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - italic_X italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) end_ARG start_ARG italic_r ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG = divide start_ARG caligraphic_C end_ARG start_ARG caligraphic_D end_ARG = caligraphic_C script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , z^˙˙^𝑧\displaystyle\dot{\hat{z}}over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG =𝒞˙𝒻𝒟+𝒞𝒻˙𝒟,absent˙𝒞subscript𝒻𝒟𝒞subscript˙𝒻𝒟\displaystyle=\dot{\mathcal{C}}\mathscr{f}_{\mathcal{D}}+\mathcal{C}\dot{% \mathscr{f}}_{\mathcal{D}},= over˙ start_ARG caligraphic_C end_ARG script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + caligraphic_C over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , (32)
𝒞𝒞\displaystyle\mathcal{C}caligraphic_C =2(Yq2Xq1),absent2𝑌subscript𝑞2𝑋subscript𝑞1\displaystyle=2\left(Yq_{2}-Xq_{1}\right),= 2 ( italic_Y italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - italic_X italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) , 𝒞˙˙𝒞\displaystyle\dot{\mathcal{C}}over˙ start_ARG caligraphic_C end_ARG =2(Y˙q2+Yq˙2X˙q1Xq˙1),absent2˙𝑌subscript𝑞2𝑌subscript˙𝑞2˙𝑋subscript𝑞1𝑋subscript˙𝑞1\displaystyle=2\left(\dot{Y}q_{2}+Y\dot{q}_{2}-\dot{X}q_{1}-X\dot{q}_{1}\right),= 2 ( over˙ start_ARG italic_Y end_ARG italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_Y over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - over˙ start_ARG italic_X end_ARG italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - italic_X over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) ,
𝒟𝒟\displaystyle\mathcal{D}caligraphic_D =r(1+q12+q22)=rqs,absent𝑟1superscriptsubscript𝑞12superscriptsubscript𝑞22𝑟subscript𝑞𝑠\displaystyle=r(1+q_{1}^{2}+q_{2}^{2})=rq_{s},= italic_r ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) = italic_r italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT , 𝒟˙˙𝒟\displaystyle\dot{\mathcal{D}}over˙ start_ARG caligraphic_D end_ARG =r˙qs+rq˙sabsent˙𝑟subscript𝑞𝑠𝑟subscript˙𝑞𝑠\displaystyle=\dot{r}q_{s}+r\dot{q}_{s}= over˙ start_ARG italic_r end_ARG italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + italic_r over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT
qssubscript𝑞𝑠\displaystyle q_{s}italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =(1+q12+q22),absent1superscriptsubscript𝑞12superscriptsubscript𝑞22\displaystyle=(1+q_{1}^{2}+q_{2}^{2}),= ( 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) , q˙ssubscript˙𝑞𝑠\displaystyle\dot{q}_{s}over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(q1q˙1+q2q˙2).absent2subscript𝑞1subscript˙𝑞1subscript𝑞2subscript˙𝑞2\displaystyle=2\left(q_{1}\dot{q}_{1}+q_{2}\dot{q}_{2}\right).= 2 ( italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

Equation (33) computes the first time derivative of 𝒰𝒰\mathscr{U}script_U and Uzsubscript𝑈𝑧U_{z}italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT.

𝒰𝒰\displaystyle\mathscr{U}script_U =Ar3(13z^2)=AUz𝒻r3,absent𝐴superscript𝑟313superscript^𝑧2𝐴subscript𝑈𝑧subscript𝒻superscript𝑟3\displaystyle=-\frac{A}{r^{3}}(1-3\hat{z}^{2})=-AU_{z}\mathscr{f}_{r^{3}},= - divide start_ARG italic_A end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG ( 1 - 3 over^ start_ARG italic_z end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) = - italic_A italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT , 𝒰˙˙𝒰\displaystyle\dot{\mathscr{U}}over˙ start_ARG script_U end_ARG =A(U˙z𝒻r3+Uz𝒻˙r3),absent𝐴subscript˙𝑈𝑧subscript𝒻superscript𝑟3subscript𝑈𝑧subscript˙𝒻superscript𝑟3\displaystyle=-A\left(\dot{U}_{z}\mathscr{f}_{r^{3}}+U_{z}\dot{\mathscr{f}}_{r% ^{3}}\right),= - italic_A ( over˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT ) , (33)
Uzsubscript𝑈𝑧\displaystyle U_{z}italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT =(13z^2),absent13superscript^𝑧2\displaystyle=(1-3\hat{z}^{2}),= ( 1 - 3 over^ start_ARG italic_z end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) , U˙zsubscript˙𝑈𝑧\displaystyle\dot{U}_{z}over˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT =6z^z^˙.absent6^𝑧˙^𝑧\displaystyle=-6\hat{z}\dot{\hat{z}}.= - 6 over^ start_ARG italic_z end_ARG over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG .

The value 𝒻˙r3subscript˙𝒻superscript𝑟3\dot{\mathscr{f}}_{r^{3}}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT in Eq. (33) is computed from the derivative of r3superscript𝑟3r^{3}italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT in Equation (34)

d(r3)dt=r˙c=3r2r˙.𝑑superscript𝑟3𝑑𝑡subscript˙𝑟𝑐3superscript𝑟2˙𝑟\frac{d(r^{3})}{dt}=\dot{r}_{c}=3r^{2}\dot{r}.\\ divide start_ARG italic_d ( italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t end_ARG = over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT = 3 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙ start_ARG italic_r end_ARG . (34)

Equation (35) includes the derivative of ΓΓ\Gammaroman_Γ and β𝛽\betaitalic_β, which in turn allows to compute 𝒻˙1+βsubscript˙𝒻1𝛽\dot{\mathscr{f}}_{1+\beta}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT, 𝒻˙βsubscript˙𝒻𝛽\dot{\mathscr{f}}_{\beta}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT and 𝒻˙αsubscript˙𝒻𝛼\dot{\mathscr{f}}_{\alpha}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT.

ΓΓ\displaystyle\Gammaroman_Γ =𝒻α+α(1r/a),absentsubscript𝒻𝛼𝛼1𝑟𝑎\displaystyle=\mathscr{f}_{\alpha}+\alpha\left(1-r/a\right),= script_f start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT + italic_α ( 1 - italic_r / italic_a ) , Γ˙˙Γ\displaystyle\dot{\Gamma}over˙ start_ARG roman_Γ end_ARG =𝒻˙α+α˙(1ra)αr˙a,absentsubscript˙𝒻𝛼˙𝛼1𝑟𝑎𝛼˙𝑟𝑎\displaystyle=\dot{\mathscr{f}}_{\alpha}+\dot{\alpha}\left(1-\frac{r}{a}\right% )-\alpha\frac{\dot{r}}{a},= over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT + over˙ start_ARG italic_α end_ARG ( 1 - divide start_ARG italic_r end_ARG start_ARG italic_a end_ARG ) - italic_α divide start_ARG over˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG , (35)
α𝛼\displaystyle\alphaitalic_α =11+β=𝒻1+β,absent11𝛽subscript𝒻1𝛽\displaystyle=\frac{1}{1+\beta}=\mathscr{f}_{1+\beta},= divide start_ARG 1 end_ARG start_ARG 1 + italic_β end_ARG = script_f start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT , α˙˙𝛼\displaystyle\dot{\alpha}over˙ start_ARG italic_α end_ARG =𝒻˙1+β,absentsubscript˙𝒻1𝛽\displaystyle=\dot{\mathscr{f}}_{1+\beta},= over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT ,
β𝛽\displaystyle\betaitalic_β =1p12p22,absent1𝑝superscript12superscriptsubscript𝑝22\displaystyle=\sqrt{1-p1^{2}-p_{2}^{2}},= square-root start_ARG 1 - italic_p 1 start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG , β˙˙𝛽\displaystyle\dot{\beta}over˙ start_ARG italic_β end_ARG =p˙s2β=12p˙s𝒻β,absentsubscript˙𝑝𝑠2𝛽12subscript˙𝑝𝑠subscript𝒻𝛽\displaystyle=\frac{-\dot{p}_{s}}{2\beta}=-\frac{1}{2}\dot{p}_{s}\mathscr{f}_{% \beta},= divide start_ARG - over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG 2 italic_β end_ARG = - divide start_ARG 1 end_ARG start_ARG 2 end_ARG over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT ,
pssubscript𝑝𝑠\displaystyle p_{s}italic_p start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =1+p12+p22,absent1superscriptsubscript𝑝12superscriptsubscript𝑝22\displaystyle=1+p_{1}^{2}+p_{2}^{2},= 1 + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , p˙ssubscript˙𝑝𝑠\displaystyle\dot{p}_{s}over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(p1p˙1+p2p˙2).absent2subscript𝑝1subscript˙𝑝1subscript𝑝2subscript˙𝑝2\displaystyle=2\left(p_{1}\dot{p}_{1}+p_{2}\dot{p}_{2}\right).= 2 ( italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

Equation (36) computes the first time derivative of I𝐼Iitalic_I. This includes the computation of 𝒻˙𝒽subscript˙𝒻𝒽\dot{\mathscr{f}}_{\mathscr{h}}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT from 𝒽˙˙𝒽\dot{\mathscr{h}}over˙ start_ARG script_h end_ARG, and 𝒻˙hsubscript˙𝒻\dot{\mathscr{f}}_{h}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT is computed from h˙˙\dot{h}over˙ start_ARG italic_h end_ARG for later use. The same goes for 𝒻˙csubscript˙𝒻𝑐\dot{\mathscr{f}}_{c}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT and csubscript𝑐\mathscr{g}_{c}script_g start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT, calculated from c˙˙𝑐\dot{c}over˙ start_ARG italic_c end_ARG.

I𝐼\displaystyle Iitalic_I =3Ahr3z^(1q12q22)=3Az^δ𝒽=3Az^δ𝒻𝒽,absent3𝐴superscript𝑟3^𝑧1superscriptsubscript𝑞12superscriptsubscript𝑞223𝐴^𝑧𝛿𝒽3𝐴^𝑧𝛿subscript𝒻𝒽\displaystyle=\frac{3A}{hr^{3}}\hat{z}(1-q_{1}^{2}-q_{2}^{2})=3A\frac{\hat{z}% \delta}{\mathscr{h}}=3A\,\hat{z}\,\delta\,\mathscr{f}_{\mathscr{h}},= divide start_ARG 3 italic_A end_ARG start_ARG italic_h italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG over^ start_ARG italic_z end_ARG ( 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) = 3 italic_A divide start_ARG over^ start_ARG italic_z end_ARG italic_δ end_ARG start_ARG script_h end_ARG = 3 italic_A over^ start_ARG italic_z end_ARG italic_δ script_f start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT , I˙˙𝐼\displaystyle\dot{I}over˙ start_ARG italic_I end_ARG =3A[(z^˙δ+z^δ˙)𝒻𝒽+z^δ𝒻˙𝒽],absent3𝐴delimited-[]˙^𝑧𝛿^𝑧˙𝛿subscript𝒻𝒽^𝑧𝛿subscript˙𝒻𝒽\displaystyle=3A\left[\left(\dot{\hat{z}}\delta+\hat{z}\dot{\delta}\right)% \mathscr{f}_{\mathscr{h}}+\hat{z}\delta\dot{\mathscr{f}}_{\mathscr{h}}\right],= 3 italic_A [ ( over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + over^ start_ARG italic_z end_ARG over˙ start_ARG italic_δ end_ARG ) script_f start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + over^ start_ARG italic_z end_ARG italic_δ over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT ] , (36)
δ𝛿\displaystyle\deltaitalic_δ =1q12q22,absent1superscriptsubscript𝑞12superscriptsubscript𝑞22\displaystyle=1-q_{1}^{2}-q_{2}^{2},= 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , δ˙˙𝛿\displaystyle\dot{\delta}over˙ start_ARG italic_δ end_ARG =q˙s,absentsubscript˙𝑞𝑠\displaystyle=-\dot{q}_{s},= - over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT ,
𝒽𝒽\displaystyle\mathscr{h}script_h =hr3=hrc,absentsuperscript𝑟3subscript𝑟𝑐\displaystyle=hr^{3}=hr_{c},= italic_h italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT = italic_h italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT , 𝒽˙˙𝒽\displaystyle\dot{\mathscr{h}}over˙ start_ARG script_h end_ARG =h˙rc+hr˙c,absent˙subscript𝑟𝑐subscript˙𝑟𝑐\displaystyle=\dot{h}r_{c}+h\dot{r}_{c},= over˙ start_ARG italic_h end_ARG italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + italic_h over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT ,
h\displaystyle hitalic_h =c22r2𝒰,absentsuperscript𝑐22superscript𝑟2𝒰\displaystyle=\sqrt{c^{2}-2r^{2}\mathscr{U}},= square-root start_ARG italic_c start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 2 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT script_U end_ARG , h˙˙\displaystyle\dot{h}over˙ start_ARG italic_h end_ARG =(c2r𝒰r2𝒰˙)𝒻h,absentsubscript𝑐2subscript𝑟𝒰superscript𝑟2˙𝒰subscript𝒻\displaystyle=\left(\mathscr{g}_{c}-2\mathscr{g}_{r}\mathscr{U}-r^{2}\dot{% \mathscr{U}}\right)\mathscr{f}_{h},= ( script_g start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙ start_ARG script_U end_ARG ) script_f start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ,
c𝑐\displaystyle citalic_c =(μ2ν)1/31p12p22=(μ2ν)1/3β,absentsuperscriptsuperscript𝜇2𝜈131superscriptsubscript𝑝12superscriptsubscript𝑝22superscriptsuperscript𝜇2𝜈13𝛽\displaystyle=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\sqrt{1-p_{1}^{2}-p_{2}^{2% }}=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\beta,= ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT square-root start_ARG 1 - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG = ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT italic_β , c˙˙𝑐\displaystyle\dot{c}over˙ start_ARG italic_c end_ARG =(μ2ν)1/3β˙.absentsuperscriptsuperscript𝜇2𝜈13˙𝛽\displaystyle=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\dot{\beta}.= ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT over˙ start_ARG italic_β end_ARG .

Equation (37) computes the first time derivative of 𝒹𝒹\mathscr{d}script_d, where 𝒻˙r2subscript˙𝒻superscript𝑟2\dot{\mathscr{f}}_{r^{2}}over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT is computed from the derivation of r2superscript𝑟2r^{2}italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT.

𝒹𝒹\displaystyle\mathscr{d}script_d =hcr2=(hc)𝒻r2,absent𝑐superscript𝑟2𝑐subscript𝒻superscript𝑟2\displaystyle=\frac{h-c}{r^{2}}=\left(h-c\right)\mathscr{f}_{r^{2}},= divide start_ARG italic_h - italic_c end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG = ( italic_h - italic_c ) script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT , (37)
𝒹˙˙𝒹\displaystyle\dot{\mathscr{d}}over˙ start_ARG script_d end_ARG =(h˙c˙)𝒻r2+(hc)𝒻˙r2,absent˙˙𝑐subscript𝒻superscript𝑟2𝑐subscript˙𝒻superscript𝑟2\displaystyle=\left(\dot{h}-\dot{c}\right)\mathscr{f}_{r^{2}}+\left(h-c\right)% \dot{\mathscr{f}}_{r^{2}},= ( over˙ start_ARG italic_h end_ARG - over˙ start_ARG italic_c end_ARG ) script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + ( italic_h - italic_c ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT ,
d(r2)dt𝑑superscript𝑟2𝑑𝑡\displaystyle\frac{d(r^{2})}{dt}divide start_ARG italic_d ( italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t end_ARG =r˙s=2rr˙=2r.absentsubscript˙𝑟𝑠2𝑟˙𝑟2subscript𝑟\displaystyle=\dot{r}_{s}=2r\dot{r}=2\mathscr{g}_{r}.= over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 2 italic_r over˙ start_ARG italic_r end_ARG = 2 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT .

Finally, the time derivatives of whsubscript𝑤w_{h}italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT, ξ1subscript𝜉1\xi_{1}italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT, ξ2subscript𝜉2\xi_{2}italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT, 𝓈Lsubscript𝓈𝐿\mathscr{s}_{L}script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT and 𝒸Lsubscript𝒸𝐿\mathscr{c}_{L}script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT are in Equation (38).

whsubscript𝑤\displaystyle w_{h}italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT =Iz^,absent𝐼^𝑧\displaystyle=I\hat{z},= italic_I over^ start_ARG italic_z end_ARG , w˙hsubscript˙𝑤\displaystyle\dot{w}_{h}over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT =I˙z^+Iz^˙,absent˙𝐼^𝑧𝐼˙^𝑧\displaystyle=\dot{I}\hat{z}+I\dot{\hat{z}},= over˙ start_ARG italic_I end_ARG over^ start_ARG italic_z end_ARG + italic_I over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG , (38)
ξ1subscript𝜉1\displaystyle\xi_{1}italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =Xa+2p2,absent𝑋𝑎2subscript𝑝2\displaystyle=\frac{X}{a}+2p_{2},= divide start_ARG italic_X end_ARG start_ARG italic_a end_ARG + 2 italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , ξ˙1subscript˙𝜉1\displaystyle\dot{\xi}_{1}over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =X˙a+2p˙2,absent˙𝑋𝑎2subscript˙𝑝2\displaystyle=\frac{\dot{X}}{a}+2\dot{p}_{2},= divide start_ARG over˙ start_ARG italic_X end_ARG end_ARG start_ARG italic_a end_ARG + 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ,
ξ2subscript𝜉2\displaystyle\xi_{2}italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =Ya+2p1,absent𝑌𝑎2subscript𝑝1\displaystyle=\frac{Y}{a}+2p_{1},= divide start_ARG italic_Y end_ARG start_ARG italic_a end_ARG + 2 italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , ξ˙2subscript˙𝜉2\displaystyle\dot{\xi}_{2}over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =Y˙a+2p˙1,absent˙𝑌𝑎2subscript˙𝑝1\displaystyle=\frac{\dot{Y}}{a}+2\dot{p}_{1},= divide start_ARG over˙ start_ARG italic_Y end_ARG end_ARG start_ARG italic_a end_ARG + 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ,
𝓈Lsubscript𝓈𝐿\displaystyle\mathscr{s}_{L}script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =Yr=Y𝒻r,absent𝑌𝑟𝑌subscript𝒻𝑟\displaystyle=\frac{Y}{r}=Y\mathscr{f}_{r},= divide start_ARG italic_Y end_ARG start_ARG italic_r end_ARG = italic_Y script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT , 𝓈˙Lsubscript˙𝓈𝐿\displaystyle\dot{\mathscr{s}}_{L}over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =Y˙𝒻r+Y𝒻˙r,absent˙𝑌subscript𝒻𝑟𝑌subscript˙𝒻𝑟\displaystyle=\dot{Y}\mathscr{f}_{r}+Y\dot{\mathscr{f}}_{r},= over˙ start_ARG italic_Y end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_Y over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ,
𝒸Lsubscript𝒸𝐿\displaystyle\mathscr{c}_{L}script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =Xr=X𝒻r,absent𝑋𝑟𝑋subscript𝒻𝑟\displaystyle=\frac{X}{r}=X\mathscr{f}_{r},= divide start_ARG italic_X end_ARG start_ARG italic_r end_ARG = italic_X script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT , 𝒸˙Lsubscript˙𝒸𝐿\displaystyle\dot{\mathscr{c}}_{L}over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =X˙𝒻r+X𝒻˙r.absent˙𝑋subscript𝒻𝑟𝑋subscript˙𝒻𝑟\displaystyle=\dot{X}\mathscr{f}_{r}+X\dot{\mathscr{f}}_{r}.= over˙ start_ARG italic_X end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_X over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT .

In this section the computation of every 𝒻ssubscript𝒻𝑠\mathscr{f}_{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT time derivative has been explicitly noted. In the following this comments are omitted for the sake of brevity, and it will be assumed all instances can be computed with the corresponding derivatives of s𝑠sitalic_s (to the needed order).

A.4.2 Third order derivatives

The third order time derivatives of the GEqOE can be computed with Equation (39).

ν˙˙˙=0,q˙˙˙1=I¨𝓈L2I˙𝓈˙LI𝓈¨L,q˙˙˙2=I¨𝒸L2I˙𝒸˙LI𝒸¨L,p˙˙˙1=p¨2(𝒹wh)+2p˙2(𝒹˙w˙h)+p2(𝒹¨w¨h)(𝒻¨cξ1+2𝒻˙cξ˙1+𝒻cξ¨1)𝒰2(𝒻˙cξ1+𝒻cξ˙1)𝒰˙𝒻cξ1𝒰¨,p˙˙˙2=p¨1(wh𝒹)+2p˙1(w˙h𝒹˙)+p1(w¨h𝒹¨)+(𝒻¨cξ2+2𝒻˙cξ˙2+𝒻cξ¨2)𝒰+2(𝒻˙cξ2+𝒻cξ˙2)𝒰˙+𝒻cξ2𝒰¨,˙˙˙=𝒹¨w¨h(𝒻¨cΓ+2𝒻˙cΓ˙+𝒻cΓ¨)𝒰2(𝒻˙cΓ+𝒻cΓ˙)𝒰˙𝒻cΓ𝒰¨.formulae-sequence˙˙˙𝜈0formulae-sequencesubscript˙˙˙𝑞1¨𝐼subscript𝓈𝐿2˙𝐼subscript˙𝓈𝐿𝐼subscript¨𝓈𝐿formulae-sequencesubscript˙˙˙𝑞2¨𝐼subscript𝒸𝐿2˙𝐼subscript˙𝒸𝐿𝐼subscript¨𝒸𝐿formulae-sequencesubscript˙˙˙𝑝1subscript¨𝑝2𝒹subscript𝑤2subscript˙𝑝2˙𝒹subscript˙𝑤subscript𝑝2¨𝒹subscript¨𝑤subscript¨𝒻𝑐subscript𝜉12subscript˙𝒻𝑐subscript˙𝜉1subscript𝒻𝑐subscript¨𝜉1𝒰2subscript˙𝒻𝑐subscript𝜉1subscript𝒻𝑐subscript˙𝜉1˙𝒰subscript𝒻𝑐subscript𝜉1¨𝒰formulae-sequencesubscript˙˙˙𝑝2subscript¨𝑝1subscript𝑤𝒹2subscript˙𝑝1subscript˙𝑤˙𝒹subscript𝑝1subscript¨𝑤¨𝒹subscript¨𝒻𝑐subscript𝜉22subscript˙𝒻𝑐subscript˙𝜉2subscript𝒻𝑐subscript¨𝜉2𝒰2subscript˙𝒻𝑐subscript𝜉2subscript𝒻𝑐subscript˙𝜉2˙𝒰subscript𝒻𝑐subscript𝜉2¨𝒰˙˙˙¨𝒹subscript¨𝑤subscript¨𝒻𝑐Γ2subscript˙𝒻𝑐˙Γsubscript𝒻𝑐¨Γ𝒰2subscript˙𝒻𝑐Γsubscript𝒻𝑐˙Γ˙𝒰subscript𝒻𝑐Γ¨𝒰\begin{split}\dddot{\nu}&=0,\\ \dddot{q}_{1}&=-\ddot{I}\mathscr{s}_{L}-2\dot{I}\dot{\mathscr{s}}_{L}-I\ddot{% \mathscr{s}}_{L},\\ \dddot{q}_{2}&=-\ddot{I}\mathscr{c}_{L}-2\dot{I}\dot{\mathscr{c}}_{L}-I\ddot{% \mathscr{c}}_{L},\\ \dddot{p}_{1}&=\ddot{p}_{2}\left(\mathscr{d}-w_{h}\right)+2\dot{p}_{2}\left(% \dot{\mathscr{d}}-\dot{w}_{h}\right)+p_{2}\left(\ddot{\mathscr{d}}-\ddot{w}_{h% }\right)-\left(\ddot{\mathscr{f}}_{c}\xi_{1}+2\dot{\mathscr{f}}_{c}\dot{\xi}_{% 1}+\mathscr{f}_{c}\ddot{\xi}_{1}\right)\mathscr{U}-2\left(\dot{\mathscr{f}}_{c% }\xi_{1}+\mathscr{f}_{c}\dot{\xi}_{1}\right)\dot{\mathscr{U}}-\mathscr{f}_{c}% \xi_{1}\ddot{\mathscr{U}},\\ \dddot{p}_{2}&=\ddot{p}_{1}\left(w_{h}-\mathscr{d}\right)+2\dot{p}_{1}\left(% \dot{w}_{h}-\dot{\mathscr{d}}\right)+p_{1}\left(\ddot{w}_{h}-\ddot{\mathscr{d}% }\right)+\left(\ddot{\mathscr{f}}_{c}\xi_{2}+2\dot{\mathscr{f}}_{c}\dot{\xi}_{% 2}+\mathscr{f}_{c}\ddot{\xi}_{2}\right)\mathscr{U}+2\left(\dot{\mathscr{f}}_{c% }\xi_{2}+\mathscr{f}_{c}\dot{\xi}_{2}\right)\dot{\mathscr{U}}+\mathscr{f}_{c}% \xi_{2}\ddot{\mathscr{U}},\\ \dddot{\mathcal{L}}&=\ddot{\mathscr{d}}-\ddot{w}_{h}-\left(\ddot{\mathscr{f}}_% {c}\Gamma+2\dot{\mathscr{f}}_{c}\dot{\Gamma}+\mathscr{f}_{c}\ddot{\Gamma}% \right)\mathscr{U}-2\left(\dot{\mathscr{f}}_{c}\Gamma+\mathscr{f}_{c}\dot{% \Gamma}\right)\dot{\mathscr{U}}-\mathscr{f}_{c}\Gamma\ddot{\mathscr{U}}.\end{split}start_ROW start_CELL over˙˙˙ start_ARG italic_ν end_ARG end_CELL start_CELL = 0 , end_CELL end_ROW start_ROW start_CELL over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL = - over¨ start_ARG italic_I end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 2 over˙ start_ARG italic_I end_ARG over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , end_CELL end_ROW start_ROW start_CELL over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT end_CELL start_CELL = - over¨ start_ARG italic_I end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 2 over˙ start_ARG italic_I end_ARG over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , end_CELL end_ROW start_ROW start_CELL over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT end_CELL start_CELL = over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( script_d - italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over˙ start_ARG script_d end_ARG - over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over¨ start_ARG script_d end_ARG - over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) - ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) script_U - 2 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) over˙ start_ARG script_U end_ARG - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG script_U end_ARG , end_CELL end_ROW start_ROW start_CELL over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT end_CELL start_CELL = over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - script_d ) + 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over˙ start_ARG script_d end_ARG ) + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over¨ start_ARG script_d end_ARG ) + ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) script_U + 2 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) over˙ start_ARG script_U end_ARG + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG script_U end_ARG , end_CELL end_ROW start_ROW start_CELL over˙˙˙ start_ARG caligraphic_L end_ARG end_CELL start_CELL = over¨ start_ARG script_d end_ARG - over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG roman_Γ end_ARG ) script_U - 2 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG ) over˙ start_ARG script_U end_ARG - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ over¨ start_ARG script_U end_ARG . end_CELL end_ROW (39)

All the elements that appear in Eq. (39) are computed with the following formulation. Equation (40) computes the second time derivative of z^^𝑧\hat{z}over^ start_ARG italic_z end_ARG.

z^¨¨^𝑧\displaystyle\ddot{\hat{z}}over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG =𝒞¨𝒻𝒟+2𝒞˙𝒻˙𝒟+𝒞𝒻¨𝒟,absent¨𝒞subscript𝒻𝒟2˙𝒞subscript˙𝒻𝒟𝒞subscript¨𝒻𝒟\displaystyle=\ddot{\mathcal{C}}\mathscr{f}_{\mathcal{D}}+2\dot{\mathcal{C}}% \dot{\mathscr{f}}_{\mathcal{D}}+\mathcal{C}\ddot{\mathscr{f}}_{\mathcal{D}},= over¨ start_ARG caligraphic_C end_ARG script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + 2 over˙ start_ARG caligraphic_C end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + caligraphic_C over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , 𝒞¨¨𝒞\displaystyle\ddot{\mathcal{C}}over¨ start_ARG caligraphic_C end_ARG =2(Y¨q2+2Y˙q˙2+Yq˙2X¨q12X˙q˙1Xq¨1),absent2¨𝑌subscript𝑞22˙𝑌subscript˙𝑞2𝑌subscript˙𝑞2¨𝑋subscript𝑞12˙𝑋subscript˙𝑞1𝑋subscript¨𝑞1\displaystyle=2\left(\ddot{Y}q_{2}+2\dot{Y}\dot{q}_{2}+Y\dot{q}_{2}-\ddot{X}q_% {1}-2\dot{X}\dot{q}_{1}-X\ddot{q}_{1}\right),= 2 ( over¨ start_ARG italic_Y end_ARG italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_Y end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_Y over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - over¨ start_ARG italic_X end_ARG italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - 2 over˙ start_ARG italic_X end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - italic_X over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) , (40)
𝒟¨¨𝒟\displaystyle\ddot{\mathcal{D}}over¨ start_ARG caligraphic_D end_ARG =r¨qs+2r˙q˙s+rq¨s𝒻¨𝒟,absent¨𝑟subscript𝑞𝑠2˙𝑟subscript˙𝑞𝑠𝑟subscript¨𝑞𝑠subscript¨𝒻𝒟\displaystyle=\ddot{r}q_{s}+2\dot{r}\dot{q}_{s}+r\ddot{q}_{s}\rightarrow\ddot{% \mathscr{f}}_{\mathcal{D}},= over¨ start_ARG italic_r end_ARG italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_r end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + italic_r over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT → over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , q¨ssubscript¨𝑞𝑠\displaystyle\ddot{q}_{s}over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(q˙12+q1q¨1+q˙22+q2q¨2).absent2superscriptsubscript˙𝑞12subscript𝑞1subscript¨𝑞1superscriptsubscript˙𝑞22subscript𝑞2subscript¨𝑞2\displaystyle=2\left(\dot{q}_{1}^{2}+q_{1}\ddot{q}_{1}+\dot{q}_{2}^{2}+q_{2}% \ddot{q}_{2}\right).= 2 ( over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

The second order time derivatives of X𝑋Xitalic_X and Y𝑌Yitalic_Y are computed in Equation (41).

X˙˙𝑋\displaystyle\dot{X}over˙ start_ARG italic_X end_ARG =r˙cosLhrsinL=r˙𝒸L𝓌𝓈L,absent˙𝑟𝐿𝑟𝐿˙𝑟subscript𝒸𝐿𝓌subscript𝓈𝐿\displaystyle=\dot{r}\cos{L}-\frac{h}{r}\sin{L}=\dot{r}\mathscr{c}_{L}-% \mathscr{w}\mathscr{s}_{L},= over˙ start_ARG italic_r end_ARG roman_cos italic_L - divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_sin italic_L = over˙ start_ARG italic_r end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - script_w script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , X¨¨𝑋\displaystyle\ddot{X}over¨ start_ARG italic_X end_ARG =r¨𝒸L+r˙𝒸˙L𝓌˙𝓈L𝓌𝓈˙L,absent¨𝑟subscript𝒸𝐿˙𝑟subscript˙𝒸𝐿˙𝓌subscript𝓈𝐿𝓌subscript˙𝓈𝐿\displaystyle=\ddot{r}\mathscr{c}_{L}+\dot{r}\dot{\mathscr{c}}_{L}-\dot{% \mathscr{w}}\mathscr{s}_{L}-\mathscr{w}\dot{\mathscr{s}}_{L},= over¨ start_ARG italic_r end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over˙ start_ARG italic_r end_ARG over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - over˙ start_ARG script_w end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - script_w over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , (41)
Y˙˙𝑌\displaystyle\dot{Y}over˙ start_ARG italic_Y end_ARG =r˙sinL+hrcosL=r˙𝓈L+𝓌𝒸L,absent˙𝑟𝐿𝑟𝐿˙𝑟subscript𝓈𝐿𝓌subscript𝒸𝐿\displaystyle=\dot{r}\sin{L}+\frac{h}{r}\cos{L}=\dot{r}\mathscr{s}_{L}+% \mathscr{w}\mathscr{c}_{L},= over˙ start_ARG italic_r end_ARG roman_sin italic_L + divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_cos italic_L = over˙ start_ARG italic_r end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + script_w script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , Y¨¨𝑌\displaystyle\ddot{Y}over¨ start_ARG italic_Y end_ARG =r¨𝓈L+r˙𝓈˙L+𝓌˙𝒸L+𝓌𝒸˙L,absent¨𝑟subscript𝓈𝐿˙𝑟subscript˙𝓈𝐿˙𝓌subscript𝒸𝐿𝓌subscript˙𝒸𝐿\displaystyle=\ddot{r}\mathscr{s}_{L}+\dot{r}\dot{\mathscr{s}}_{L}+\dot{% \mathscr{w}}\mathscr{c}_{L}+\mathscr{w}\dot{\mathscr{c}}_{L},= over¨ start_ARG italic_r end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over˙ start_ARG italic_r end_ARG over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over˙ start_ARG script_w end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + script_w over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT ,
𝓌𝓌\displaystyle\mathscr{w}script_w =hr=h𝒻r,absent𝑟subscript𝒻𝑟\displaystyle=\frac{h}{r}=h\mathscr{f}_{r},= divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG = italic_h script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT , 𝓌˙˙𝓌\displaystyle\dot{\mathscr{w}}over˙ start_ARG script_w end_ARG =h˙𝒻r+h𝒻˙r,absent˙subscript𝒻𝑟subscript˙𝒻𝑟\displaystyle=\dot{h}\mathscr{f}_{r}+h\dot{\mathscr{f}}_{r},= over˙ start_ARG italic_h end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_h over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ,
r˙˙𝑟\displaystyle\dot{r}over˙ start_ARG italic_r end_ARG =μc(p2sinLp1cosL)=μ𝒻crpl,absent𝜇𝑐subscript𝑝2𝐿subscript𝑝1𝐿𝜇subscript𝒻𝑐subscript𝑟𝑝𝑙\displaystyle=\frac{\mu}{c}\left(p_{2}\sin{L}-p_{1}\cos{L}\right)=\mu\mathscr{% f}_{c}r_{pl},= divide start_ARG italic_μ end_ARG start_ARG italic_c end_ARG ( italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin italic_L - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_cos italic_L ) = italic_μ script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT , r¨¨𝑟\displaystyle\ddot{r}over¨ start_ARG italic_r end_ARG =μ(𝒻˙crpl+𝒻cr˙pl),absent𝜇subscript˙𝒻𝑐subscript𝑟𝑝𝑙subscript𝒻𝑐subscript˙𝑟𝑝𝑙\displaystyle=\mu\left(\dot{\mathscr{f}}_{c}r_{pl}+\mathscr{f}_{c}\dot{r}_{pl}% \right),= italic_μ ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT ) ,
rplsubscript𝑟𝑝𝑙\displaystyle r_{pl}italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT =p2𝓈Lp1𝒸L,absentsubscript𝑝2subscript𝓈𝐿subscript𝑝1subscript𝒸𝐿\displaystyle=p_{2}\mathscr{s}_{L}-p_{1}\mathscr{c}_{L},= italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , r˙plsubscript˙𝑟𝑝𝑙\displaystyle\dot{r}_{pl}over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT =p˙2𝓈L+p2𝓈˙Lp˙1𝒸Lp1𝒸˙L.absentsubscript˙𝑝2subscript𝓈𝐿subscript𝑝2subscript˙𝓈𝐿subscript˙𝑝1subscript𝒸𝐿subscript𝑝1subscript˙𝒸𝐿\displaystyle=\dot{p}_{2}\mathscr{s}_{L}+p_{2}\dot{\mathscr{s}}_{L}-\dot{p}_{1% }\mathscr{c}_{L}-p_{1}\dot{\mathscr{c}}_{L}.= over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT .

Equation (42) computes the second time derivative of 𝒰𝒰\mathscr{U}script_U and Uzsubscript𝑈𝑧U_{z}italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT.

𝒰¨¨𝒰\displaystyle\ddot{\mathscr{U}}over¨ start_ARG script_U end_ARG =A(U¨z𝒻r3+2U˙z𝒻˙r3+Uz𝒻¨r3),absent𝐴subscript¨𝑈𝑧subscript𝒻superscript𝑟32subscript˙𝑈𝑧subscript˙𝒻superscript𝑟3subscript𝑈𝑧subscript¨𝒻superscript𝑟3\displaystyle=-A\left(\ddot{U}_{z}\mathscr{f}_{r^{3}}+2\dot{U}_{z}\dot{% \mathscr{f}}_{r^{3}}+U_{z}\ddot{\mathscr{f}}_{r^{3}}\right),= - italic_A ( over¨ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT ) , U¨zsubscript¨𝑈𝑧\displaystyle\ddot{U}_{z}over¨ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT =6(z^˙2+z^z^¨),absent6superscript˙^𝑧2^𝑧¨^𝑧\displaystyle=-6\left(\dot{\hat{z}}^{2}+\hat{z}\ddot{\hat{z}}\right),= - 6 ( over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + over^ start_ARG italic_z end_ARG over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG ) , d2(r3)dt2=r¨c=3(2rr˙2+r2r¨).superscript𝑑2superscript𝑟3𝑑superscript𝑡2subscript¨𝑟𝑐32𝑟superscript˙𝑟2superscript𝑟2¨𝑟\displaystyle\frac{d^{2}(r^{3})}{dt^{2}}=\ddot{r}_{c}=3\left(2r\dot{r}^{2}+r^{% 2}\ddot{r}\right).divide start_ARG italic_d start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG = over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT = 3 ( 2 italic_r over˙ start_ARG italic_r end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG italic_r end_ARG ) . (42)

Equation (43) includes the second order derivatives of ΓΓ\Gammaroman_Γ and β𝛽\betaitalic_β.

Γ¨¨Γ\displaystyle\ddot{\Gamma}over¨ start_ARG roman_Γ end_ARG =𝒻¨α+α¨(1ra)2α˙r˙aαr¨a,absentsubscript¨𝒻𝛼¨𝛼1𝑟𝑎2˙𝛼˙𝑟𝑎𝛼¨𝑟𝑎\displaystyle=\ddot{\mathscr{f}}_{\alpha}+\ddot{\alpha}\left(1-\frac{r}{a}% \right)-2\dot{\alpha}\frac{\dot{r}}{a}-\alpha\frac{\ddot{r}}{a},= over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT + over¨ start_ARG italic_α end_ARG ( 1 - divide start_ARG italic_r end_ARG start_ARG italic_a end_ARG ) - 2 over˙ start_ARG italic_α end_ARG divide start_ARG over˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG - italic_α divide start_ARG over¨ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG , ᨨ𝛼\displaystyle\ddot{\alpha}over¨ start_ARG italic_α end_ARG =𝒻¨1+β,absentsubscript¨𝒻1𝛽\displaystyle=\ddot{\mathscr{f}}_{1+\beta},= over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT , (43)
⨨𝛽\displaystyle\ddot{\beta}over¨ start_ARG italic_β end_ARG =12(p¨s𝒻β+p˙s𝒻˙β)𝒻¨1+β,𝒻¨β,formulae-sequenceabsent12subscript¨𝑝𝑠subscript𝒻𝛽subscript˙𝑝𝑠subscript˙𝒻𝛽subscript¨𝒻1𝛽subscript¨𝒻𝛽\displaystyle=-\frac{1}{2}\left(\ddot{p}_{s}\mathscr{f}_{\beta}+\dot{p}_{s}% \dot{\mathscr{f}}_{\beta}\right)\rightarrow\ddot{\mathscr{f}}_{1+\beta},\ddot{% \mathscr{f}}_{\beta},= - divide start_ARG 1 end_ARG start_ARG 2 end_ARG ( over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT + over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT ) → over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT , over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT , p¨ssubscript¨𝑝𝑠\displaystyle\ddot{p}_{s}over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(p˙12+p1p¨1+p˙22+p2p¨2).absent2superscriptsubscript˙𝑝12subscript𝑝1subscript¨𝑝1superscriptsubscript˙𝑝22subscript𝑝2subscript¨𝑝2\displaystyle=2\left(\dot{p}_{1}^{2}+p_{1}\ddot{p}_{1}+\dot{p}_{2}^{2}+p_{2}% \ddot{p}_{2}\right).= 2 ( over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

Equation (44) computes the second time derivative of I𝐼Iitalic_I.

I¨¨𝐼\displaystyle\ddot{I}over¨ start_ARG italic_I end_ARG =3A[(z^¨δ+2z^˙δ˙+z^δ¨)𝒻𝒽+2(z^˙δ+z^δ˙)𝒻˙𝒽+z^δ𝒻¨𝒽],absent3𝐴delimited-[]¨^𝑧𝛿2˙^𝑧˙𝛿^𝑧¨𝛿subscript𝒻𝒽2˙^𝑧𝛿^𝑧˙𝛿subscript˙𝒻𝒽^𝑧𝛿subscript¨𝒻𝒽\displaystyle=3A\left[\left(\ddot{\hat{z}}\delta+2\dot{\hat{z}}\dot{\delta}+% \hat{z}\ddot{\delta}\right)\mathscr{f}_{\mathscr{h}}+2\left(\dot{\hat{z}}% \delta+\hat{z}\dot{\delta}\right)\dot{\mathscr{f}}_{\mathscr{h}}+\hat{z}\delta% \ddot{\mathscr{f}}_{\mathscr{h}}\right],= 3 italic_A [ ( over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + 2 over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG over˙ start_ARG italic_δ end_ARG + over^ start_ARG italic_z end_ARG over¨ start_ARG italic_δ end_ARG ) script_f start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + 2 ( over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + over^ start_ARG italic_z end_ARG over˙ start_ARG italic_δ end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + over^ start_ARG italic_z end_ARG italic_δ over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT ] , (44)
𝒽¨¨𝒽\displaystyle\ddot{\mathscr{h}}over¨ start_ARG script_h end_ARG =h¨rc+2h˙r˙c+hr¨c,absent¨subscript𝑟𝑐2˙subscript˙𝑟𝑐subscript¨𝑟𝑐\displaystyle=\ddot{h}r_{c}+2\dot{h}\dot{r}_{c}+h\ddot{r}_{c},= over¨ start_ARG italic_h end_ARG italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_h end_ARG over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + italic_h over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT ,
h¨¨\displaystyle\ddot{h}over¨ start_ARG italic_h end_ARG =(˙c2˙r𝒰4r𝒰˙r2𝒰¨)𝒻h+(c2r𝒰r2𝒰˙)𝒻˙h,absentsubscript˙𝑐2subscript˙𝑟𝒰4subscript𝑟˙𝒰superscript𝑟2¨𝒰subscript𝒻subscript𝑐2subscript𝑟𝒰superscript𝑟2˙𝒰subscript˙𝒻\displaystyle=\left(\dot{\mathscr{g}}_{c}-2\dot{\mathscr{g}}_{r}\mathscr{U}-4% \mathscr{g}_{r}\dot{\mathscr{U}}-r^{2}\ddot{\mathscr{U}}\right)\mathscr{f}_{h}% +\left(\mathscr{g}_{c}-2\mathscr{g}_{r}\mathscr{U}-r^{2}\dot{\mathscr{U}}% \right)\dot{\mathscr{f}}_{h},= ( over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - 4 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT over˙ start_ARG script_U end_ARG - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG script_U end_ARG ) script_f start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT + ( script_g start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙ start_ARG script_U end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ,
c¨¨𝑐\displaystyle\ddot{c}over¨ start_ARG italic_c end_ARG =(μ2ν)1/3β¨,absentsuperscriptsuperscript𝜇2𝜈13¨𝛽\displaystyle=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\ddot{\beta},= ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT over¨ start_ARG italic_β end_ARG ,
䨨𝛿\displaystyle\ddot{\delta}over¨ start_ARG italic_δ end_ARG =q¨s.absentsubscript¨𝑞𝑠\displaystyle=-\ddot{q}_{s}.= - over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT .

Equation (45) computes the second time derivative of 𝒹𝒹\mathscr{d}script_d.

𝒹¨¨𝒹\displaystyle\ddot{\mathscr{d}}over¨ start_ARG script_d end_ARG =(h¨c¨)𝒻r2+2(h˙c˙)𝒻˙r2+(hc)𝒻¨r2,absent¨¨𝑐subscript𝒻superscript𝑟22˙˙𝑐subscript˙𝒻superscript𝑟2𝑐subscript¨𝒻superscript𝑟2\displaystyle=\left(\ddot{h}-\ddot{c}\right)\mathscr{f}_{r^{2}}+2\left(\dot{h}% -\dot{c}\right)\dot{\mathscr{f}}_{r^{2}}+\left(h-c\right)\ddot{\mathscr{f}}_{r% ^{2}},= ( over¨ start_ARG italic_h end_ARG - over¨ start_ARG italic_c end_ARG ) script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 2 ( over˙ start_ARG italic_h end_ARG - over˙ start_ARG italic_c end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + ( italic_h - italic_c ) over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT , (45)
d2(r2)dt2superscript𝑑2superscript𝑟2𝑑superscript𝑡2\displaystyle\frac{d^{2}(r^{2})}{dt^{2}}divide start_ARG italic_d start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ( italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG =r¨s=2˙r.absentsubscript¨𝑟𝑠2subscript˙𝑟\displaystyle=\ddot{r}_{s}=2\dot{\mathscr{g}}_{r}.= over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 2 over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT .

The second order time derivatives of whsubscript𝑤w_{h}italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT, ξ1subscript𝜉1\xi_{1}italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT, ξ2subscript𝜉2\xi_{2}italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT, 𝓈Lsubscript𝓈𝐿\mathscr{s}_{L}script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT and 𝒸Lsubscript𝒸𝐿\mathscr{c}_{L}script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT are in Equation (46).

w¨hsubscript¨𝑤\displaystyle\ddot{w}_{h}over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT =I¨z^+2I˙z^˙+Iz^¨,absent¨𝐼^𝑧2˙𝐼˙^𝑧𝐼¨^𝑧\displaystyle=\ddot{I}\hat{z}+2\dot{I}\dot{\hat{z}}+I\ddot{\hat{z}},= over¨ start_ARG italic_I end_ARG over^ start_ARG italic_z end_ARG + 2 over˙ start_ARG italic_I end_ARG over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG + italic_I over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG , (46)
ξ¨1subscript¨𝜉1\displaystyle\ddot{\xi}_{1}over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =X¨a+2p¨2,absent¨𝑋𝑎2subscript¨𝑝2\displaystyle=\frac{\ddot{X}}{a}+2\ddot{p}_{2},= divide start_ARG over¨ start_ARG italic_X end_ARG end_ARG start_ARG italic_a end_ARG + 2 over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ,
ξ¨2subscript¨𝜉2\displaystyle\ddot{\xi}_{2}over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =Y¨a+2p¨1,absent¨𝑌𝑎2subscript¨𝑝1\displaystyle=\frac{\ddot{Y}}{a}+2\ddot{p}_{1},= divide start_ARG over¨ start_ARG italic_Y end_ARG end_ARG start_ARG italic_a end_ARG + 2 over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ,
𝓈¨Lsubscript¨𝓈𝐿\displaystyle\ddot{\mathscr{s}}_{L}over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =Y¨𝒻r+2Y˙𝒻˙r+Y𝒻¨r,absent¨𝑌subscript𝒻𝑟2˙𝑌subscript˙𝒻𝑟𝑌subscript¨𝒻𝑟\displaystyle=\ddot{Y}\mathscr{f}_{r}+2\dot{Y}\dot{\mathscr{f}}_{r}+Y\ddot{% \mathscr{f}}_{r},= over¨ start_ARG italic_Y end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_Y end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_Y over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ,
𝒸¨Lsubscript¨𝒸𝐿\displaystyle\ddot{\mathscr{c}}_{L}over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =X¨𝒻r+2X˙𝒻˙r+X𝒻¨r.absent¨𝑋subscript𝒻𝑟2˙𝑋subscript˙𝒻𝑟𝑋subscript¨𝒻𝑟\displaystyle=\ddot{X}\mathscr{f}_{r}+2\dot{X}\dot{\mathscr{f}}_{r}+X\ddot{% \mathscr{f}}_{r}.= over¨ start_ARG italic_X end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_X end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_X over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT .

A.4.3 Fourth order derivatives

The third order time derivatives of the GEqOE can be computed with Equation (47).

ν(4)=4𝜈absent\displaystyle\overset{\scriptscriptstyle(4)}{\nu}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_ν end_ARG = 0,0\displaystyle 0,0 , (47)
q(4)1=subscript4𝑞1absent\displaystyle\overset{\scriptscriptstyle(4)}{q}_{1}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT = I˙˙˙𝓈L3I¨𝓈˙L3I˙𝓈¨LI𝓈˙˙˙L,˙˙˙𝐼subscript𝓈𝐿3¨𝐼subscript˙𝓈𝐿3˙𝐼subscript¨𝓈𝐿𝐼subscript˙˙˙𝓈𝐿\displaystyle-\dddot{I}\mathscr{s}_{L}-3\ddot{I}\dot{\mathscr{s}}_{L}-3\dot{I}% \ddot{\mathscr{s}}_{L}-I\dddot{\mathscr{s}}_{L},- over˙˙˙ start_ARG italic_I end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 3 over¨ start_ARG italic_I end_ARG over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 3 over˙ start_ARG italic_I end_ARG over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over˙˙˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT ,
q(4)2=subscript4𝑞2absent\displaystyle\overset{\scriptscriptstyle(4)}{q}_{2}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT = I˙˙˙𝒸L3I¨𝒸˙L3I˙𝒸¨LI𝒸˙˙˙L,˙˙˙𝐼subscript𝒸𝐿3¨𝐼subscript˙𝒸𝐿3˙𝐼subscript¨𝒸𝐿𝐼subscript˙˙˙𝒸𝐿\displaystyle-\dddot{I}\mathscr{c}_{L}-3\ddot{I}\dot{\mathscr{c}}_{L}-3\dot{I}% \ddot{\mathscr{c}}_{L}-I\dddot{\mathscr{c}}_{L},- over˙˙˙ start_ARG italic_I end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 3 over¨ start_ARG italic_I end_ARG over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 3 over˙ start_ARG italic_I end_ARG over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_I over˙˙˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT ,
p(4)1=subscript4𝑝1absent\displaystyle\overset{\scriptscriptstyle(4)}{p}_{1}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT = p˙˙˙2(𝒹wh)+3p¨2(𝒹˙w˙h)+3p˙2(𝒹¨w¨h)+p2(𝒹˙˙˙w˙˙˙h)subscript˙˙˙𝑝2𝒹subscript𝑤3subscript¨𝑝2˙𝒹subscript˙𝑤3subscript˙𝑝2¨𝒹subscript¨𝑤subscript𝑝2˙˙˙𝒹subscript˙˙˙𝑤\displaystyle\dddot{p}_{2}\left(\mathscr{d}-w_{h}\right)+3\ddot{p}_{2}\left(% \dot{\mathscr{d}}-\dot{w}_{h}\right)+3\dot{p}_{2}\left(\ddot{\mathscr{d}}-% \ddot{w}_{h}\right)+p_{2}\left(\dddot{\mathscr{d}}-\dddot{w}_{h}\right)over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( script_d - italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + 3 over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over˙ start_ARG script_d end_ARG - over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + 3 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over¨ start_ARG script_d end_ARG - over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ) + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ( over˙˙˙ start_ARG script_d end_ARG - over˙˙˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT )
(𝒻˙˙˙cξ1+3𝒻¨cξ˙1+3𝒻˙cξ¨1+𝒻cξ˙˙˙1)𝒰3(𝒻¨cξ1+2𝒻˙cξ˙1+𝒻cξ¨1)𝒰˙3(𝒻˙cξ1+𝒻cξ˙1)𝒰¨𝒻cξ1𝒰˙˙˙,subscript˙˙˙𝒻𝑐subscript𝜉13subscript¨𝒻𝑐subscript˙𝜉13subscript˙𝒻𝑐subscript¨𝜉1subscript𝒻𝑐subscript˙˙˙𝜉1𝒰3subscript¨𝒻𝑐subscript𝜉12subscript˙𝒻𝑐subscript˙𝜉1subscript𝒻𝑐subscript¨𝜉1˙𝒰3subscript˙𝒻𝑐subscript𝜉1subscript𝒻𝑐subscript˙𝜉1¨𝒰subscript𝒻𝑐subscript𝜉1˙˙˙𝒰\displaystyle-\left(\dddot{\mathscr{f}}_{c}\xi_{1}+3\ddot{\mathscr{f}}_{c}\dot% {\xi}_{1}+3\dot{\mathscr{f}}_{c}\ddot{\xi}_{1}+\mathscr{f}_{c}\dddot{\xi}_{1}% \right)\mathscr{U}-3\left(\ddot{\mathscr{f}}_{c}\xi_{1}+2\dot{\mathscr{f}}_{c}% \dot{\xi}_{1}+\mathscr{f}_{c}\ddot{\xi}_{1}\right)\dot{\mathscr{U}}-3\left(% \dot{\mathscr{f}}_{c}\xi_{1}+\mathscr{f}_{c}\dot{\xi}_{1}\right)\ddot{\mathscr% {U}}-\mathscr{f}_{c}\xi_{1}\dddot{\mathscr{U}},- ( over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 3 over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 3 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) script_U - 3 ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) over˙ start_ARG script_U end_ARG - 3 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) over¨ start_ARG script_U end_ARG - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙˙˙ start_ARG script_U end_ARG ,
p(4)2=subscript4𝑝2absent\displaystyle\overset{\scriptscriptstyle(4)}{p}_{2}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT = p˙˙˙1(wh𝒹)+3p¨1(w˙h𝒹˙)+3p˙1(w¨h𝒹¨)+p1(w˙˙˙h𝒹˙˙˙)subscript˙˙˙𝑝1subscript𝑤𝒹3subscript¨𝑝1subscript˙𝑤˙𝒹3subscript˙𝑝1subscript¨𝑤¨𝒹subscript𝑝1subscript˙˙˙𝑤˙˙˙𝒹\displaystyle\dddot{p}_{1}\left(w_{h}-\mathscr{d}\right)+3\ddot{p}_{1}\left(% \dot{w}_{h}-\dot{\mathscr{d}}\right)+3\dot{p}_{1}\left(\ddot{w}_{h}-\ddot{% \mathscr{d}}\right)+p_{1}\left(\dddot{w}_{h}-\dddot{\mathscr{d}}\right)over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - script_d ) + 3 over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over˙ start_ARG script_d end_ARG ) + 3 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over¨ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over¨ start_ARG script_d end_ARG ) + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ( over˙˙˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - over˙˙˙ start_ARG script_d end_ARG )
+(𝒻˙˙˙cξ2+3𝒻¨cξ˙2+3𝒻˙cξ¨2+𝒻cξ˙˙˙2)𝒰+3(𝒻¨cξ2+2𝒻˙cξ˙2+𝒻cξ¨2)𝒰˙+3(𝒻˙cξ2+𝒻cξ˙2)𝒰¨+𝒻cξ2𝒰˙˙˙,subscript˙˙˙𝒻𝑐subscript𝜉23subscript¨𝒻𝑐subscript˙𝜉23subscript˙𝒻𝑐subscript¨𝜉2subscript𝒻𝑐subscript˙˙˙𝜉2𝒰3subscript¨𝒻𝑐subscript𝜉22subscript˙𝒻𝑐subscript˙𝜉2subscript𝒻𝑐subscript¨𝜉2˙𝒰3subscript˙𝒻𝑐subscript𝜉2subscript𝒻𝑐subscript˙𝜉2¨𝒰subscript𝒻𝑐subscript𝜉2˙˙˙𝒰\displaystyle+\left(\dddot{\mathscr{f}}_{c}\xi_{2}+3\ddot{\mathscr{f}}_{c}\dot% {\xi}_{2}+3\dot{\mathscr{f}}_{c}\ddot{\xi}_{2}+\mathscr{f}_{c}\dddot{\xi}_{2}% \right)\mathscr{U}+3\left(\ddot{\mathscr{f}}_{c}\xi_{2}+2\dot{\mathscr{f}}_{c}% \dot{\xi}_{2}+\mathscr{f}_{c}\ddot{\xi}_{2}\right)\dot{\mathscr{U}}+3\left(% \dot{\mathscr{f}}_{c}\xi_{2}+\mathscr{f}_{c}\dot{\xi}_{2}\right)\ddot{\mathscr% {U}}+\mathscr{f}_{c}\xi_{2}\dddot{\mathscr{U}},+ ( over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 3 over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 3 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) script_U + 3 ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) over˙ start_ARG script_U end_ARG + 3 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) over¨ start_ARG script_U end_ARG + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙˙˙ start_ARG script_U end_ARG ,
(4)=4absent\displaystyle\overset{\scriptscriptstyle(4)}{\mathcal{L}}=start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG caligraphic_L end_ARG = 𝒹˙˙˙w˙˙˙h(𝒻˙˙˙cΓ+3𝒻¨cΓ˙+3𝒻˙cΓ¨+𝒻cΓ˙˙˙)𝒰3(𝒻¨cΓ+2𝒻˙cΓ˙+𝒻cΓ¨)𝒰˙3(𝒻˙cΓ+𝒻cΓ˙)𝒰¨𝒻cΓ𝒰˙˙˙.˙˙˙𝒹subscript˙˙˙𝑤subscript˙˙˙𝒻𝑐Γ3subscript¨𝒻𝑐˙Γ3subscript˙𝒻𝑐¨Γsubscript𝒻𝑐˙˙˙Γ𝒰3subscript¨𝒻𝑐Γ2subscript˙𝒻𝑐˙Γsubscript𝒻𝑐¨Γ˙𝒰3subscript˙𝒻𝑐Γsubscript𝒻𝑐˙Γ¨𝒰subscript𝒻𝑐Γ˙˙˙𝒰\displaystyle\dddot{\mathscr{d}}-\dddot{w}_{h}-\left(\dddot{\mathscr{f}}_{c}% \Gamma+3\ddot{\mathscr{f}}_{c}\dot{\Gamma}+3\dot{\mathscr{f}}_{c}\ddot{\Gamma}% +\mathscr{f}_{c}\dddot{\Gamma}\right)\mathscr{U}-3\left(\ddot{\mathscr{f}}_{c}% \Gamma+2\dot{\mathscr{f}}_{c}\dot{\Gamma}+\mathscr{f}_{c}\ddot{\Gamma}\right)% \dot{\mathscr{U}}-3\left(\dot{\mathscr{f}}_{c}\Gamma+\mathscr{f}_{c}\dot{% \Gamma}\right)\ddot{\mathscr{U}}-\mathscr{f}_{c}\Gamma\dddot{\mathscr{U}}.over˙˙˙ start_ARG script_d end_ARG - over˙˙˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT - ( over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + 3 over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG + 3 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG roman_Γ end_ARG + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙˙˙ start_ARG roman_Γ end_ARG ) script_U - 3 ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG roman_Γ end_ARG ) over˙ start_ARG script_U end_ARG - 3 ( over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG roman_Γ end_ARG ) over¨ start_ARG script_U end_ARG - script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT roman_Γ over˙˙˙ start_ARG script_U end_ARG .

All the elements that appear in Eq. (47) are computed with the following formulation. Equation (48) computes the second time derivative of z^^𝑧\hat{z}over^ start_ARG italic_z end_ARG.

z^˙˙˙˙˙˙^𝑧\displaystyle\dddot{\hat{z}}over˙˙˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG =𝒞˙˙˙𝒻𝒟+3𝒞¨𝒻˙𝒟+3𝒞˙𝒻¨𝒟+𝒞𝒻˙˙˙𝒟,absent˙˙˙𝒞subscript𝒻𝒟3¨𝒞subscript˙𝒻𝒟3˙𝒞subscript¨𝒻𝒟𝒞subscript˙˙˙𝒻𝒟\displaystyle=\dddot{\mathcal{C}}\mathscr{f}_{\mathcal{D}}+3\ddot{\mathcal{C}}% \dot{\mathscr{f}}_{\mathcal{D}}+3\dot{\mathcal{C}}\ddot{\mathscr{f}}_{\mathcal% {D}}+\mathcal{C}\dddot{\mathscr{f}}_{\mathcal{D}},= over˙˙˙ start_ARG caligraphic_C end_ARG script_f start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + 3 over¨ start_ARG caligraphic_C end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + 3 over˙ start_ARG caligraphic_C end_ARG over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT + caligraphic_C over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT caligraphic_D end_POSTSUBSCRIPT , 𝒞˙˙˙˙˙˙𝒞\displaystyle\dddot{\mathcal{C}}over˙˙˙ start_ARG caligraphic_C end_ARG =2(Y˙˙˙q2+3Y¨q˙2+3Y˙q¨2+Yq˙˙˙2X˙˙˙q13X¨q˙13X˙q¨1Xq˙˙˙1),absent2˙˙˙𝑌subscript𝑞23¨𝑌subscript˙𝑞23˙𝑌subscript¨𝑞2𝑌subscript˙˙˙𝑞2˙˙˙𝑋subscript𝑞13¨𝑋subscript˙𝑞13˙𝑋subscript¨𝑞1𝑋subscript˙˙˙𝑞1\displaystyle=2\left(\dddot{Y}q_{2}+3\ddot{Y}\dot{q}_{2}+3\dot{Y}\ddot{q}_{2}+% Y\dddot{q}_{2}-\dddot{X}q_{1}-3\ddot{X}\dot{q}_{1}-3\dot{X}\ddot{q}_{1}-X% \dddot{q}_{1}\right),= 2 ( over˙˙˙ start_ARG italic_Y end_ARG italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_Y end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_Y end_ARG over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_Y over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT - over˙˙˙ start_ARG italic_X end_ARG italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - 3 over¨ start_ARG italic_X end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - 3 over˙ start_ARG italic_X end_ARG over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - italic_X over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ) , (48)
𝒟˙˙˙˙˙˙𝒟\displaystyle\dddot{\mathcal{D}}over˙˙˙ start_ARG caligraphic_D end_ARG =r˙˙˙qs+3r¨q˙s+3r˙q¨s+rq˙˙˙s,absent˙˙˙𝑟subscript𝑞𝑠3¨𝑟subscript˙𝑞𝑠3˙𝑟subscript¨𝑞𝑠𝑟subscript˙˙˙𝑞𝑠\displaystyle=\dddot{r}q_{s}+3\ddot{r}\dot{q}_{s}+3\dot{r}\ddot{q}_{s}+r\dddot% {q}_{s},= over˙˙˙ start_ARG italic_r end_ARG italic_q start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_r end_ARG over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_r end_ARG over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT + italic_r over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT , q˙˙˙ssubscript˙˙˙𝑞𝑠\displaystyle\dddot{q}_{s}over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(3q˙1q¨1+q1q˙˙˙1+3q˙2q¨2+q2q˙˙˙2).absent23subscript˙𝑞1subscript¨𝑞1subscript𝑞1subscript˙˙˙𝑞13subscript˙𝑞2subscript¨𝑞2subscript𝑞2subscript˙˙˙𝑞2\displaystyle=2\left(3\dot{q}_{1}\ddot{q}_{1}+q_{1}\dddot{q}_{1}+3\dot{q}_{2}% \ddot{q}_{2}+q_{2}\dddot{q}_{2}\right).= 2 ( 3 over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

The third order time derivatives of X𝑋Xitalic_X and Y𝑌Yitalic_Y are computed in Equation (49).

X˙˙˙˙˙˙𝑋\displaystyle\dddot{X}over˙˙˙ start_ARG italic_X end_ARG =r˙˙˙𝒸L+2r¨𝒸˙L+r˙𝒸¨L𝓌¨𝓈L2𝓌˙𝓈˙L𝓌𝓈¨L,absent˙˙˙𝑟subscript𝒸𝐿2¨𝑟subscript˙𝒸𝐿˙𝑟subscript¨𝒸𝐿¨𝓌subscript𝓈𝐿2˙𝓌subscript˙𝓈𝐿𝓌subscript¨𝓈𝐿\displaystyle=\dddot{r}\mathscr{c}_{L}+2\ddot{r}\dot{\mathscr{c}}_{L}+\dot{r}% \ddot{\mathscr{c}}_{L}-\ddot{\mathscr{w}}\mathscr{s}_{L}-2\dot{\mathscr{w}}% \dot{\mathscr{s}}_{L}-\mathscr{w}\ddot{\mathscr{s}}_{L},= over˙˙˙ start_ARG italic_r end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + 2 over¨ start_ARG italic_r end_ARG over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over˙ start_ARG italic_r end_ARG over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - over¨ start_ARG script_w end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 2 over˙ start_ARG script_w end_ARG over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - script_w over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT , (49)
Y˙˙˙˙˙˙𝑌\displaystyle\dddot{Y}over˙˙˙ start_ARG italic_Y end_ARG =r˙˙˙𝓈L+2r¨𝓈˙L+r˙𝓈¨L+𝓌¨𝒸L+2𝓌˙𝒸˙L+𝓌𝒸¨L,absent˙˙˙𝑟subscript𝓈𝐿2¨𝑟subscript˙𝓈𝐿˙𝑟subscript¨𝓈𝐿¨𝓌subscript𝒸𝐿2˙𝓌subscript˙𝒸𝐿𝓌subscript¨𝒸𝐿\displaystyle=\dddot{r}\mathscr{s}_{L}+2\ddot{r}\dot{\mathscr{s}}_{L}+\dot{r}% \ddot{\mathscr{s}}_{L}+\ddot{\mathscr{w}}\mathscr{c}_{L}+2\dot{\mathscr{w}}% \dot{\mathscr{c}}_{L}+\mathscr{w}\ddot{\mathscr{c}}_{L},= over˙˙˙ start_ARG italic_r end_ARG script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + 2 over¨ start_ARG italic_r end_ARG over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over˙ start_ARG italic_r end_ARG over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + over¨ start_ARG script_w end_ARG script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + 2 over˙ start_ARG script_w end_ARG over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + script_w over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT ,
𝓌¨¨𝓌\displaystyle\ddot{\mathscr{w}}over¨ start_ARG script_w end_ARG =h¨𝒻r+2h˙𝒻˙r+h𝒻¨r,absent¨subscript𝒻𝑟2˙subscript˙𝒻𝑟subscript¨𝒻𝑟\displaystyle=\ddot{h}\mathscr{f}_{r}+2\dot{h}\dot{\mathscr{f}}_{r}+h\ddot{% \mathscr{f}}_{r},= over¨ start_ARG italic_h end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_h end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_h over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ,
r˙˙˙˙˙˙𝑟\displaystyle\dddot{r}over˙˙˙ start_ARG italic_r end_ARG =μ(𝒻¨crpl+2𝒻˙cr˙pl+𝒻cr¨pl),absent𝜇subscript¨𝒻𝑐subscript𝑟𝑝𝑙2subscript˙𝒻𝑐subscript˙𝑟𝑝𝑙subscript𝒻𝑐subscript¨𝑟𝑝𝑙\displaystyle=\mu\left(\ddot{\mathscr{f}}_{c}r_{pl}+2\dot{\mathscr{f}}_{c}\dot% {r}_{pl}+\mathscr{f}_{c}\ddot{r}_{pl}\right),= italic_μ ( over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT italic_r start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT + 2 over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT + script_f start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT ) ,
r¨plsubscript¨𝑟𝑝𝑙\displaystyle\ddot{r}_{pl}over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_p italic_l end_POSTSUBSCRIPT =p¨2𝓈L+2p˙2𝓈˙L+p2𝓈¨Lp¨1𝒸L2p˙1𝒸˙Lp1𝒸¨L.absentsubscript¨𝑝2subscript𝓈𝐿2subscript˙𝑝2subscript˙𝓈𝐿subscript𝑝2subscript¨𝓈𝐿subscript¨𝑝1subscript𝒸𝐿2subscript˙𝑝1subscript˙𝒸𝐿subscript𝑝1subscript¨𝒸𝐿\displaystyle=\ddot{p}_{2}\mathscr{s}_{L}+2\dot{p}_{2}\dot{\mathscr{s}}_{L}+p_% {2}\ddot{\mathscr{s}}_{L}-\ddot{p}_{1}\mathscr{c}_{L}-2\dot{p}_{1}\dot{% \mathscr{c}}_{L}-p_{1}\ddot{\mathscr{c}}_{L}.= over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - 2 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT .

Equation (50) computes the third order time derivative of 𝒰𝒰\mathscr{U}script_U and Uzsubscript𝑈𝑧U_{z}italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT.

𝒰˙˙˙˙˙˙𝒰\displaystyle\dddot{\mathscr{U}}over˙˙˙ start_ARG script_U end_ARG =A(U˙˙˙z𝒻r3+3U¨z𝒻˙r3+3U˙z𝒻¨r3+Uz𝒻˙˙˙r3),absent𝐴subscript˙˙˙𝑈𝑧subscript𝒻superscript𝑟33subscript¨𝑈𝑧subscript˙𝒻superscript𝑟33subscript˙𝑈𝑧subscript¨𝒻superscript𝑟3subscript𝑈𝑧subscript˙˙˙𝒻superscript𝑟3\displaystyle=-A\left(\dddot{U}_{z}\mathscr{f}_{r^{3}}+3\ddot{U}_{z}\dot{% \mathscr{f}}_{r^{3}}+3\dot{U}_{z}\ddot{\mathscr{f}}_{r^{3}}+U_{z}\dddot{% \mathscr{f}}_{r^{3}}\right),= - italic_A ( over˙˙˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + italic_U start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT ) , (50)
U˙˙˙zsubscript˙˙˙𝑈𝑧\displaystyle\dddot{U}_{z}over˙˙˙ start_ARG italic_U end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT =6(3z^˙z^¨+z^z^˙˙˙),absent63˙^𝑧¨^𝑧^𝑧˙˙˙^𝑧\displaystyle=-6\left(3\dot{\hat{z}}\ddot{\hat{z}}+\hat{z}\dddot{\hat{z}}% \right),= - 6 ( 3 over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG + over^ start_ARG italic_z end_ARG over˙˙˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG ) ,
d3(r3)dt3superscript𝑑3superscript𝑟3𝑑superscript𝑡3\displaystyle\frac{d^{3}(r^{3})}{dt^{3}}divide start_ARG italic_d start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT ( italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG =r˙˙˙c=3(2r˙3+6rr˙r¨+r2r˙˙˙).absentsubscript˙˙˙𝑟𝑐32superscript˙𝑟36𝑟˙𝑟¨𝑟superscript𝑟2˙˙˙𝑟\displaystyle=\dddot{r}_{c}=3\left(2\dot{r}^{3}+6r\dot{r}\ddot{r}+r^{2}\dddot{% r}\right).= over˙˙˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT = 3 ( 2 over˙ start_ARG italic_r end_ARG start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT + 6 italic_r over˙ start_ARG italic_r end_ARG over¨ start_ARG italic_r end_ARG + italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙˙˙ start_ARG italic_r end_ARG ) .

Equation (51) includes the third order derivatives of ΓΓ\Gammaroman_Γ and β𝛽\betaitalic_β.

Γ˙˙˙˙˙˙Γ\displaystyle\dddot{\Gamma}over˙˙˙ start_ARG roman_Γ end_ARG =𝒻˙˙˙α+α¨(1ra)3α¨r˙a3α˙r¨aαr˙˙˙a,absentsubscript˙˙˙𝒻𝛼¨𝛼1𝑟𝑎3¨𝛼˙𝑟𝑎3˙𝛼¨𝑟𝑎𝛼˙˙˙𝑟𝑎\displaystyle=\dddot{\mathscr{f}}_{\alpha}+\ddot{\alpha}\left(1-\frac{r}{a}% \right)-3\ddot{\alpha}\frac{\dot{r}}{a}-3\dot{\alpha}\frac{\ddot{r}}{a}-\alpha% \frac{\dddot{r}}{a},= over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_α end_POSTSUBSCRIPT + over¨ start_ARG italic_α end_ARG ( 1 - divide start_ARG italic_r end_ARG start_ARG italic_a end_ARG ) - 3 over¨ start_ARG italic_α end_ARG divide start_ARG over˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG - 3 over˙ start_ARG italic_α end_ARG divide start_ARG over¨ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG - italic_α divide start_ARG over˙˙˙ start_ARG italic_r end_ARG end_ARG start_ARG italic_a end_ARG , α˙˙˙˙˙˙𝛼\displaystyle\dddot{\alpha}over˙˙˙ start_ARG italic_α end_ARG =𝒻˙˙˙1+β,absentsubscript˙˙˙𝒻1𝛽\displaystyle=\dddot{\mathscr{f}}_{1+\beta},= over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT 1 + italic_β end_POSTSUBSCRIPT , (51)
β˙˙˙˙˙˙𝛽\displaystyle\dddot{\beta}over˙˙˙ start_ARG italic_β end_ARG =12(p˙˙˙s𝒻β+2p¨s𝒻˙β+p˙s𝒻¨β),𝒻˙˙˙β,absent12subscript˙˙˙𝑝𝑠subscript𝒻𝛽2subscript¨𝑝𝑠subscript˙𝒻𝛽subscript˙𝑝𝑠subscript¨𝒻𝛽subscript˙˙˙𝒻𝛽\displaystyle=-\frac{1}{2}\left(\dddot{p}_{s}\mathscr{f}_{\beta}+2\ddot{p}_{s}% \dot{\mathscr{f}}_{\beta}+\dot{p}_{s}\ddot{\mathscr{f}}_{\beta}\right),\dddot{% \mathscr{f}}_{\beta},= - divide start_ARG 1 end_ARG start_ARG 2 end_ARG ( over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT script_f start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT + 2 over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT + over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT ) , over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_β end_POSTSUBSCRIPT , p˙˙˙ssubscript˙˙˙𝑝𝑠\displaystyle\dddot{p}_{s}over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT =2(3p˙1p¨1+p1p˙˙˙1+3p˙2p¨2+p2p˙˙˙2).absent23subscript˙𝑝1subscript¨𝑝1subscript𝑝1subscript˙˙˙𝑝13subscript˙𝑝2subscript¨𝑝2subscript𝑝2subscript˙˙˙𝑝2\displaystyle=2\left(3\dot{p}_{1}\ddot{p}_{1}+p_{1}\dddot{p}_{1}+3\dot{p}_{2}% \ddot{p}_{2}+p_{2}\dddot{p}_{2}\right).= 2 ( 3 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over¨ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ) .

Equation (52) computes the third order time derivative of I𝐼Iitalic_I.

I˙˙˙˙˙˙𝐼\displaystyle\dddot{I}over˙˙˙ start_ARG italic_I end_ARG =3A[(z^˙˙˙δ+3z^¨δ˙+3z^˙δ¨+z^δ˙˙˙)𝒻𝒽+3(z^¨δ+2z^˙δ˙+z^δ¨)𝒻˙𝒽+3(z^˙δ+z^δ˙)𝒻¨𝒽+z^δ𝒻˙˙˙𝒽],absent3𝐴delimited-[]˙˙˙^𝑧𝛿3¨^𝑧˙𝛿3˙^𝑧¨𝛿^𝑧˙˙˙𝛿subscript𝒻𝒽3¨^𝑧𝛿2˙^𝑧˙𝛿^𝑧¨𝛿subscript˙𝒻𝒽3˙^𝑧𝛿^𝑧˙𝛿subscript¨𝒻𝒽^𝑧𝛿subscript˙˙˙𝒻𝒽\displaystyle=3A\left[\left(\dddot{\hat{z}}\delta+3\ddot{\hat{z}}\dot{\delta}+% 3\dot{\hat{z}}\ddot{\delta}+\hat{z}\dddot{\delta}\right)\mathscr{f}_{\mathscr{% h}}+3\left(\ddot{\hat{z}}\delta+2\dot{\hat{z}}\dot{\delta}+\hat{z}\ddot{\delta% }\right)\dot{\mathscr{f}}_{\mathscr{h}}+3\left(\dot{\hat{z}}\delta+\hat{z}\dot% {\delta}\right)\ddot{\mathscr{f}}_{\mathscr{h}}+\hat{z}\delta\dddot{\mathscr{f% }}_{\mathscr{h}}\right],= 3 italic_A [ ( over˙˙˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + 3 over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG over˙ start_ARG italic_δ end_ARG + 3 over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG over¨ start_ARG italic_δ end_ARG + over^ start_ARG italic_z end_ARG over˙˙˙ start_ARG italic_δ end_ARG ) script_f start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + 3 ( over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + 2 over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG over˙ start_ARG italic_δ end_ARG + over^ start_ARG italic_z end_ARG over¨ start_ARG italic_δ end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + 3 ( over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG italic_δ + over^ start_ARG italic_z end_ARG over˙ start_ARG italic_δ end_ARG ) over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT + over^ start_ARG italic_z end_ARG italic_δ over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT script_h end_POSTSUBSCRIPT ] , (52)
𝒽˙˙˙˙˙˙𝒽\displaystyle\dddot{\mathscr{h}}over˙˙˙ start_ARG script_h end_ARG =h˙˙˙rc+3h¨r˙c+3h˙r¨c+hr˙˙˙c,absent˙˙˙subscript𝑟𝑐3¨subscript˙𝑟𝑐3˙subscript¨𝑟𝑐subscript˙˙˙𝑟𝑐\displaystyle=\dddot{h}r_{c}+3\ddot{h}\dot{r}_{c}+3\dot{h}\ddot{r}_{c}+h\dddot% {r}_{c},= over˙˙˙ start_ARG italic_h end_ARG italic_r start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_h end_ARG over˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_h end_ARG over¨ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT + italic_h over˙˙˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT ,
h˙˙˙˙˙˙\displaystyle\dddot{h}over˙˙˙ start_ARG italic_h end_ARG =(¨c2¨r𝒰6˙r𝒰˙6r𝒰¨r2𝒰˙˙˙)𝒻h+2(˙c2˙r𝒰4r𝒰˙r2𝒰¨)𝒻˙h+(c2r𝒰r2𝒰˙)𝒻¨h,absentsubscript¨𝑐2subscript¨𝑟𝒰6subscript˙𝑟˙𝒰6subscript𝑟¨𝒰superscript𝑟2˙˙˙𝒰subscript𝒻2subscript˙𝑐2subscript˙𝑟𝒰4subscript𝑟˙𝒰superscript𝑟2¨𝒰subscript˙𝒻subscript𝑐2subscript𝑟𝒰superscript𝑟2˙𝒰subscript¨𝒻\displaystyle=\left(\ddot{\mathscr{g}}_{c}-2\ddot{\mathscr{g}}_{r}\mathscr{U}-% 6\dot{\mathscr{g}}_{r}\dot{\mathscr{U}}-6\mathscr{g}_{r}\ddot{\mathscr{U}}-r^{% 2}\dddot{\mathscr{U}}\right)\mathscr{f}_{h}+2\left(\dot{\mathscr{g}}_{c}-2\dot% {\mathscr{g}}_{r}\mathscr{U}-4\mathscr{g}_{r}\dot{\mathscr{U}}-r^{2}\ddot{% \mathscr{U}}\right)\dot{\mathscr{f}}_{h}+\left(\mathscr{g}_{c}-2\mathscr{g}_{r% }\mathscr{U}-r^{2}\dot{\mathscr{U}}\right)\ddot{\mathscr{f}}_{h},= ( over¨ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 over¨ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - 6 over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT over˙ start_ARG script_U end_ARG - 6 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT over¨ start_ARG script_U end_ARG - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙˙˙ start_ARG script_U end_ARG ) script_f start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT + 2 ( over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - 4 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT over˙ start_ARG script_U end_ARG - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG script_U end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT + ( script_g start_POSTSUBSCRIPT italic_c end_POSTSUBSCRIPT - 2 script_g start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT script_U - italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙ start_ARG script_U end_ARG ) over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT ,
c˙˙˙˙˙˙𝑐\displaystyle\dddot{c}over˙˙˙ start_ARG italic_c end_ARG =(μ2ν)1/3β˙˙˙,absentsuperscriptsuperscript𝜇2𝜈13˙˙˙𝛽\displaystyle=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\dddot{\beta},= ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT over˙˙˙ start_ARG italic_β end_ARG ,
δ˙˙˙˙˙˙𝛿\displaystyle\dddot{\delta}over˙˙˙ start_ARG italic_δ end_ARG =q˙˙˙s.absentsubscript˙˙˙𝑞𝑠\displaystyle=-\dddot{q}_{s}.= - over˙˙˙ start_ARG italic_q end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT .

Equation (53) computes the third time derivative of 𝒹𝒹\mathscr{d}script_d.

𝒹˙˙˙˙˙˙𝒹\displaystyle\dddot{\mathscr{d}}over˙˙˙ start_ARG script_d end_ARG =(h˙˙˙c˙˙˙)𝒻r2+3(h¨c¨)𝒻˙r2+3(h˙c˙)𝒻¨r2+(hc)𝒻˙˙˙r2,absent˙˙˙˙˙˙𝑐subscript𝒻superscript𝑟23¨¨𝑐subscript˙𝒻superscript𝑟23˙˙𝑐subscript¨𝒻superscript𝑟2𝑐subscript˙˙˙𝒻superscript𝑟2\displaystyle=\left(\dddot{h}-\dddot{c}\right)\mathscr{f}_{r^{2}}+3\left(\ddot% {h}-\ddot{c}\right)\dot{\mathscr{f}}_{r^{2}}+3\left(\dot{h}-\dot{c}\right)% \ddot{\mathscr{f}}_{r^{2}}+\left(h-c\right)\dddot{\mathscr{f}}_{r^{2}},= ( over˙˙˙ start_ARG italic_h end_ARG - over˙˙˙ start_ARG italic_c end_ARG ) script_f start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 3 ( over¨ start_ARG italic_h end_ARG - over¨ start_ARG italic_c end_ARG ) over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + 3 ( over˙ start_ARG italic_h end_ARG - over˙ start_ARG italic_c end_ARG ) over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT + ( italic_h - italic_c ) over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_POSTSUBSCRIPT , d3(r2)dt3=r˙˙˙s=2¨r.superscript𝑑3superscript𝑟2𝑑superscript𝑡3subscript˙˙˙𝑟𝑠2subscript¨𝑟\displaystyle\frac{d^{3}(r^{2})}{dt^{3}}=\dddot{r}_{s}=2\ddot{\mathscr{g}}_{r}.divide start_ARG italic_d start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT ( italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) end_ARG start_ARG italic_d italic_t start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG = over˙˙˙ start_ARG italic_r end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 2 over¨ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT . (53)

The third order time derivatives of whsubscript𝑤w_{h}italic_w start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT, ξ1subscript𝜉1\xi_{1}italic_ξ start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT, ξ2subscript𝜉2\xi_{2}italic_ξ start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT, 𝓈Lsubscript𝓈𝐿\mathscr{s}_{L}script_s start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT and 𝒸Lsubscript𝒸𝐿\mathscr{c}_{L}script_c start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT are in Equation (54).

w˙˙˙hsubscript˙˙˙𝑤\displaystyle\dddot{w}_{h}over˙˙˙ start_ARG italic_w end_ARG start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT =I˙˙˙z^+3I¨z^˙+3I˙z^¨+Iz^˙˙˙,absent˙˙˙𝐼^𝑧3¨𝐼˙^𝑧3˙𝐼¨^𝑧𝐼˙˙˙^𝑧\displaystyle=\dddot{I}\hat{z}+3\ddot{I}\dot{\hat{z}}+3\dot{I}\ddot{\hat{z}}+I% \dddot{\hat{z}},= over˙˙˙ start_ARG italic_I end_ARG over^ start_ARG italic_z end_ARG + 3 over¨ start_ARG italic_I end_ARG over˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG + 3 over˙ start_ARG italic_I end_ARG over¨ start_ARG over^ start_ARG italic_z end_ARG end_ARG + italic_I over˙˙˙ start_ARG over^ start_ARG italic_z end_ARG end_ARG , (54)
ξ˙˙˙1subscript˙˙˙𝜉1\displaystyle\dddot{\xi}_{1}over˙˙˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT =X˙˙˙a+2p˙˙˙2,absent˙˙˙𝑋𝑎2subscript˙˙˙𝑝2\displaystyle=\frac{\dddot{X}}{a}+2\dddot{p}_{2},= divide start_ARG over˙˙˙ start_ARG italic_X end_ARG end_ARG start_ARG italic_a end_ARG + 2 over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ,
ξ˙˙˙2subscript˙˙˙𝜉2\displaystyle\dddot{\xi}_{2}over˙˙˙ start_ARG italic_ξ end_ARG start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT =Y˙˙˙a+2p˙˙˙1,absent˙˙˙𝑌𝑎2subscript˙˙˙𝑝1\displaystyle=\frac{\dddot{Y}}{a}+2\dddot{p}_{1},= divide start_ARG over˙˙˙ start_ARG italic_Y end_ARG end_ARG start_ARG italic_a end_ARG + 2 over˙˙˙ start_ARG italic_p end_ARG start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ,
𝓈˙˙˙Lsubscript˙˙˙𝓈𝐿\displaystyle\dddot{\mathscr{s}}_{L}over˙˙˙ start_ARG script_s end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =Y˙˙˙𝒻r+3Y¨𝒻˙r+3Y˙𝒻¨r+Y𝒻˙˙˙r,absent˙˙˙𝑌subscript𝒻𝑟3¨𝑌subscript˙𝒻𝑟3˙𝑌subscript¨𝒻𝑟𝑌subscript˙˙˙𝒻𝑟\displaystyle=\dddot{Y}\mathscr{f}_{r}+3\ddot{Y}\dot{\mathscr{f}}_{r}+3\dot{Y}% \ddot{\mathscr{f}}_{r}+Y\dddot{\mathscr{f}}_{r},= over˙˙˙ start_ARG italic_Y end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_Y end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_Y end_ARG over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_Y over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT ,
𝒸˙˙˙Lsubscript˙˙˙𝒸𝐿\displaystyle\dddot{\mathscr{c}}_{L}over˙˙˙ start_ARG script_c end_ARG start_POSTSUBSCRIPT italic_L end_POSTSUBSCRIPT =X˙˙˙𝒻r+3X¨𝒻˙r+3X˙𝒻¨r+X𝒻˙˙˙r.absent˙˙˙𝑋subscript𝒻𝑟3¨𝑋subscript˙𝒻𝑟3˙𝑋subscript¨𝒻𝑟𝑋subscript˙˙˙𝒻𝑟\displaystyle=\dddot{X}\mathscr{f}_{r}+3\ddot{X}\dot{\mathscr{f}}_{r}+3\dot{X}% \ddot{\mathscr{f}}_{r}+X\dddot{\mathscr{f}}_{r}.= over˙˙˙ start_ARG italic_X end_ARG script_f start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 3 over¨ start_ARG italic_X end_ARG over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + 3 over˙ start_ARG italic_X end_ARG over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + italic_X over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT .

A.5 Derivatives of the 𝒻ssubscript𝒻𝑠\mathscr{f}_{s}script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT and ssubscript𝑠\mathscr{g}_{s}script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT time derivatives with respect to the element x𝑥xitalic_x

When 𝒻(k)ssubscript𝑘𝒻𝑠\overset{\scriptscriptstyle(k)}{\mathscr{f}}_{s}start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT is derived with respect to x𝑥xitalic_x, then all the derivatives up to s(k)𝑘𝑠\overset{\scriptscriptstyle(k)}{s}start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG italic_s end_ARG with respect to x𝑥xitalic_x (with standard notation s(k)xsubscript𝑘𝑠𝑥\overset{\scriptscriptstyle(k)}{s}_{x}start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT) are needed (or up to s(k+1)𝑘1𝑠\overset{\scriptscriptstyle(k+1)}{s}start_OVERACCENT ( italic_k + 1 ) end_OVERACCENT start_ARG italic_s end_ARG in the case of (k)ssubscript𝑘𝑠\overset{\scriptscriptstyle(k)}{\mathscr{g}}_{s}start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT). The notation for the cross derivative used here meets 𝒻s(k)/x=𝒻s(k),x𝑘subscript𝒻𝑠𝑥𝑘𝑥subscript𝒻𝑠\partial\overset{\scriptscriptstyle(k)}{\mathscr{f}_{s}}/\partial x=\overset{% \scriptscriptstyle(k),x}{\mathscr{f}_{s}}∂ start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG / ∂ italic_x = start_OVERACCENT ( italic_k ) , italic_x end_OVERACCENT start_ARG script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG, chose on purpose for the compact expressions developed in this appendix section.

Thus, the function that computes 𝒻(k),xssubscript𝑘𝑥𝒻𝑠\overset{\scriptscriptstyle{(k),x}}{\mathscr{f}}_{s}start_OVERACCENT ( italic_k ) , italic_x end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT needs not only the vector [s,s˙,,s(k)]𝑠˙𝑠𝑘𝑠\left[s,\dot{s},\cdots,\overset{\scriptscriptstyle(k)}{s}\right][ italic_s , over˙ start_ARG italic_s end_ARG , ⋯ , start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG italic_s end_ARG ], but also [sx,s˙x,,s(k)x]subscript𝑠𝑥subscript˙𝑠𝑥subscript𝑘𝑠𝑥\left[s_{x},\dot{s}_{x},\cdots,\overset{\scriptscriptstyle(k)}{s}_{x}\right][ italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT , over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT , ⋯ , start_OVERACCENT ( italic_k ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ] as input. Here are the expressions of the function that implements these derivatives:

𝒻sx=𝒻𝑥s=subscript𝒻𝑠𝑥subscript𝑥𝒻𝑠absent\displaystyle\frac{\partial\mathscr{f}_{s}}{\partial x}=\overset{% \scriptscriptstyle{x}}{\mathscr{f}}_{s}=divide start_ARG ∂ script_f start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = overitalic_x start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = sxs2,subscript𝑠𝑥superscript𝑠2\displaystyle-\frac{s_{x}}{s^{2}},- divide start_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG , (55)
𝒻˙sx=𝒻(1),xs=subscript˙𝒻𝑠𝑥subscript1𝑥𝒻𝑠absent\displaystyle\frac{\partial\dot{\mathscr{f}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(1),x}}{\mathscr{f}}_{s}=divide start_ARG ∂ over˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 1 ) , italic_x end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = s˙xs2+2s˙sxs3,subscript˙𝑠𝑥superscript𝑠22˙𝑠subscript𝑠𝑥superscript𝑠3\displaystyle-\frac{\dot{s}_{x}}{s^{2}}+2\frac{\dot{s}s_{x}}{s^{3}},- divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + 2 divide start_ARG over˙ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG ,
𝒻¨sx=𝒻(2),xs=subscript¨𝒻𝑠𝑥subscript2𝑥𝒻𝑠absent\displaystyle\frac{\partial\ddot{\mathscr{f}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(2),x}}{\mathscr{f}}_{s}=divide start_ARG ∂ over¨ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 2 ) , italic_x end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = s¨xs2+2s¨sx+2s˙s˙xs36s˙2sxs4,subscript¨𝑠𝑥superscript𝑠22¨𝑠subscript𝑠𝑥2˙𝑠subscript˙𝑠𝑥superscript𝑠36superscript˙𝑠2subscript𝑠𝑥superscript𝑠4\displaystyle-\frac{\ddot{s}_{x}}{s^{2}}+2\frac{\ddot{s}s_{x}+2\dot{s}\dot{s}_% {x}}{s^{3}}-6\frac{\dot{s}^{2}s_{x}}{s^{4}},- divide start_ARG over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + 2 divide start_ARG over¨ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 2 over˙ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - 6 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG ,
𝒻˙˙˙sx=𝒻(3),xs=subscript˙˙˙𝒻𝑠𝑥subscript3𝑥𝒻𝑠absent\displaystyle\frac{\partial\dddot{\mathscr{f}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(3),x}}{\mathscr{f}}_{s}=divide start_ARG ∂ over˙˙˙ start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 3 ) , italic_x end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = s˙˙˙xs2+2s˙˙˙sx+3(s¨xs˙+s¨s˙x)s318s¨s˙sx+s˙2s˙xs4+24s˙3sxs5,subscript˙˙˙𝑠𝑥superscript𝑠22˙˙˙𝑠subscript𝑠𝑥3subscript¨𝑠𝑥˙𝑠¨𝑠subscript˙𝑠𝑥superscript𝑠318¨𝑠˙𝑠subscript𝑠𝑥superscript˙𝑠2subscript˙𝑠𝑥superscript𝑠424superscript˙𝑠3subscript𝑠𝑥superscript𝑠5\displaystyle-\frac{\dddot{s}_{x}}{s^{2}}+2\frac{\dddot{s}s_{x}+3\left(\ddot{s% }_{x}\dot{s}+\ddot{s}\dot{s}_{x}\right)}{s^{3}}-18\frac{\ddot{s}\dot{s}s_{x}+% \dot{s}^{2}\dot{s}_{x}}{s^{4}}+24\frac{\dot{s}^{3}s_{x}}{s^{5}},- divide start_ARG over˙˙˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + 2 divide start_ARG over˙˙˙ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 3 ( over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over˙ start_ARG italic_s end_ARG + over¨ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ) end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - 18 divide start_ARG over¨ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG + 24 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 5 end_POSTSUPERSCRIPT end_ARG ,
𝒻(4)sx=𝒻(4),xs=subscript4𝒻𝑠𝑥subscript4𝑥𝒻𝑠absent\displaystyle\frac{\partial\overset{\scriptscriptstyle{(4)}}{\mathscr{f}}_{s}}% {\partial x}=\overset{\scriptscriptstyle{(4),x}}{\mathscr{f}}_{s}=divide start_ARG ∂ start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 4 ) , italic_x end_OVERACCENT start_ARG script_f end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = s(4)xs2+2s(4)sx+6s¨s¨x+4(s˙˙˙xs˙+s(3)s˙x)s364s(3)s˙sx+6(2s˙s˙xs¨+s˙2s¨x)+3s¨2sxs4subscript4𝑠𝑥superscript𝑠224𝑠subscript𝑠𝑥6¨𝑠subscript¨𝑠𝑥4subscript˙˙˙𝑠𝑥˙𝑠3𝑠subscript˙𝑠𝑥superscript𝑠3643𝑠˙𝑠subscript𝑠𝑥62˙𝑠subscript˙𝑠𝑥¨𝑠superscript˙𝑠2subscript¨𝑠𝑥3superscript¨𝑠2subscript𝑠𝑥superscript𝑠4\displaystyle-\frac{\overset{\scriptscriptstyle(4)}{s}_{x}}{s^{2}}+2\frac{% \overset{\scriptscriptstyle(4)}{s}s_{x}+6\ddot{s}\ddot{s}_{x}+4\left(\dddot{s}% _{x}\dot{s}+\overset{\scriptscriptstyle(3)}{s}\dot{s}_{x}\right)}{s^{3}}-6% \frac{4\overset{\scriptscriptstyle(3)}{s}\dot{s}s_{x}+6\left(2\dot{s}\dot{s}_{% x}\ddot{s}+\dot{s}^{2}\ddot{s}_{x}\right)+3\ddot{s}^{2}s_{x}}{s^{4}}- divide start_ARG start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + 2 divide start_ARG start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 6 over¨ start_ARG italic_s end_ARG over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 4 ( over˙˙˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over˙ start_ARG italic_s end_ARG + start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ) end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG - 6 divide start_ARG 4 start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 6 ( 2 over˙ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over¨ start_ARG italic_s end_ARG + over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ) + 3 over¨ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT end_ARG
+1212s˙2s¨sx8s˙3s˙xs5+120s˙4sxs6.1212superscript˙𝑠2¨𝑠subscript𝑠𝑥8superscript˙𝑠3subscript˙𝑠𝑥superscript𝑠5120superscript˙𝑠4subscript𝑠𝑥superscript𝑠6\displaystyle+12\frac{12\dot{s}^{2}\ddot{s}s_{x}-8\dot{s}^{3}\dot{s}_{x}}{s^{5% }}+120\frac{\dot{s}^{4}s_{x}}{s^{6}}.+ 12 divide start_ARG 12 over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT over¨ start_ARG italic_s end_ARG italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT - 8 over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 5 end_POSTSUPERSCRIPT end_ARG + 120 divide start_ARG over˙ start_ARG italic_s end_ARG start_POSTSUPERSCRIPT 4 end_POSTSUPERSCRIPT italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG italic_s start_POSTSUPERSCRIPT 6 end_POSTSUPERSCRIPT end_ARG .

And similarly for (k),xssubscript𝑘𝑥𝑠\overset{\scriptscriptstyle{(k),x}}{\mathscr{g}}_{s}start_OVERACCENT ( italic_k ) , italic_x end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT the derivatives are:

sx=𝑥s=subscript𝑠𝑥subscript𝑥𝑠absent\displaystyle\frac{\partial\mathscr{g}_{s}}{\partial x}=\overset{% \scriptscriptstyle{x}}{\mathscr{g}}_{s}=divide start_ARG ∂ script_g start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = overitalic_x start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = sxs˙+ss˙x,subscript𝑠𝑥˙𝑠𝑠subscript˙𝑠𝑥\displaystyle s_{x}\dot{s}+s\dot{s}_{x},italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over˙ start_ARG italic_s end_ARG + italic_s over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT , (56)
˙sx=(1),xs=subscript˙𝑠𝑥subscript1𝑥𝑠absent\displaystyle\frac{\partial\dot{\mathscr{g}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(1),x}}{\mathscr{g}}_{s}=divide start_ARG ∂ over˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 1 ) , italic_x end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 2s˙s˙x+sxs¨+ss¨x,2˙𝑠subscript˙𝑠𝑥subscript𝑠𝑥¨𝑠𝑠subscript¨𝑠𝑥\displaystyle 2\dot{s}\dot{s}_{x}+s_{x}\ddot{s}+s\ddot{s}_{x},2 over˙ start_ARG italic_s end_ARG over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over¨ start_ARG italic_s end_ARG + italic_s over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ,
¨sx=(2),xs=subscript¨𝑠𝑥subscript2𝑥𝑠absent\displaystyle\frac{\partial\ddot{\mathscr{g}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(2),x}}{\mathscr{g}}_{s}=divide start_ARG ∂ over¨ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 2 ) , italic_x end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 3s˙xs¨+3s˙s¨x+sxs˙˙˙+ss˙˙˙x,3subscript˙𝑠𝑥¨𝑠3˙𝑠subscript¨𝑠𝑥subscript𝑠𝑥˙˙˙𝑠𝑠subscript˙˙˙𝑠𝑥\displaystyle 3\dot{s}_{x}\ddot{s}+3\dot{s}\ddot{s}_{x}+s_{x}\dddot{s}+s\dddot% {s}_{x},3 over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over¨ start_ARG italic_s end_ARG + 3 over˙ start_ARG italic_s end_ARG over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT over˙˙˙ start_ARG italic_s end_ARG + italic_s over˙˙˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ,
˙˙˙sx=(3),xs=subscript˙˙˙𝑠𝑥subscript3𝑥𝑠absent\displaystyle\frac{\partial\dddot{\mathscr{g}}_{s}}{\partial x}=\overset{% \scriptscriptstyle{(3),x}}{\mathscr{g}}_{s}=divide start_ARG ∂ over˙˙˙ start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 3 ) , italic_x end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 6s¨s¨x+4s˙xs(3)+4s˙s(3)x+sxs(4)+ss(4)x,6¨𝑠subscript¨𝑠𝑥4subscript˙𝑠𝑥3𝑠4˙𝑠subscript3𝑠𝑥subscript𝑠𝑥4𝑠𝑠subscript4𝑠𝑥\displaystyle 6\ddot{s}\ddot{s}_{x}+4\dot{s}_{x}\overset{\scriptscriptstyle(3)% }{s}+4\dot{s}\overset{\scriptscriptstyle(3)}{s}_{x}+s_{x}\overset{% \scriptscriptstyle(4)}{s}+s\overset{\scriptscriptstyle(4)}{s}_{x},6 over¨ start_ARG italic_s end_ARG over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 4 over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG + 4 over˙ start_ARG italic_s end_ARG start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG + italic_s start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT ,
(4)sx=(4),xs=subscript4𝑠𝑥subscript4𝑥𝑠absent\displaystyle\frac{\partial\overset{\scriptscriptstyle{(4)}}{\mathscr{g}}_{s}}% {\partial x}=\overset{\scriptscriptstyle{(4),x}}{\mathscr{g}}_{s}=divide start_ARG ∂ start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT end_ARG start_ARG ∂ italic_x end_ARG = start_OVERACCENT ( 4 ) , italic_x end_OVERACCENT start_ARG script_g end_ARG start_POSTSUBSCRIPT italic_s end_POSTSUBSCRIPT = 10s¨xs(3)+10s¨s(3)x+5s˙xs(4)+5s˙s(4)x+sxs(5)+ss(5)x.10subscript¨𝑠𝑥3𝑠10¨𝑠subscript3𝑠𝑥5subscript˙𝑠𝑥4𝑠5˙𝑠subscript4𝑠𝑥subscript𝑠𝑥5𝑠𝑠subscript5𝑠𝑥\displaystyle 10\ddot{s}_{x}\overset{\scriptscriptstyle(3)}{s}+10\ddot{s}% \overset{\scriptscriptstyle(3)}{s}_{x}+5\dot{s}_{x}\overset{\scriptscriptstyle% (4)}{s}+5\dot{s}\overset{\scriptscriptstyle(4)}{s}_{x}+s_{x}\overset{% \scriptscriptstyle(5)}{s}+s\overset{\scriptscriptstyle(5)}{s}_{x}.10 over¨ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG + 10 over¨ start_ARG italic_s end_ARG start_OVERACCENT ( 3 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + 5 over˙ start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG + 5 over˙ start_ARG italic_s end_ARG start_OVERACCENT ( 4 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT + italic_s start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT start_OVERACCENT ( 5 ) end_OVERACCENT start_ARG italic_s end_ARG + italic_s start_OVERACCENT ( 5 ) end_OVERACCENT start_ARG italic_s end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT .

A.6 Generalized equinoctial orbital elements auxiliary functions

Algorithms 1 and 2 are basic conversion functions needed to work with the generalized equinoctial orbital elements. The analytical jacobians of these conversions are given explicitly in Baù et al. [2021].

Algorithm 1 𝝌=[νp1p2q1q2]=RV2GEQOEfun(𝒓ECI,𝒗ECI,μ,J2,R)\>\bm{\chi}=\left[\nu\>p_{1}\>p_{2}\>q_{1}\>q_{2}\>\mathcal{L}\right]^{% \intercal}=\text{RV2GEQOE}_{fun}(\bm{r}\rfloor_{ECI},\bm{v}\rfloor_{ECI},\mu,J% _{2},R_{\oplus})bold_italic_χ = [ italic_ν italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT caligraphic_L ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT = RV2GEQOE start_POSTSUBSCRIPT italic_f italic_u italic_n end_POSTSUBSCRIPT ( bold_italic_r ⌋ start_POSTSUBSCRIPT italic_E italic_C italic_I end_POSTSUBSCRIPT , bold_italic_v ⌋ start_POSTSUBSCRIPT italic_E italic_C italic_I end_POSTSUBSCRIPT , italic_μ , italic_J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , italic_R start_POSTSUBSCRIPT ⊕ end_POSTSUBSCRIPT )
1:r=𝒓r=\lVert\bm{r}\lVertitalic_r = ∥ bold_italic_r ∥,   𝓋=𝒗\mathscr{v}=\lVert\bm{v}\lVertscript_v = ∥ bold_italic_v ∥
2:𝒉=𝒓×𝒗,h=𝒉\bm{h}=\bm{r}\times\bm{v},\>h=\lVert\bm{h}\lVertbold_italic_h = bold_italic_r × bold_italic_v , italic_h = ∥ bold_italic_h ∥, r˙=𝒓𝒗r˙𝑟𝒓𝒗𝑟\dot{r}=\frac{\bm{r}\cdot\bm{v}}{r}over˙ start_ARG italic_r end_ARG = divide start_ARG bold_italic_r ⋅ bold_italic_v end_ARG start_ARG italic_r end_ARG
3:z^=𝒓(3)/r^𝑧𝒓3𝑟\hat{z}=\bm{r}(3)/rover^ start_ARG italic_z end_ARG = bold_italic_r ( 3 ) / italic_r
4:A=μJ2R22𝐴𝜇subscriptJ2superscriptsubscript𝑅direct-sum22A=\frac{\mu\text{J}_{2}R_{\oplus}^{2}}{2}italic_A = divide start_ARG italic_μ J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_R start_POSTSUBSCRIPT ⊕ end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 end_ARG, 𝒰=Ar3(13z^2)𝒰𝐴superscript𝑟313superscript^𝑧2\mathscr{U}=-\frac{A}{r^{3}}(1-3\hat{z}^{2})script_U = - divide start_ARG italic_A end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG ( 1 - 3 over^ start_ARG italic_z end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ), 𝒰eff=h22r2+𝒰subscript𝒰effsuperscript22superscript𝑟2𝒰\mathscr{U}_{\text{eff}}=\frac{h^{2}}{2r^{2}}+\mathscr{U}script_U start_POSTSUBSCRIPT eff end_POSTSUBSCRIPT = divide start_ARG italic_h start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG + script_U
5:𝒆r=𝒓/rsubscript𝒆𝑟𝒓𝑟\bm{e}_{r}=\bm{r}/rbold_italic_e start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT = bold_italic_r / italic_r, 𝒆h=𝒉/hsubscript𝒆𝒉\bm{e}_{h}=\bm{h}/hbold_italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT = bold_italic_h / italic_h, 𝒆f=𝒆h×𝒆rsubscript𝒆𝑓subscript𝒆subscript𝒆𝑟\bm{e}_{f}=\bm{e}_{h}\times\bm{e}_{r}bold_italic_e start_POSTSUBSCRIPT italic_f end_POSTSUBSCRIPT = bold_italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT × bold_italic_e start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT
6:𝒆x=[1,0,0]subscript𝒆𝑥superscript100\bm{e}_{x}=\left[1,0,0\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT = [ 1 , 0 , 0 ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT, 𝒆y=[0,1,0]subscript𝒆𝑦superscript010\bm{e}_{y}=\left[0,1,0\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_y end_POSTSUBSCRIPT = [ 0 , 1 , 0 ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT, 𝒆z=[0,0,1]subscript𝒆𝑧superscript001\bm{e}_{z}=\left[0,0,1\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT = [ 0 , 0 , 1 ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT
7:Total energy: ε=εK+𝒰=𝓋22μr+𝒰𝜀subscript𝜀𝐾𝒰superscript𝓋22𝜇𝑟𝒰\varepsilon=\varepsilon_{K}+\mathscr{U}=\frac{\mathscr{v}^{2}}{2}-\frac{\mu}{r% }+\mathscr{U}italic_ε = italic_ε start_POSTSUBSCRIPT italic_K end_POSTSUBSCRIPT + script_U = divide start_ARG script_v start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 end_ARG - divide start_ARG italic_μ end_ARG start_ARG italic_r end_ARG + script_U
8:Generalized mean motion: ν=1μ(2ε)3/2𝜈1𝜇superscript2𝜀32\nu=\frac{1}{\mu}\left(-2\varepsilon\right)^{3/2}italic_ν = divide start_ARG 1 end_ARG start_ARG italic_μ end_ARG ( - 2 italic_ε ) start_POSTSUPERSCRIPT 3 / 2 end_POSTSUPERSCRIPT
9:q1=ehe˙x1+ehe˙zsubscript𝑞1subscript𝑒subscript˙𝑒𝑥1subscript𝑒subscript˙𝑒𝑧q_{1}=\frac{e_{h}\dot{e}_{x}}{1+e_{h}\dot{e}_{z}}italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT = divide start_ARG italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT over˙ start_ARG italic_e end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG 1 + italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT over˙ start_ARG italic_e end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT end_ARG, q2=ehe˙x1+ehe˙zsubscript𝑞2subscript𝑒subscript˙𝑒𝑥1subscript𝑒subscript˙𝑒𝑧q_{2}=\frac{-e_{h}\dot{e}_{x}}{1+e_{h}\dot{e}_{z}}italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT = divide start_ARG - italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT over˙ start_ARG italic_e end_ARG start_POSTSUBSCRIPT italic_x end_POSTSUBSCRIPT end_ARG start_ARG 1 + italic_e start_POSTSUBSCRIPT italic_h end_POSTSUBSCRIPT over˙ start_ARG italic_e end_ARG start_POSTSUBSCRIPT italic_z end_POSTSUBSCRIPT end_ARG
10:𝒆X=11+q12+q22[1q12+q22,2q1q2,2q1]subscript𝒆𝑋11superscriptsubscript𝑞12superscriptsubscript𝑞22superscript1superscriptsubscript𝑞12superscriptsubscript𝑞222subscript𝑞1subscript𝑞22subscript𝑞1\bm{e}_{X}=\frac{1}{1+q_{1}^{2}+q_{2}^{2}}\left[1-q_{1}^{2}+q_{2}^{2},2q_{1}q_% {2},-2q_{1}\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG [ 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , - 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT
11:𝒆Y=11+q12+q22[2q1q2,1+q12q22,2q2]subscript𝒆𝑌11superscriptsubscript𝑞12superscriptsubscript𝑞22superscript2subscript𝑞1subscript𝑞21superscriptsubscript𝑞12superscriptsubscript𝑞222subscript𝑞2\bm{e}_{Y}=\frac{1}{1+q_{1}^{2}+q_{2}^{2}}\left[2q_{1}q_{2},1+q_{1}^{2}-q_{2}^% {2},2q_{2}\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG [ 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , 2 italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT
12:Generalized angular momentum: c=2r2𝒰eff𝑐2superscript𝑟2subscript𝒰effc=\sqrt{2r^{2}\mathscr{U}_{\text{eff}}}italic_c = square-root start_ARG 2 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT script_U start_POSTSUBSCRIPT eff end_POSTSUBSCRIPT end_ARG
13:Generalized velocity vector: υ=r˙er+cref𝜐˙𝑟subscript𝑒𝑟𝑐𝑟subscript𝑒𝑓\bm{\upsilon}=\dot{r}\bm{e}_{r}+\frac{c}{r}\bm{e}_{f}bold_italic_υ = over˙ start_ARG italic_r end_ARG bold_italic_e start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT + divide start_ARG italic_c end_ARG start_ARG italic_r end_ARG bold_italic_e start_POSTSUBSCRIPT italic_f end_POSTSUBSCRIPT
14:Generalized eccentricity vector: g=1μυ(r×υ)er𝑔1𝜇𝜐𝑟𝜐subscript𝑒𝑟\bm{g}=\frac{1}{\mu}\bm{\upsilon}\left(\bm{r}\times\bm{\upsilon}\right)-\bm{e}% _{r}bold_italic_g = divide start_ARG 1 end_ARG start_ARG italic_μ end_ARG bold_italic_υ ( bold_italic_r × bold_italic_υ ) - bold_italic_e start_POSTSUBSCRIPT italic_r end_POSTSUBSCRIPT
15:p1=𝒈𝒆Ysubscript𝑝1𝒈subscript𝒆𝑌p_{1}=\bm{g}\cdot\bm{e}_{Y}italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT = bold_italic_g ⋅ bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT, p2=𝒈𝒆Xsubscript𝑝2𝒈subscript𝒆𝑋p_{2}=\bm{g}\cdot\bm{e}_{X}italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT = bold_italic_g ⋅ bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT
16:X=𝒓𝒆X𝑋𝒓subscript𝒆𝑋X=\bm{r}\cdot\bm{e}_{X}italic_X = bold_italic_r ⋅ bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT, Y=𝒓𝒆Y𝑌𝒓subscript𝒆𝑌Y=\bm{r}\cdot\bm{e}_{Y}italic_Y = bold_italic_r ⋅ bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT
17:β=1p12p22𝛽1𝑝superscript12superscriptsubscript𝑝22\beta=\sqrt{1-p1^{2}-p_{2}^{2}}italic_β = square-root start_ARG 1 - italic_p 1 start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG, α=11+β𝛼11𝛽\alpha=\frac{1}{1+\beta}italic_α = divide start_ARG 1 end_ARG start_ARG 1 + italic_β end_ARG
18:Generalized semi-major axis: a=μ2ε=(μν2)1/3𝑎𝜇2𝜀superscript𝜇superscript𝜈213a=-\frac{\mu}{2\varepsilon}=\left(\frac{\mu}{\nu^{2}}\right)^{1/3}italic_a = - divide start_ARG italic_μ end_ARG start_ARG 2 italic_ε end_ARG = ( divide start_ARG italic_μ end_ARG start_ARG italic_ν start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT
19:cos𝒦=p2+1aβ[(1αp22)Xαp1p2Y]𝒦subscript𝑝21𝑎𝛽delimited-[]1𝛼superscriptsubscript𝑝22𝑋𝛼subscript𝑝1subscript𝑝2𝑌\cos{\mathcal{K}}=p_{2}+\frac{1}{a\beta}\left[\left(1-\alpha p_{2}^{2}\right)X% -\alpha p_{1}p_{2}Y\right]roman_cos caligraphic_K = italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT + divide start_ARG 1 end_ARG start_ARG italic_a italic_β end_ARG [ ( 1 - italic_α italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) italic_X - italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_Y ]
20:sin𝒦=p1+1aβ[(1αp12)Yαp1p2X]𝒦subscript𝑝11𝑎𝛽delimited-[]1𝛼superscriptsubscript𝑝12𝑌𝛼subscript𝑝1subscript𝑝2𝑋\sin{\mathcal{K}}=p_{1}+\frac{1}{a\beta}\left[\left(1-\alpha p_{1}^{2}\right)Y% -\alpha p_{1}p_{2}X\right]roman_sin caligraphic_K = italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT + divide start_ARG 1 end_ARG start_ARG italic_a italic_β end_ARG [ ( 1 - italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) italic_Y - italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_X ]
21:=atan2(sin𝒦,cos𝒦)+1aβ(Xp1Yp2)atan2𝒦𝒦1𝑎𝛽𝑋subscript𝑝1𝑌subscript𝑝2\mathcal{L}=\text{atan2}(\sin{\mathcal{K}},\cos{\mathcal{K}})+\frac{1}{a\beta}% \left(Xp_{1}-Yp_{2}\right)caligraphic_L = atan2 ( roman_sin caligraphic_K , roman_cos caligraphic_K ) + divide start_ARG 1 end_ARG start_ARG italic_a italic_β end_ARG ( italic_X italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT - italic_Y italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT )
Algorithm 2 𝑿ECI=[𝒓,𝒗]=GEQOE2RVfun(ν,p1,p2,q1,q2,,μ,J2,R)\>\bm{X}\rfloor_{ECI}=\left[\bm{r}^{\intercal},\bm{v}^{\intercal}\right]^{% \intercal}=\text{GEQOE2RV}_{fun}(\nu,p_{1},p_{2},q_{1},q_{2},\mathcal{L},\mu,% \text{J}_{2},R_{\oplus})bold_italic_X ⌋ start_POSTSUBSCRIPT italic_E italic_C italic_I end_POSTSUBSCRIPT = [ bold_italic_r start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT , bold_italic_v start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT = GEQOE2RV start_POSTSUBSCRIPT italic_f italic_u italic_n end_POSTSUBSCRIPT ( italic_ν , italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT , italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , caligraphic_L , italic_μ , J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , italic_R start_POSTSUBSCRIPT ⊕ end_POSTSUBSCRIPT )
1:Numerically solve Kepler's equation: 𝒦=𝒦+p1cos𝒦p2sin𝒦𝒦𝒦subscript𝑝1𝒦subscript𝑝2𝒦\mathcal{K}\leftarrow\mathcal{L}=\mathcal{K}+p_{1}\cos{\mathcal{K}}-p_{2}\sin{% \mathcal{K}}caligraphic_K ← caligraphic_L = caligraphic_K + italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_cos caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin caligraphic_K
2:𝒆X=11+q12+q22[1q12+q22,2q1q2,2q1]subscript𝒆𝑋11superscriptsubscript𝑞12superscriptsubscript𝑞22superscript1superscriptsubscript𝑞12superscriptsubscript𝑞222subscript𝑞1subscript𝑞22subscript𝑞1\bm{e}_{X}=\frac{1}{1+q_{1}^{2}+q_{2}^{2}}\left[1-q_{1}^{2}+q_{2}^{2},2q_{1}q_% {2},-2q_{1}\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG [ 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , - 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT
3:𝒆Y=11+q12+q22[2q1q2,1+q12q22,2q2]subscript𝒆𝑌11superscriptsubscript𝑞12superscriptsubscript𝑞22superscript2subscript𝑞1subscript𝑞21superscriptsubscript𝑞12superscriptsubscript𝑞222subscript𝑞2\bm{e}_{Y}=\frac{1}{1+q_{1}^{2}+q_{2}^{2}}\left[2q_{1}q_{2},1+q_{1}^{2}-q_{2}^% {2},2q_{2}\right]^{\intercal}bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT = divide start_ARG 1 end_ARG start_ARG 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT + italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG [ 2 italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT , 1 + italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT , 2 italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ] start_POSTSUPERSCRIPT ⊺ end_POSTSUPERSCRIPT
4:β=1p12p22𝛽1𝑝superscript12superscriptsubscript𝑝22\beta=\sqrt{1-p1^{2}-p_{2}^{2}}italic_β = square-root start_ARG 1 - italic_p 1 start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG, α=11+β𝛼11𝛽\alpha=\frac{1}{1+\beta}italic_α = divide start_ARG 1 end_ARG start_ARG 1 + italic_β end_ARG
5:a=(μν2)1/3𝑎superscript𝜇superscript𝜈213a=\left(\frac{\mu}{\nu^{2}}\right)^{1/3}italic_a = ( divide start_ARG italic_μ end_ARG start_ARG italic_ν start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT
6:X=a[αp1p2sin𝒦+(1αp12)cos𝒦p2]𝑋𝑎delimited-[]𝛼subscript𝑝1subscript𝑝2𝒦1𝛼superscriptsubscript𝑝12𝒦subscript𝑝2X=a\left[\alpha p_{1}p_{2}\sin{\mathcal{K}}+(1-\alpha p_{1}^{2})\cos{\mathcal{% K}}-p_{2}\right]italic_X = italic_a [ italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin caligraphic_K + ( 1 - italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) roman_cos caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT ]
7:Y=a[αp1p2cos𝒦+(1αp22)sin𝒦p1]𝑌𝑎delimited-[]𝛼subscript𝑝1subscript𝑝2𝒦1𝛼superscriptsubscript𝑝22𝒦subscript𝑝1Y=a\left[\alpha p_{1}p_{2}\cos{\mathcal{K}}+(1-\alpha p_{2}^{2})\sin{\mathcal{% K}}-p_{1}\right]italic_Y = italic_a [ italic_α italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_cos caligraphic_K + ( 1 - italic_α italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT ) roman_sin caligraphic_K - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT ]
8:𝒓=X𝒆X+Y𝒆Y𝒓𝑋subscript𝒆𝑋𝑌subscript𝒆𝑌\bm{r}=X\bm{e}_{X}+Y\bm{e}_{Y}bold_italic_r = italic_X bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT + italic_Y bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT
9:r=a(1p1sin𝒦p2cos𝒦)𝑟𝑎1subscript𝑝1𝒦subscript𝑝2𝒦r=a\left(1-p_{1}\sin{\mathcal{K}}-p_{2}\cos{\mathcal{K}}\right)italic_r = italic_a ( 1 - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_sin caligraphic_K - italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_cos caligraphic_K )
10:z^=𝒓(3)/r^𝑧𝒓3𝑟\hat{z}=\bm{r}(3)/rover^ start_ARG italic_z end_ARG = bold_italic_r ( 3 ) / italic_r
11:A=μJ2R22𝐴𝜇subscriptJ2superscriptsubscript𝑅direct-sum22A=\frac{\mu\text{J}_{2}R_{\oplus}^{2}}{2}italic_A = divide start_ARG italic_μ J start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT italic_R start_POSTSUBSCRIPT ⊕ end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG 2 end_ARG, 𝒰=Ar3(13z^2)𝒰𝐴superscript𝑟313superscript^𝑧2\mathscr{U}=-\frac{A}{r^{3}}(1-3\hat{z}^{2})script_U = - divide start_ARG italic_A end_ARG start_ARG italic_r start_POSTSUPERSCRIPT 3 end_POSTSUPERSCRIPT end_ARG ( 1 - 3 over^ start_ARG italic_z end_ARG start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT )
12:r˙=μar(p2sin𝒦p1cos𝒦)˙𝑟𝜇𝑎𝑟subscript𝑝2𝒦subscript𝑝1𝒦\dot{r}=\frac{\sqrt{\mu a}}{r}\left(p_{2}\sin{\mathcal{K}}-p_{1}\cos{\mathcal{% K}}\right)over˙ start_ARG italic_r end_ARG = divide start_ARG square-root start_ARG italic_μ italic_a end_ARG end_ARG start_ARG italic_r end_ARG ( italic_p start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT roman_sin caligraphic_K - italic_p start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT roman_cos caligraphic_K )
13:cosL=Xr𝐿𝑋𝑟\cos{L}=\frac{X}{r}roman_cos italic_L = divide start_ARG italic_X end_ARG start_ARG italic_r end_ARG, sinL=Yr𝐿𝑌𝑟\sin{L}=\frac{Y}{r}roman_sin italic_L = divide start_ARG italic_Y end_ARG start_ARG italic_r end_ARG
14:c=(μ2ν)1/31q12q22𝑐superscriptsuperscript𝜇2𝜈131superscriptsubscript𝑞12superscriptsubscript𝑞22c=\left(\frac{\mu^{2}}{\nu}\right)^{1/3}\sqrt{1-q_{1}^{2}-q_{2}^{2}}italic_c = ( divide start_ARG italic_μ start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG start_ARG italic_ν end_ARG ) start_POSTSUPERSCRIPT 1 / 3 end_POSTSUPERSCRIPT square-root start_ARG 1 - italic_q start_POSTSUBSCRIPT 1 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - italic_q start_POSTSUBSCRIPT 2 end_POSTSUBSCRIPT start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT end_ARG, h=c22r2𝒰superscript𝑐22superscript𝑟2𝒰h=\sqrt{c^{2}-2r^{2}\mathscr{U}}italic_h = square-root start_ARG italic_c start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT - 2 italic_r start_POSTSUPERSCRIPT 2 end_POSTSUPERSCRIPT script_U end_ARG
15:X˙=r˙cosLhrsinL˙𝑋˙𝑟𝐿𝑟𝐿\dot{X}=\dot{r}\cos{L}-\frac{h}{r}\sin{L}over˙ start_ARG italic_X end_ARG = over˙ start_ARG italic_r end_ARG roman_cos italic_L - divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_sin italic_L
16:Y˙=r˙sinL+hrcosL˙𝑌˙𝑟𝐿𝑟𝐿\dot{Y}=\dot{r}\sin{L}+\frac{h}{r}\cos{L}over˙ start_ARG italic_Y end_ARG = over˙ start_ARG italic_r end_ARG roman_sin italic_L + divide start_ARG italic_h end_ARG start_ARG italic_r end_ARG roman_cos italic_L
17:𝒗=X˙𝒆X+Y˙𝒆Y𝒗˙𝑋subscript𝒆𝑋˙𝑌subscript𝒆𝑌\bm{v}=\dot{X}\bm{e}_{X}+\dot{Y}\bm{e}_{Y}bold_italic_v = over˙ start_ARG italic_X end_ARG bold_italic_e start_POSTSUBSCRIPT italic_X end_POSTSUBSCRIPT + over˙ start_ARG italic_Y end_ARG bold_italic_e start_POSTSUBSCRIPT italic_Y end_POSTSUBSCRIPT