Mathematical Problems in Engineering

Volume 2013, Article ID 502610, 7 pages

http://dx.doi.org/10.1155/2013/502610

## Trajectory Estimation of Aircraft in a Double-Satellite Passive Positioning System with the Adjoint Method

^{1}Laboratory of Physical Oceanography, Ocean University of China, Qingdao 266003, China^{2}Laboratory of Coast and Island Development, Nanjing University, Nanjing 210093, China

Received 7 March 2013; Accepted 15 May 2013

Academic Editor: Antonio F. Bertachini A. Prado

Copyright © 2013 Anzhou Cao et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

A double-satellite passive positioning system is constructed based on the theory of space geometry, where two observation coordinate systems and a fundamental coordinate system exist. In each observation coordinate system, there exists a ray from the observation satellite to the aircraft. One difficulty lies in that these two rays may not intersect due to the existence of various errors. Under this situation, this work assumes that the middle point of common perpendicular between two rays is the actual position of aircraft. Based on the theory of space geometry, the coordinates of aircraft in the fundamental coordinate system can be determined. A dynamic model with the adjoint method is developed to estimate the trajectory of aircraft during the process of rocket propulsion. By assimilating observations, the trajectory of aircraft can be calculated. Numerical experiments are designed to validate the reasonability and feasibility of this model. Simulated results indicate that even by assimilating a small number of observations, the trajectory of aircraft can be estimated. In addition, the trajectory estimation can become more accurate when more observations are assimilated to the model.

#### 1. Introduction

The determination of the position of an aircraft by a passive observer is a typical navigation problem [1]. In this paper, a double-satellite passive positioning system is constructed based on the theory of space geometry. In this system, two observation coordinate systems corresponding to two observation satellites and a fundamental coordinate system exist. In each observation coordinate system, there exists a ray from the observation satellite to the aircraft. In the ideal situation where no error exists in the double-satellite passive positioning system, these two rays intersect and the point of intersection is the aircraft. One difficulty lies in that these two rays may not intersect due to the existence of various errors which contain systemic error of observation satellite and random error of measurement. Under this situation, this work assumes that the middle point of common perpendicular between two rays is the actual position of aircraft. Based on the assumption and theory of space geometry, the coordinates of aircraft in the fundamental coordinate system can be determined.

Based on observations of aircraft in the fundamental coordinate system, the trajectory of aircraft could be estimated. Spingarn [1] used an extended Kalman filter to obtain the estimations of optimal filtered position combined with observations. Jamilnia and Naghash [2] used two different approaches, which were separated approach and integrated approach, to optimize trajectories of multistage launch vehicles simultaneously. In this paper, the adjoint method is used to estimate the trajectory of aircraft during the process of rocket propulsion. Based on the theory of inverse problem, the adjoint method is a useful tool for parameter estimation by assimilating observations into numerical models. Lardner [3], Zhang and Lu [4], Guo et al. [5], Cao et al. [6], and Chen et al. [7] studied the inversion of open boundary conditions for ocean dynamic models. As for the inverse problem of other parameters, Lu and Zhang [8] and Zhang et al. [9] inverted spatially varying bottom friction coefficient for the two-dimensional tidal model, and Yu and O’Brien [10] estimated wind drag coefficient and eddy viscosity coefficients in an Ekman layer model. Results of their work demonstrate that the adjoint method is a useful tool for parameter estimation and can improve the accuracy of simulated results.

This paper is organized as follows. The double-satellite passive positioning system is constructed in Section 2. The dynamic model with the adjoint method is developed to estimate the trajectory of aircraft in Section 3. In Section 4, numerical experiments are designed to validate the reasonability and feasibility of this model. Summaries and conclusions are presented in Section 5.

#### 2. Double-Satellite Passive Positioning System

##### 2.1. Transformation of Coordinates

Two coordinate systems, namely, the fundamental and observation coordinate system, are used in a passive positioning system. Figure 1 is a snapshot of these coordinate systems. In the fundamental coordinate system , the geocenter is taken as the origin. The earth and observation satellite are simplified as two particles and constitute a two-body problem under the effect of gravity. Considering that the time scale of studied problem is much shorter than that of earth rotation, the fundamental coordinate system is regarded as an inertial system. The aircraft is measured by observation satellite in the observation coordinate system . As shown in the observation coordinate system of Figure 1, the position of observation satellite is taken as the origin, -axis is along the vector , and -axis is perpendicular to -axis and pointing to the north exactly. -axis is then ascertained following right hand system. Generally speaking, observation satellite would not pass the south and north poles, so the observation coordinate is definite and reasonable.

Considering that observation satellite is passive detective satellite which only measures direction, the aircraft is observed and represented by two dimensionless ratios ( and ) in the observation coordinate: where , , and are the coordinates of aircraft in the observation coordinate system. It should be noted that , , and are just used to represent the position of aircraft and cannot be measured by one observation satellite.

The key to achieve double-satellite passive position is to transform coordinates from the observation coordinate system to the fundamental one. The basic idea of transformation is described as follows. Assume that is an arbitrary point in the observation coordinate system. Three components of vector along , , and are set to , and , respectively. Considering that , , and are well-determined and can be described by the unit vectors , and in the fundamental coordinate system, , , and have the following relation with , , and : where ,, , , , , , , , , , , , , , , , and are parameters and will be derived in the following part. Then can be rewritten as which is the description of in the fundamental coordinate system. Detailed derivations are displayed as follows.

Assume that is in the fundamental coordinate system, is in the observation coordinate system, and in the fundamental one. Because is along vector , the unit vector of in the fundamental coordinate system is Considering that points to the north exactly, lies in the plane . As a result, direction vector of is also the normal vector of . Then unit vector of in the fundamental coordinate system can be described as As unit vectors of and have been determined, that of can be calculated by vector multiplication cross Consequently, in the fundamental coordinate system is described as

##### 2.2. Double-Satellite Passive Positioning System

As described before, observation satellite is passive detective satellite and can measure direction only. It means that the position of aircraft can be determined only when two or more observation satellites are available. In this paper, a double-satellite passive positioning system is constructed to study the positioning problem. This means that there exist two observation coordinate systems, of which the origins are the two observation satellites, respectively. In each observation coordinate system, there exists a ray from the observation satellite to the aircraft. In the ideal situation where no error exists in the double-satellite passive positioning system, these two rays intersect and the intersection point is the aircraft. One difficulty lies in that these two rays may not intersect due to the existence of various errors. Under this situation, this work assumes that the middle point of common perpendicular between two rays is the actual position of aircraft.

As , , and the trajectory information of observation satellites are known, the equation of the ray from the observation satellite to the aircraft in the fundamental coordinate system can be obtained as long as is transformed from the observation coordinate system to the fundamental one. According to the assumption, the position of aircraft can be determined based on the theory of space geometry. Detailed derivation is displayed as follows. (It should be noted that the unit vector rather than the equation of the ray is used in the derivation.)

Figure 2 is the schematic diagram of the double-satellite passive positioning system. and represent two satellites, and and represent the observations of the aircraft by satellites and , respectively. Based on the assumption, the middle point of is the actual position of the aircraft, which is represented by in Figure 2. In the fundamental coordinate system, assume that the coordinates of and are and , and unit vectors of and are and . Consider Then, Finally, the coordinate of aircraft in the fundamental coordinate system can be calculated as

#### 3. Dynamic model

As mentioned in Section 2, the coordinates of aircraft in the fundamental coordinate system are determined by the double-satellite passive positioning system, and they will be used as observations in the dynamic model. If adequate observations are obtained, the trajectory of the aircraft can be estimated by using the dynamic model with the adjoint method.

##### 3.1. Forward Model (Governing Equation)

The governing equation of the aircraft during the process of rocket propulsion in the fundamental coordinate system can be described as follows: where is the vector of position, is time, is the double derivative in time of , that is, acceleration, is the constant of earth attraction, is the acceleration caused by universal gravitation, and is the acceleration caused by rocket propulsion, which is taken as the unknown parameter and will be optimized by the adjoint method. Assume that , and , are the -, -, and -components of , respectively, (11) can be changed into where , , and are three components of .

##### 3.2. Adjoint Model and Corrections

The cost function is defined as where is the unit matrix [8] , , , , , and are observations and simulated coordinate of the aircraft, respectively. Then the Lagrangian function can be expressed as where , , and are the adjoint variables (namely, Lagrangian multipliers) of , , and , respectively.

According to the theory of Lagrangian multiplier method, we obtain the first-order derivatives of Lagrangian function with respect to all the variables, Equation (15) give the forward model described by (12). From (16) the adjoint model can be deduced as From (17), the corrections of , , and are obtained where , , and , , are prior and optimized values, receptively. Because the values of cost function decrease along the opposite direction of the gradient, by employing typical steepest descent method [11], , , and can be optimized during iterations.

Equations (12), (18) and (19) are discretized using the finite difference method and are shown as follows:

The computed process is designed as follows. (a) Run the forward model with prescribed initial values of , , and . (b) Calculate the value of cost function . (c) The difference between simulated results and observations plays as the external driving force of the adjoint model. The adjoint variables can then be obtained through the backward integration of the adjoint model. (d) Based on the corrections and typical steepest descent method, , , and can be optimized. Repeating the process aforementioned, the difference between simulated results and observations is decreased. When the convergence criterion is met, the optimization stops.

The convergence criterion could be that the number of iteration steps is prescribed, the last two values of the cost function are sufficiently close, the magnitude of the gradient norm is sufficiently small, the discrepancy between the updated and old parameters is sufficiently small, or a combination of these. In this work, the convergence criterion is that the number of iteration steps is equal to 10000, which leads to satisfied values of cost function and gradient norm and is obtained through a trial process. In addition, this convergence criterion is reasonable and essential to investigate the influence of the number of observations on the accuracy of simulated results in the numerical experiments.

#### 4. Numerical Experiments

The data used in the numerical experiments, containing , , and trajectory information of two observation satellites (satellites 06 and 09), are from problem B of the ninth National Graduate Mathematical Contest in Modeling (http://www.njnet.edu.cn/news/16/). These data are from 50 to 170 s with an interval of 0.2 s, corresponding to the process of rocket propulsion. The trajectories of observation satellites are plotted in Figure 3. and are plotted in Figure 4. Then the coordinates of aircraft in the fundamental coordinate system, which are used as observations, are determined according to formulas in Section 2 and are shown in Figure 5.

Four numerical experiments are designed to validate the sensitivity to the number of observations in the model. In experiment one (E1), the trajectory of aircraft is estimated by assimilating all observations. The number of observations is 601 in E1 with internal of 0.2 s. In E2–E4, the number of observations is decreased successively, which is 61, 21, and 13, respectively. In numerical experiments, the initial values of , , and are all equal to 10 m^{2}/s, and the time step is equal to 0.2 s. Simulated results are illustrated as follows.

Simulated results show good agreement with the observed ones in all four experiments. However, they are not plotted in a figure for very small differences with each other and the observations. Table 1 lists the mean absolute differences (MADs) and mean relative differences (MRDs) between simulated results and observations. In all four experiments, the MADs and MRDs are all very small, indicating the reasonability and feasibility of the model. Log of cost function and gradient norm are plotted in Figure 6. Cost function and gradient norm decrease fast during the iteration, implying the efficiency of the typical steepest method. Careful inspection shows that the MAD and MRD, as well as the value of cost function at the end of iterations, increase from E1 to E4. This is to say, the trajectory estimation of the aircraft becomes worse as the number of observations is decreased. Combining all these results, we can draw two conclusions. One is that even by assimilating a small number of observations, the trajectory of aircraft can be estimated using the dynamic model with the adjoint method. The other is that the trajectory estimation can become more accurate by assimilating more observations.

#### 5. Summary and Conclusions

In this paper, a double-satellite passive positioning system is constructed based on the theory of space geometry. In this system, two observation coordinate systems corresponding to two observation satellites and a fundamental coordinate system exist. In each observation coordinate system, there exists a ray from the observation satellite to the aircraft. In the ideal situation where no error exists in the double-satellite passive positioning system, these two rays intersect and the point of intersection is the aircraft. One difficulty lies in that these two rays may not intersect due to the existence of various errors. Under this situation, this work assumes that the middle point of common perpendicular between two rays is the actual position of aircraft. Based on the assumption and theory of space geometry, the coordinates of aircraft in the fundamental coordinate system can be determined.

In order to estimate the trajectory of aircraft during the process of rocket propulsion, a dynamic model with the adjoint method is constructed. The forward model is used to simulate the motion of aircraft, and the adjoint model is used to optimize parameters. By assimilating observations, which are the coordinates of aircraft in the fundamental coordinate system, the trajectory of aircraft can be estimated. Numerical experiments are designed to validate the reasonability and feasibility of this model. Results indicate that even by assimilating a small number of observations, the trajectory of aircraft can be estimated using the dynamic model with the adjoint method. In addition, the trajectory estimation can become more accurate by assimilating more observations.

#### Acknowledgments

Partial support for this research was provided by the National Natural Science Foundation of China through Grant 41206001 and 41076006, the Major State Basic Research Development Program of China through Grant 2013CB956500, the Natural Science Foundation of Jiangsu Province through Grant BK2012315, and the Priority Academic Program Development of Jiangsu Higher Education Institutions.

#### References

- K. Spingarn, “Passive position location estimation using the extended Kalman filter,”
*IEEE Transactions on Aerospace and Electronic Systems*, vol. 23, no. 4, pp. 558–567, 1987. View at Google Scholar · View at Scopus - R. Jamilnia and A. Naghash, “Simultaneous optimization of staging and trajectory of launch vehicles using two different approaches,”
*Aerospace Science and Technology*, vol. 23, pp. 85–92, 2012. View at Publisher · View at Google Scholar - R. W. Lardner, “Optimal assimilation of current and surface elevation data in a two-dimensional numerical tidal model,”
*Applied Mathematical Modelling*, vol. 19, no. 1, pp. 30–38, 1995. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at Scopus - J. Zhang and X. Lu, “Inversion of three-dimensional tidal currents in marginal seas by assimilating satellite altimetry,”
*Computer Methods in Applied Mechanics and Engineering*, vol. 199, no. 49–52, pp. 3125–3136, 2010. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - Z. Guo, A. Cao, and X. Lv, “Inverse estimation of open boundary conditions in the Bohai Sea,”
*Mathematical Problems in Engineering*, vol. 2012, Article ID 628061, 9 pages, 2012. View at Publisher · View at Google Scholar - A. Cao, Z. Guo, and X. Lv, “Inversion of two-dimensional tidal open boundary conditions of M
_{2}constituent in the Bohai and Yellow Seas,”*Chinese Journal of Oceanology and Limnology*, vol. 30, no. 5, pp. 868–875, 2012. View at Publisher · View at Google Scholar - H. Chen, C. Miao, and X. Lv, “A three-dimensional numerical internal tidal model involving adjoint method,”
*International Journal for Numerical Methods in Fluids*, vol. 69, no. 10, pp. 1584–1613, 2012. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - X. Lu and J. Zhang, “Numerical study on spatially varying bottom friction coefficient of a 2D tidal model with adjoint method,”
*Continental Shelf Research*, vol. 26, no. 16, pp. 1905–1923, 2006. View at Publisher · View at Google Scholar · View at Scopus - J. Zhang, X. Lu, P. Wang, and Y. P. Wang, “Study on linear and nonlinear bottom friction parameterizations for regional tidal models using data assimilation,”
*Continental Shelf Research*, vol. 31, no. 6, pp. 555–573, 2011. View at Publisher · View at Google Scholar · View at Scopus - L. Yu and J. J. O'Brien, “Variational estimation of the wind stress drag coefficient and the oceanic eddy viscosity profile,”
*Journal of Physical Oceanography*, vol. 21, pp. 709–719, 1990. View at Google Scholar - H. Chen, C. Miao, and X. Lv, “Estimation of open boundary conditions for an internal tidal model with adjoint method: a comparative study on optimization Methods,”
*Mathematical Problems in Engineering*, vol. 2013, Article ID 802136, 12 pages, 2013. View at Publisher · View at Google Scholar