1. INTRODUCTION
Space agencies in the world have focused on Solar System exploration. China intends to launch a Mars probe in the near future, which will lead China one step further in interplanetary exploration (Fang and Ning, Reference Fang and Ning2010; Wu et al., Reference Wu, Wang and Ning2011; Ma et al., Reference Ma, Fang and Ning2013). Launch, Cruise, Approach and Orbit Insertion, and Entry Descent and Landing (EDL) are four major phases in exploring a target; the Approach and Orbit Insertion phase is vital for interplanetary missions because its accuracy deeply affects the following EDL phase (Wang et al., Reference Wang, Huang and Guan2008) and avoiding a fault in navigation is essential to ensure mission success.
Radio navigation and autonomous navigation are used in interplanetary navigation. Radio navigation measures the signal delay time and the frequency shift to obtain the range and range rate from a probe to a Deep Space Network station (Thornton and Border, Reference Thornton and Border2003). Its accuracy with respect to Earth is excellent, and is dominant for interplanetary missions. However, this is restricted to the visible arcs of the station and Sun conjunction, and its performance with respect to the target mainly suffers from target ephemeris uncertainty (Jordan et al., Reference Jordan, Madrid and Pease1972).
Autonomous navigation can obtain the probe position and velocity without Earth tracking, which is currently only a complementary navigation method despite progress. Three autonomous navigation methods have been proposed. Optical navigation (OpNav) finds the centroids from the optical image of the target and its background stars, and calculates the probe position with respect to the target, which has been used in Mars Reconnaissance Orbiter (MRO), Deep Space 1, and Deep Impact, etc (Martin-Mur et al., Reference Martin-Mur, Bhaskaran, Cesarone and McElrath2008). Optical Doppler navigation measures the Doppler-shift spectrum of the Sun or stars to determine the probe velocity (Yim et al., Reference Yim, Crassidis and Junkins2000; Guo, Reference Guo1999). X-ray Pulsar navigation compares the measured arrival time of the pulsar signal with predictions to locate the probe, which has been validated in an on-orbit experiment (Graven et al., Reference Graven, Collions, Sheikh, Hanson, Ray and Wood2008; Wood et al., Reference Wood, Mowalski, Lovellette, Ray, Wolff, Yentis, Bandyopadhyay, Fewtrell, Fritz, Wood and Hertz2001). Among these methods, OpNav is the only method which has been successfully utilised in interplanetary missions.
In previous missions, the navigation results have been provided by direct combination without information fusion, using OpNav results for those with respect to the target and radio navigation ones for those with respect to Earth. This is because OpNav is superior in its accuracy with respect to the target and radio navigation can achieve better accuracy with respect to the Earth (Klumpp et al., Reference Klumpp, Bon, D'Amario, Downing, Frauenholz and McReynolds1980). However, this method combines information with lower efficiency (Antreasian et al., Reference Antreasian, Ardalan, Beswick, Criddle, Ionasescu, Jacobson, Jones, MacKenzie, Parcher, Pelletier, Roth, Thompson and Vaughan2008). To enhance the performance of the Integrated Navigation System (INS) and obtain more accurate results with respect to both Earth and the target, a key technology is information fusion.
However, if data is to be efficiently integrated, coordinate transformations are required to integrate the two navigation results in the same coordinate system, which introduces target ephemeris uncertainty and directly affects the INS accuracy. Therefore, the planetary ephemeris uncertainty is the main reason for the inaccurate fusion results.
A global fit on the ground can give accurate ephemeris results, which has been utilised for ephemeris correction in several interplanetary missions (Rourke et al., Reference Rourke, Acton, Breckenridge, Campbell, Christensen, Donegan, Jerath, Mottinger, Rinker and Winn1977; Riedel et al., Reference Riedel, Owen, Stuve, Synnott and Vaughan1990; Murrow and Jacobson, Reference Murrow and Jacobson1988). However it requires intensive computational time and large memory to store a complicated model, and is usually used in post-flight analysis to improve the ephemeris. An analytical method based on the geometry of the Earth, the probe, and the target is useful for calculating the ephemeris (Rosenblatta et al., Reference Rosenblatta, Laineyb, Le Maistrea, Martyc, Dehanta, Pätzold, Van Hoolst and Häusler2008), which requires less memory and computation time. However, the calculated ephemeris is not accurate enough and errors still exist in the force model (Ma et al., Reference Ma, Ning and Fang2012). Hence an estimation method based on the analytical solution and a simple model of the ephemeris uncertainty could be an attractive method to balance the accuracy and real-time performance.
Since the ephemeris error belongs to system error, the corresponding estimation methods mainly include Least Squares (LS), Kalman Filter (KF) and Neural Networks (NN). LS has the lowest computation cost and needs a large memory to store a batch of measurements and its accuracy depends on the number of measurements (Zhou et al., Reference Zhou, Leung and Blanchette1999). KF is an algorithm that recursively estimates the states by the state and measurement models and their noise statistic characteristics (Ning et al., Reference Ning, Ma, Zhang and Wu2012a). NN is an intelligent method using a set of neurons to estimate or approximate the functions or the model, which is especially useful for systems with unknown model and requires larger memory and higher computation capability (Karniely and Siegelmann, Reference Karniely and Siegelmann2000). Thus, with regards to the known model of the ephemeris error and the real time requirement, KF is the most suitable method for estimating ephemeris uncertainty.
Ning and Fang (Reference Ning and Fang2008) provide an information fusion method for Earth satellites to effectively combine the Doppler and celestial measurements. However, the study ignores the influence of the ephemeris uncertainty. Motivated by Ning and Fang (Reference Ning and Fang2008), this paper proposes a Radio/Optical information fusion method based on estimation and correction of the target ephemeris error. The main contribution of this paper is:
(1) The ephemeris error model is established and by taking the analytical ephemeris uncertainty as measurement the target ephemeris error and its covariance are estimated and fed back to modify the force models.
(2) Based on the accurate target ephemeris and information fusion, the INS provides precise information with respect to both Earth and the target.
This paper is organised as follows: Section 2 describes a concept of interplanetary navigation and ephemeris correction. Section 3 and Section 4 present the models of the ONS and the RNS. Section 5 presents the analysis of the uncertainties in the force model. Section 6 gives the filter methods, target ephemeris correction, the information fusion algorithms and coordinate transformations. In Section 7, taking Mars as a target, simulations are provided. Finally, Section 8 concludes.
2. A CONCEPT OF INTERPLANETARY NAVIGATION AND ANALYTICAL METHOD FOR EPHEMERIS CORRECTION
Figure 1 shows a concept of interplanetary navigation. As shown in Figure 1, radio navigation accuracy with respect to Earth decreases as the distance between the probe and Earth increases. Unlike radio navigation, the closer the probe approaches the target, the more precise navigation performance OpNav can provide (Klumpp et al., Reference Klumpp, Bon, D'Amario, Downing, Frauenholz and McReynolds1980).
As discussed, the planetary ephemeris is the main reason for the inaccuracy of the INS. Table 1 shows the accuracy of the DE421 ephemeris in 2008 (Folkner et al., Reference Folkner, Williams and Boggs2008). The ephemeris of Venus, Earth, Mars, Jupiter and Saturn is accurate (200 m ~ tens of kilometres), whereas the other planets' ephemeris uncertainties are of the order of thousands of kilometres. Without new observations, DE421 accuracy rapidly decreases. According to Folkner (Reference Folkner2010), Mars ephemeris uncertainty declines to about 10 km by the end of 2015, and ephemeris uncertainties of other planets (except the Earth) are even larger by then.
According to the geometry of the probe, target and Earth, the target ephemeris ${\bi X}_{{\rm target}}^{{\rm helio}} $ with respect to the Sun can be determined by optical measurement ${\bi X}_{{\rm optical}}^{{\rm target}} $ and radio measurement ${\bi X}_{{\rm radio}}^{{\rm earth}} $ (Figure 1)
where, ${\bi X}_{{\rm earth}}^{{\rm helio}} $ is the Earth vector with respect to the Sun.
By calculating and correcting the ephemeris ${\bi X}_{{\rm target}}^{{\rm helio}} $ using the analytical method, the navigation errors caused by the ephemeris uncertainty can be reduced in the INS.
3. OPTICAL NAVIGATION SUBSYSTEM (ONS)
3.1. The force model in the ONS
The ONS force model is established in the Target-Centred Inertial (TCI) coordinate system, taking Mars as a target:
where in the TCI system r = [x, y, z]T is the probe position vector, v = [v x, v y, v z]T is the probe velocity vector, μ m, μ s, μ i are the gravitational parameters of Mars, Sun, and the ith planet respectively, r ps, r pm, r pi are the distances between the probe and Sun, Mars, and the ith planet respectively, rs = [x s, y s, z s]T are the coordinates of Sun, ri = [x i, y i, z i]T are the position vector of the ith planet, which can be obtained from the ephemeris, and w = [w x, w y, w z]T are the process noises in the three-axis velocity.
The force model can be written in the general form:
where X1 = [x, y, z, v x, v y, v z]T is the ONS state vector, f 1 (·) is the ONS dynamic model function , and w1 = [w1, w2, w3, w 4, w 5, w 6]T is the ONS process noise vector.
3.2. Measurement processing in the ONS
Although different types of measurements can be used in autonomous navigation (Paluszek et al., Reference Paluszek, Mueller and Littman2010), the angles between a target (Mars, Phobos, or Deimos) and its background stars from images captured by navigation sensor is used as measurement (Figure 2), because this kind of measurement can avoid the attitude determination errors.
The image of the target and background stars is the original data from the navigation sensor (Camera). Several steps are required to obtain the angle between the target and the known stars:
Step 1: Centroid identification. The pixel and line of the target (p, l) and those of the optical axis (p 0, l 0) can be calculated from the image by centroid-identification image processing technology.
Step 2: Coordinate Transformations
(1) Coordinates transformation from the pixel coordinate frame to the 2-Dimension (2D) image coordinate frame.
The pixel and line coordinates (p, l) (Figure 3) can be described in the 2D image frame as (x 2d, y 2d):
where K is the transformation matrix.
(2) Coordinates transformation from the 2D image coordinate frame to the 3-Dimension (3D) sensor coordinate frame.
A unit vector (x c, y c, z c) in the 3D sensor coordinate frame can be given as follows:
where, f is the focal length, and ${\bi l}_{{\rm pc}}^{\rm c} $ is the unit vector from the celestial body (c) to the probe (p) with respect to the origin in the sensor coordinate frame.
Step 3: Angle calculation. The angle θ between the target vector and its background star vector can be calculated by
where ${\bi l}_{{\rm pc}}^{\rm c}, {\bi l}_{\rm s}^{\rm c} $ are the vectors from the target and the background star to the probe in the sensor coordinate frame derived from Step 2.
3.3. The measurement model in the ONS
The angles between Mars, Phobos and Deimos and their jth background star θ mj, θ pj, θ dj can be expressed as
where in the sensor coordinate system, ${\bi l}_{{\rm pm}}^{\rm c} $ is the unit vector from Mars to the probe, ${\bi l}_{1{\rm s}j}^{\rm c} $ is the unit vector of the j th known star from the Mars image. In the TCI system, ${\bi l}_{{\rm pm}}^{\rm i}, {\bi l}_{{\rm pp}}^{\rm i}, {\bi l}_{{\rm pd}}^{\rm i} $ are the unit vectors to the probe from Mars, Phobos, and Deimos respectively, ${\bi l}_{1{\rm s}j}^{\rm i}, {\bi l}_{{\rm 2s}j}^{\rm i}, {\bi l}_{{\rm 3s}j}^{\rm i} $ are the unit vectors of the jth known star from the Mars image, Phobos image, and Deimos image, respectively.
Thus, the measurement model can be written in the general form:
where Z1 = [θ m1, θ m2, θ m3, θ p1, θ p2, θ p3, θ d1, θ d2, θ d3]T is the measurement vector, and ${\bi v}_{\rm 1} = [v_{\theta _{{\rm m1}}}, v_{\theta _{{\rm m2}}}, v_{\theta _{{\rm m3}}}, v_{\theta _{{\rm p1}}}, v_{\theta _{{\rm p2}}}, v_{\theta _{{\rm p3}}}, v_{\theta _{{\rm d1}}}, v_{\theta _{{\rm d2}}}, v_{\theta _{{\rm d3}}} ]^{\rm T} $ is the measurement noise vector, and $v_{\theta _{{\rm m1}}}, v_{\theta _{{\rm m2}}}, v_{\theta _{{\rm m3}}}, v_{\theta _{{\rm p1}}}, v_{\theta _{{\rm p2}}}, v_{\theta _{{\rm p3}}}, v_{\theta _{{\rm d1}}}, v_{\theta _{{\rm d2}}}, v_{\theta _{{\rm d3}}} $ are the measurement noise.
3.4. The initial state error of the ONS
The initial state error of the ONS is the position and velocity error in the TCI system at the initial moment, which is delivered from the navigation results in the HCI system at the end of the cruise phase.
Consequently, the target ephemeris error could be reflected as a part of the initial navigation error in the approach phase. Therefore the initial navigation error dX1(0) can be divided into two parts as follows:
where dXhelio(0) is the initial navigation error with respect to the Sun, ${\rm d}{\bi X}_{{\rm target}}^{{\rm helio}} (0)$ is the prior knowledge of the target ephemeris error at the initial moment.
4. RADIO NAVIGATION SUBSYSTEM (RNS)
4.1. The force model in the RNS
The RNS force model is established in the Helio-Centric Inertial (HCI) coordinate system:
where in the HCI system, r′ = [x′, y′, z′]T is the probe position vector, v = [v′x, v′y, v′z]T is the probe velocity vector, r′i = [x i′, y i′, z i′]T is the position vector of the ith planet, and w′ = [w′x, w′y, w′z]T are the process noises in the three-axis velocity.
The force model can be written in the general form:
where X2 = [x′, y′, z′, v′x, v′y, v′z]T is the RNS state vector, f 2(·) is the RNS dynamic model function, and w2 = [w′1, w′2, w′3, w′4, w′5, w′6]T is the RNS process noise vector.
4.2. Measurements processing in the RNS
Range and range rate are two available measurements of the RNS. The range rate between a probe and a station $\dot R$ is measured by the signal frequency shift.
where c is the speed of light, f 0 is the frequency of the signal from the station, f′rec is the frequency of the signal received by the station, δf atm, δf 0 are the frequency errors caused by the atmospheric delay and the oscillator instability.
The range R between a probe and a station is measured by the signal delay time, and it can be expressed as
where τ is the signal transit time, δt R is the receiver clock difference with true time, δt T is the transmitter clock difference with true time, δρ atm, δρ ion are the atmospheric delay contribution and ionosphere contribution, δρ trop is the troposphere delay, and ε represents remaining errors, such as the instrument noise (Vallado, Reference Vallado2007; Bar-Shalom et al., Reference Bar-Shalom, Rong and Kirubarajan2001).
4.3. The measurement model in the RNS
Ground stations can determine the probe position and velocity by measuring the ranges and range rates. A primary station with several secondary stations can accomplish the observing mission. The expressions of the range and range rate are given in the vector form by
where ρ is the probe position vector with respect to the ground station, ${\dot{\bi \rho}} $ is the relative probe velocity with respect to the ground station, $\rho, \dot \rho $ is the magnitude of ${\bi \rho}, {\dot{\bi \rho}} $, (x f, y f, z f) are the coordinates of the ground station in the HCI system, and ux, uy, uz are position unit vector of the probe with respect to the ground station.
Therefore, the measurement model can be written in the general form
where ${\bi Z}_{\rm 2} = [\rho _1, \dot \rho _1, \rho _2, \dot \rho _2, \rho _3, \dot \rho _3 ]^{\rm T} $ is the measurement vector of the RNS, ${\bi v}_{\rm 2} = [v_{\rho _1}, v_{\dot \rho _1}, v_{\rho _2}, v_{\dot \rho _2}, v_{\rho _3}, v_{\dot \rho _3} ]^{\rm T} $ is the measurement noise vector of the RNS, $\rho _1, \dot \rho _1, \rho _2, \dot \rho _2, \rho _3, \dot \rho _3 $ are the range and the range rate between the probe and the 1st, 2nd, and 3rd ground stations, and $v_{\rho _1}, v_{\dot \rho _1}, v_{\rho _2}, v_{\dot \rho _2}, v_{\rho _3}, v_{\dot \rho _3} $ is the measurement noise.
4.4. The initial state error of the RNS
The navigation results at the end of the cruise phase and the initial state error are both in the HCI system. Therefore, the initial navigation error dX2(0) is equal to the navigation results at the end of the cruise phase
5. UNCERTAINTIES IN THE FORCE MODEL
To determine the main uncertainties in the force model and the process noise covariance, the uncertainties in the force model and their perturbation acceleration are analysed.
5.1. Uncertainties of the gravity force of central body
When the probe enters into the gravitational sphere of influence of the target, the target is the central body. The acceleration from the central body is
where μ t is the gravitational parameter of the target.
For a Mars probe in the approach phase (R m < r ≤ 600000 km, R m is the radius of the Mars), the acceleration from the central body is 1·1897 × 10−4 < a cb ≤ 3·4962 m/s2. Figure 4 gives the variation of the acceleration from the central body with the distance between the probe and Mars.
5.1.1. Uncertainty of the target ephemeris
The acceleration with respect to δ r, the changes in the target ephemeris, can be derived from the error propagation model of the target ephemeris (Ma et al., Reference Ma, Fang, Ning, Liu and Ge2015)
where $g({\bi r}) = - \mu _{\rm t} {{\bi r} / {r^3}} $, $\delta {\dot{\bi v}} = \delta {\ddot{\bi r}}$. It can be rewritten as follows:
where $\delta {\ddot{\bi r}}$ is the acceleration with respect to the target ephemeris uncertainty, δ r is the target position error.
For a Mars probe in the approach phase, the ephemeris uncertainty of the central body (Mars) is less than 10 km, and the acceleration error caused by the Mars ephemeris uncertainty is about O(10−4).
5.1.2. Uncertainty of the target gravitational constant
The derivative of acceleration with respect to δμ t, the change in the target gravitational parameter, can be derived from the error propagation model
For a Mars probe in the approach phase, the gravitational parameter uncertainty of Mars is ± 0·1 km3/s2, and the perturbation acceleration error caused by the Mars gravitational parameter uncertainty is about $O(10^{ - {\rm 5}} {\rm \sim}10^{ - {\rm 10}} {\rm )}$, which can be reasonably ignored due to the small magnitude.
5.2. Uncertainties of the perturbation of third body
Besides the gravities of the central body, other planets, and Sun, gravities from other celestial bodies, such as natural satellites and asteroids also act on the probe. The perturbation acceleration model is
where rpi is the position vector from the third body to the probe, and rti is the position vector from the third body to the target.
For a Mars probe in the approach phase, r ≪ (r ti, r pi) and $r_{{\rm p}i} ^3 \approx r_{{\rm t}i} ^3 $, then the perturbation acceleration model can be simplified as follows
Figure 5 gives the third body perturbation acceleration of all planets except Mars for a Mars probe in the approach phase, which indicates that the main third body perturbation acceleration is from the Sun, and the perturbation acceleration from the other bodies is less than 10−10 m/s2. The third body perturbation acceleration from Phobos and Deimos is $10^{ - 1} {\sim}10^{ - 5} {\rm \;m\!/\!s}^2 $ at a low altitude, which cannot be ignored.
5.3. Uncertainties of the gravity field of the target
As the target is not a perfectly spherical central body, the perturbing accelerations caused by a non-spherical central body will affect the force model accuracy. Taking Mars as an example, the aspherical-potential function U is modelled in spherical harmonics using the expression (Vallado, Reference Vallado2007; Lemonine et al., Reference Lemoine, Smith, Rowlands, Zuber, Neumann and Chinn2001)
where, r, θ, λ are the body fixed coordinates, φ is latitude, and λ is longitude, C nm and S nm are the normalised coefficients of the spherical harmonic expansion, and P nm are the normalised associated Legendre Functions.
Different Mars gravity field models are established by experimental data from interplanetary missions, such as GMM-2B, MGS75D, MGS95J, MRO110B, etc. The degree and order of the model determines the accuracy of the model. GMM-2B is an 80 × 80 spherical harmonics model calculated by Goddard Space Flight Center (GSFC), and MGS75D, MGS95J, MRO110B are 75 × 75, 95 × 95, 110 × 110 spherical harmonics models calculated by the Jet Propulsion Laboratory (JPL). Normalised gravitational coefficients of GMM-2B can be found in Lemonine (Reference Lemoine, Smith, Rowlands, Zuber, Neumann and Chinn2001).
Figure 6 gives the 4 × 4 nonsperical perturbation acceleration for a Mars probe in the approach phase. For a Mars probe in the approach phase, J 2 ≈ O(10−4), J 2,2 ≈ O(10−4), $J_{{\rm 3,m}} \approx O{\rm (}10^{ - 10} ) \sim O{\rm (}10^{ - 6} {\rm )}$ and $J_{{\rm 4,m}} \approx O{\rm (}10^{ - 18} )\sim O{\rm (}10^{ - 9} {\rm )}$.
5.4. Uncertainties of Solar radiation perturbation
When the probe is traveling in space, it is exposed to the Sun. Some incoming radiation from the Sun is absorbed, while some is reflected. The energy conversion leads to a force on the probe, which is the solar radiation pressure. Then the acceleration caused by solar radiation pressure can be modelled as
where c R is the reflectivity, its value depends on the composition and shape of the probe. If all the radiation is absorbed or reflected, then c R = 1 or c R = 2. If the object is translucent to incoming radiation, then c R = 0. A is the incident area exposed to the Sun. p SR is the force of solar pressure per unit area, and ${\bi r}_{{\rm sat} \odot} $ is the position vector from the probe to the Sun.
If the ratio of incident area to mass A/m = 0·02 m2/kg, and the average radiated power of solar radiation per unit area is 1·4 W/m2, then the solar radiation pressure is p SR = 4·65 × 10−6 N/m2. For a Mars probe in the approach phase, the solar radiation perturbation acceleration is less than 10−7 m/s2.
5.5. Uncertainties of atmosphere perturbation
Mars, Venus, Neptune and Titan are all surrounded by atmosphere. If the probe is operated at high speed in the atmosphere, the atmospheric drag will decrease the orbit altitude. The basic model is
where C D is the coefficient of drag, A D is the exposed cross-sectional area, ρ is the atmospheric density, and v is the velocity of the probe relative to the atmosphere.
For Mars exploration, the available Mars atmosphere models include Mars GRAM 2010, Mars GRAM 2005, Mars GRAM 2000, etc. The atmospheric density depends on the altitude of the orbit. The atmospheric density and its drag effects decrease as the altitude rises. The atmospheric densities at 100 km and 50 km above the Mars surface are 7·5 × 10−9 kg/m3 and 5·6 × 10−11 kg/m3, respectively.
If the altitude h = 150 km, the density is ρ = 5·6 × 10−11 kg/m3, the coefficient of drag C D is approximately 1, and the ratio of incident area to mass A D/m = 0·02 m2/kg, then for a Mars probe in the approach phase, aD < 1 × 10−5 m/s2.
5.6. Total uncertainties of the force model
According to the analysis above, for a Mars probe in the approach phase, the uncertainties in the force models can be determined. The two main kinds of perturbation acceleration come from the gravity field of the target and target ephemeris uncertainty, and it is about 10−4 m/s2. The other perturbation acceleration caused by solar radiation pressure, atmosphere drag and the target gravitational parameter can be reasonably ignored due to their small magnitude.
6. FILTER METHODS, EPHEMERIS CORRECTION AND INFORMATION FUSION
6.1. Filter methods for two navigation subsystems
Because of the nonlinear problem of the force models, a nonlinear filter should be used. Extended Kalman Filter (EKF) (Lee and Kyle, Reference Lee and Kyle2004), Unscented Kalman Filter (UKF) (Julier and Uhlmann, Reference Julier and Uhlmann1997; Julier et al., Reference Julier, Uhlmann and Durrant-Whyte2000), and Unscented Particle Filter (UPF) (van der Merwe et al., Reference van der Merwe, Doucet, de Freitas and Wan2000; Payne and Marrs, Reference Payne and Marrs2004) are three well-known nonlinear filters. EKF is based on the analytical Taylor series expansion of the nonlinear state and measurement models and the state approximations introduce large errors due to the neglected nonlinearities. UKF is a method capturing the mean and covariance of the state using the true nonlinear models and a set of sigma sample points with the unscented transformation. These two methods have the limitation that they do not apply to a general non-Gaussian distribution. The Particle Filter (PF) implements a recursive Bayesian filter by Monte Carlo simulations. The performance of the PF heavily depends on the choices of the importance sampling density and resampling scheme, and the number of samples decides the time consumed. However, due to the strict real time and accuracy requirement, the time consuming characteristics of PF and the inaccuracy of EKF, UKF is used in the INS (Ning et al., Reference Ning, Ma, Peng, Quan and Fang2012b).
6.2. Target ephemeris correction
6.2.1. The analytical method for target ephemeris correction
The target ephemeris uncertainty can be calculated from the geometry of the Sun, Earth, the actual target, the target in ephemeris and the probe (Figure 7).
From Figure 7, the target ephemeris uncertainty Zerr can be derived from
where, ${\bi X}_{{\rm target}}^{\rm p} $ and ${\bi X}_{{\rm target}}^{\rm a} $ are the predicted and actual target position vector in the HCI system, ${\bi X}_{{\rm target}}^{\rm p} $ can be obtained from target ephemeris database, and ${\bi X}_{{\rm target}}^{\rm a} $ can be calculated by
where ${\bi X}_{{\rm target}}^{{\rm helio}} $ can be measured from the results of the RNS and the ONS, as Equation (1) shows. Therefore, the target ephemeris uncertainty Zerr can be calculated as follows:
6.2.2. The estimation method for target ephemeris correction
The ephemeris uncertainty leads to a high uncertainty of the probe position. The exact orientation of orbit plane is more uncertain, whereas the period of the planet motion is relatively accurate. Thus the magnitude of the velocity typically has accurate prior knowledge. Based on those facts, the target ephemeris error is modelled as constant (Ma et al., Reference Ma, Fang, Ning, Liu and Ge2015; Wang et al, Reference Wang, Zheng, Sun and Li2013).
Figure 8 shows the flow chart of the target ephemeris correction, and the specific steps are given as follows:
(1) The state model of target ephemeris error. Since the variation of the target ephemeris error is slow in each filter period, the dynamics of the target ephemeris error can be modelled as:
where ${\dot{\bi X}}{\rm err =} \left[ {\matrix{ {\dot x_{{\rm err}}} & {\dot y_{{\rm err}}} & {\dot z_{{\rm err}}} \cr}} \right]^{\rm T} $, (x err, y err, z err) are the coordinates of the target ephemeris errors in the HCI system.
The discrete state model of the target ephemeris error can be given as
where the mapping F err (·) represents the process models and F err (Xerr(k), k) = Φerr,k+1,kXerr,k, Φerr,k+1,k is the state transition matrix at step k, Xerr(k) is the state vector at step k and werr (k) is the process noise vector.
(2) Measurement and its model. The measurement vector of the target ephemeris error Zerr can be obtained from the estimation of the ONS and the RNS, ${\bi X}_{{\rm optical}}^{{\rm target}} $ and ${\bi X}_{{\rm radio}}^{{\rm helio}} $
where ${\tilde{\bi X}}_{{\rm target}}^{\rm e} $ is the estimation of target ephemeris vector.
Accordingly, the discrete measurement model of the target ephemeris error can be expressed as follows:
where Zerr (k) is the measurement vector of ephemeris error at step k, the mapping h 3 (·) represents the measurement models function, and v3 (k) is the measurement noise vector of ephemeris errors at the step k.
(3) KF. According to the linear characteristics of the state model and measurement models of the ephemeris error, KF is utilised to estimate the target ephemeris error ${\hat{\bi X}}_{{\rm err,} k} $ and its covariance matrix Perr,k.
(4) Correction. ${\hat{\bi X}}_{{\rm err,} k} $ and Perr,k are provided for the force models of both RNS and ONS to correct the target ephemeris error. After the correction, the accuracy of the orbit dynamics is enhanced.
1) Correction on the force model of the ONS. In the ONS, the coordinates of all the celestial bodies are in the TCI system. Therefore, the target ephemeris error has no effect on the coordinates of the origin of the TCI system, and the coordinates of the actual target are [0, 0, 0]T. However, the coordinates of other planets contain the Mars ephemeris errors owing to the coordinates transformation.
The ith celestial body position coordinates in the TCI system ${\bi X}_i ^{{\rm target}} $ can be expressed as
where ${\bi X}_i ^{{\rm helio}} $ is the position coordinates of the ith celestial body in the HCI system, ${\bi X}_{{\rm target}}^{{\rm helio}} $ is the actual target ephemeris in the HCI system, Xerr is the target ephemeris error, and ${\tilde{\bi X}}_{{\rm target}}^{{\rm helio}} {\bi = X}_{{\rm target}}^{{\rm helio}} + {\bi X}_{{\rm err}} $. Therefore, the ephemerides of other planets (or the Sun) used in the force model are affected by the target ephemeris error Xerr, and the estimated target ephemeris error is used to correct the ephemerides of other planets in the state model
where, ${\hat{\bi X}}_{{\rm err}} $ is the estimated target ephemeris error.
2) Correction of the force model of the RNS. In the RNS, the coordinates of all the celestial bodies are in the HCI system. The target ephemeris error only affects the coordinates of the target, and the corrected target ephemeris is given by
where ${\hat{\bi X}}_{{\rm target}}^{{\rm helio}} $ is the corrected target ephemeris.
6.3. Information fusion algorithm
X1(k), P1(k) and X2(k), P2(k) are the estimated values and error covariance matrix of ONS and RNS respectively. However, X1(k), P1(k) are described in the TCI system, whereas X2(k), P2(k) are in the HCI system. To integrate the information in the same coordinate system, X2(k), P2(k) are transformed to X′2(k), P′2(k) in the TCI system (see 6.4. Coordinates Transformation). The global optimal estimation and its error covariance Xg and Pg in the TCI system in the master filter is obtained by the following equations (Ning and Fang, Reference Ning and Fang2008):
where β i is the fusion coefficient, which is inversely proportional to the trace of the error covariance.
The stability of UKF is not as good as EKF, so the feedback is only performed to state variables of the position and velocity. The information fusion algorithm directly provides the navigation results with respect to Mars. Those with respect to Earth can be derived by coordinate transformation using updated ephemeris.
6.4. Coordinates Transformations
6.4.1. Coordinates Transformation from the HCI to TCI system
To integrate the information in the same system, the navigation results of the RNS X2(k), P2(k) in the HCI system are transformed to X′2(k), P′2(k) in the TCI system. The translation between the two systems is
and
where $\delta {\bi X}_{{\rm target}}^{{\rm helio}} $ is the ephemeris error of ${\bi X}_{{\rm target}}^{{\rm helio}} $, ${\bi P}_{{\rm target}}^{{\rm helio}} $ is the target ephemeris covariance, ${\bi P}_{{\rm target}}^{{\rm helio}} = {\bi P}_{{\rm err}} $.
6.4.2. Coordinates Transformation from the TCI system to ECI
To simultaneously provide the position and velocity with respect to Earth and the target, the results of the INS in the TCI system need to transform these in the ECI system, which can be expressed as follows
and
where, X′g and P′g is the estimation and its covariance of the INS in the ECI system, $\delta {\bi X}_{{\rm earth}}^{{\rm helio}} $ is the ephemeris error of ${\bi X}_{{\rm earth}}^{{\rm helio}} $ which can be neglected owing to the long-term observation of the Sun from Earth.
6.5. Criterion of final navigation results
6.5.1. Final navigation results with respect to the target
Besides the INS, ONS alone can also provide the navigation result with respect to the target. The final navigation estimation ${\bf X}_g^{{\rm target}} $ and its covariance ${\bi P}_g^{{\rm target}} $ with respect to the target is chosen by their covariance as follows:
6.5.2. Final navigation results with respect to Earth
Similarly, RNS alone can also provide the navigation result with respect to Earth. The final navigation estimation ${\bf X}_{\rm g}^{{\rm earth}} $ and its covariance ${\bi P}_{\rm g}^{{\rm earth}} $ with respect to Earth is chosen by their covariance as follows:
7. SIMULATIONS
7.1. Simulation setup
The satellite Tool Kit Astrogator was used for creating the trajectory of the probe Earth-Mars transfers in 2013. The initial parameters were set as shown in Table 2.
In the reference orbit model, the perturbation force included third body gravity from the Sun and other planets, spherical harmonic gravity of central body and solar radiation force. The spherical harmonic gravity of Mars was modelled as GMM2B (4 × 4) (Lemoine et al., Reference Lemoine, Smith, Rowlands, Zuber, Neumann and Chinn2001). Besides the gravitational perturbation from celestial bodies, solar radiation pressure was also included with the spherical solar radiation pressure model (Vallado, Reference Vallado2007). The reference orbit was generated by RKF89 numerical integrator using the fixed step (1 s).
The ephemerides of planetary bodies, the natural satellite and the star used JPL DE421 (Folkner, Reference Folkner2010), SPICE ephemeris (Acton, Reference Acton1996), and Tycho-2 star catalogue, respectively (Høg et al., Reference Høg, Fabricius, Makarov, Urban, Corbin, Wycoff, Bastian, Schwekendiek and Wicenec2000). The optical characteristics of Mars, Phobos, and Deimos sensors are shown in Table 3. Three deep space stations were located in Kashi, Qingdao and Santiago. The available arcs are given in Figure 9.
7.2. Navigation results
Firstly, the results of the RNS and the ONS are given. Secondly, the impacts of the ephemeris uncertainty on information fusion are provided. Finally, the information fusion results using the analytical method and the estimation method for ephemeris correction are also given to show the importance of ephemeris correction and superior performance of the proposed method.
7.2.1. Navigation results of two navigation subsystems
Figure 10 and Table 4 give the navigation results (both with respect to Earth and Mars) of the RNS and ONS. As shown in Figure 10 and Table 4, the RNS can provide accurate navigation performance with respect to Earth, and the estimation accuracy of the position is 1·4993 m and that of the velocity is 7·9599 × 10−6 m/s, which is because RNS directly measures the observations with respect to Earth rather than Mars. However, for RNS alone, because of the inaccurate Mars ephemeris, the estimated position error with respect to Mars is inferior to that with respect to Earth. Therefore, the RNS usually offers navigation results with respect to Earth in interplanetary missions.
Different from the RNS, the ONS provide accurate navigation performance with respect to Mars, that is 8·6747 × 103 m in position and 0·0356 m/s. That is because ONS directly measures the observations with respect to Mars rather than Earth, and its navigation performance with respect to Mars does not depend on the Mars ephemeris, but on the accuracy of the measurements and models. When the Mars ephemeris uncertainty changes, the accuracy with respect to Mars provided by the ONS remains the same. However, also because of the inaccurate Mars ephemeris, the ONS cannot provide accurate navigation results with respect to Earth. Therefore, the ONS usually provides navigation results with respect to the target in interplanetary missions.
7.2.2. Fusion results with ephemeris uncertainty
Both the fusion results with and without ephemeris uncertainty and the fusion results with and without criteria are shown in Figure 11 and Table 5. It can be seen that the fusion accuracy is heavily influenced by the Mars ephemeris uncertainty. Because the Mars ephemeris uncertainty polluted the estimated position with respect to Mars in the RNS, the direct fusion results without criteria with respect to Earth are worse than the RNS.
After using the criteria, compared with the subsystems alone, better accuracies with respect to Earth and Mars are achieved. This is because the criteria of final results integrate the more accurate results from each subsystem. However, compared with the result without ephemeris uncertainty, the accuracy has declined. Therefore, the Mars ephemeris uncertainty is still propagated into the INS, and its effects cannot be ignored.
7.2.3. Fusion results with ephemeris correction
Figure 12 and Table 6 compare the fusion results using three ephemeris correction methods, including no correction, the analytical method and the estimation method. The errors of the calculated and estimated ephemeris uncertainties from the analytical and estimation methods are given in Figure 13.
By using the analytical method, the estimation errors with respect to both Earth and Mars decline a little. After the Mars ephemeris is calculated and corrected, the accuracy with respect to Mars is improved and is better than the ONS results. The calculated error of the Mars ephemeris uncertainty is within 7·8075 km (shown in Figure 13). Therefore, although the improvement is not evident, the improvement is attributed to the analytical method for the ephemeris correction, which provides the INS with a better ephemeris uncertainty result.
By using the estimation method, the INS can achieve the best accuracy. In particular, the estimation errors of the position with respect to Mars decline from 7·8062 km to 4·4704 km. The estimation error of the Mars ephemeris uncertainty is within 4·4707 km (Figure 13). The accuracy with respect to both Earth and Mars improved because of the corrected force models. It is indicated that the improvement of the Mars ephemeris uncertainty is attributable to the Mars ephemeris uncertainty model and KF helping to reduce the measurement noise from the analytical solution.
Therefore, the utilisation of the estimation method to correct ephemeris leads to the accuracy enhancement, which precisely estimates the ephemeris uncertainty, corrects the errors in the force models and reduces the effects of the Mars ephemeris uncertainty on the estimation accuracy. These results suggest that information fusion using estimation for ephemeris correction is an attractive solution for the ephemeris uncertainty problem.
7.3. Impact factors of estimation accuracy
The estimation accuracy of the ephemeris error is influenced by the parameters in the KF, such as the initial ephemeris error and covariance, the process noise covariance and the measurement noise covariance. The following are the specific effects of the impact factors on the estimation accuracy.
7.3.1. Initial ephemeris error and covariance
The initial ephemeris error Xerr (0) is the prior knowledge of the ephemeris uncertainty at the initial moment, and the initial ephemeris covariance is Perr (0) = E(Xerr (0)Xerr (0)T). The initial ephemeris error and covariance have some effects on the final estimation. Figure 14 and Table 7 give the estimation errors of the ephemeris uncertainty with different initial errors. From Figure 14 and Table 7, the estimation errors of ephemeris uncertainty increase with the initial ephemeris error growth.
7.3.2. Process noise covariance
The process noise covariance of the ephemeris uncertainty is defined as Qerr = E[(Werr)(Werr)T]. However, the process noise covariance is presumed to be
Figure 15 and Table 8 give the estimation errors of the ephemeris uncertainty with different process noise covariance matrices, and q 0 varies from 10−5 to 1012. From Figure 15 and Table 8, the estimation has the highest precision when q 0 = 102. It is suggested that only if the Qerr matches the real process noise covariance, the estimation error is minimum. Therefore, the prior knowledge of the process noise covariance is required.
7.3.3. Measurement noise covariance
The measurement noise covariance of the ephemeris uncertainty is defined as Rerr = E[(Verr)(Verr)T]. In our case, the ideal one is equal to ${\tilde{\bi R}}_{{\rm err}} = {\bf E}\left[ {\left( {{\bi Z}_{{\rm err}} - {\tilde{\bi X}}_{{\rm err}}} \right)\left( {{\bi Z}_{{\rm err}} - {\tilde{\bi X}}_{{\rm err}}} \right)^{\rm T}} \right]$, ${\tilde{\bi X}}_{{\rm err}} $ is the real Mars ephemeris uncertainty. However, ${\tilde{\bi X}}_{{\rm err}} $ is not exactly known in practice. Because Mars ephemeris uncertainty is approximately constant, the estimation at the last step Xerr (k − 1) can replace ${\tilde{\bi X}}_{{\rm err}} $. Therefore Rerr (k) = E[(Zerr (k) − Xerr (k − 1))(Zerr (k) − Xerr (k − 1))T] is used in simulations.
Figure 16 and Table 9 give the estimation errors of ephemeris uncertainty with different measurement noise covariance metrics. It is shown that the estimation is accurate when measurement noise covariance is the ideal one ${\tilde{\bi R}}_{{\rm err}} $. However because of the limited prior knowledge of the measurement noise, high estimation accuracy is hard to achieve.
8. CONCLUSIONS
This paper has presented a Radio/Optical integrated navigation method based on ephemeris correction for a probe to approach a target planet. In this paper, the ephemeris error model is established, and the analytical solution of the ephemeris uncertainty is considered as the measurement. The target ephemeris error is estimated and fed back to modify the force models, and its accuracy impact factors are analysed.
Furthermore, based on the accurate target ephemeris uncertainty estimation and correction, the Radio/Optical integrated navigation method provides precise navigation information with respect to Earth simultaneously to that with respect to the target.
The results demonstrate that by applying the proposed method the navigation errors caused by the ephemeris uncertainty dramatically decrease and the accuracy is sufficient for a successful approach to a target.
ACKNOWLEDGMENTS
The authors would like to thank all members of Science and Technology on Inertial Laboratory and those of Fundamental Science on Novel Inertial Instrument and Navigation System Technology Laboratory for their useful comments on this work.
FINANCIAL SUPPORT
The work described in the current paper was supported by the National Science Foundation of China (grant Nos. 61233005 and No. 61004140); National Basic Research Program of China (grant No. 2014CB744202); Innovation Foundation of BUAA for PhD Graduates; New Century Program for Excellent Talents of the Ministry of Education of China; The Shanghai Committee of Science and Technology (grant No.13dz2260100) and Open Project supported by Shanghai Key Laboratory of Deep Space Exploration Technology (grant No. DS201501-002).