Open Access

ARTICLE

# Cooperative Angles-Only Relative Navigation Algorithm for Multi-Spacecraft Formation in Close-Range

1
State Key Laboratory of Satellite Navigation System and Equipment Technology, Shijiazhuang, 050081, China

2
Nanjing University of Aeronautics and Astronautics, Nanjing, 210016, China

3
Beijing Institute of Control and Electronic Technology, Beijing, 100038, China

* Corresponding Author: Baichun Gong. Email:

*Computer Modeling in Engineering & Sciences* **2023**, *134*(1), 121-134. https://doi.org/10.32604/cmes.2022.017470

**Received** 12 May 2021; **Accepted** 15 February 2022; **Issue published** 24 August 2022

## Abstract

As to solve the collaborative relative navigation problem for near-circular orbiting small satellites in close-range under GNSS denied environment, a novel consensus constrained relative navigation algorithm based on the lever arm effect of the sensor offset from the spacecraft center of mass is proposed. Firstly, the orbital propagation model for the relative motion of multi-spacecraft is established based on Hill-Clohessy-Wiltshire dynamics and the line-of-sight measurement under sensor offset condition is modeled in Local Vertical Local Horizontal frame. Secondly, the consensus constraint model for the relative orbit state is constructed by introducing the geometry constraint between the spacecraft, based on which the consensus unscented Kalman filter is designed. Thirdly, the observability analysis is done and the necessary conditions of the sensor offset to make the state observable are obtained. Lastly, digital simulations are conducted to verify the proposed algorithm, where the comparison to the unconstrained case is also done. The results show that the estimated error of the relative position converges very quickly, the location error is smaller than 10 m under the condition of 10−3 rad level camera and 5 m offset.## Keywords

Maintaining formation configuration and restructuring control is essential for cooperative spacecraft to accomplish specific missions, and formation control depends on precise relative navigation between the members [1–3]. Estimating based on certain dynamic model, measuring with sensors on the spacecraft, and finally using the EKF filter algorithm or the UKF filter algorithm to update the relative state is the basic framework of the current navigation algorithm [4,5]. Relative dynamic model, the accuracy of on-board sensors together with navigation algorithm affect the accuracy and the observability of relative navigation.

At present, the commonly used sensors for relative measurement of spacecraft formation flying mainly include: relative GPS, microwave radar, LIDAR, visible light camera, infrared camera and laser rangefinder, etc. However, relative navigation based on GPS can be easily interfered by the environment. In addition, members in the formation will lose common star to do the relative measurement if they are far away from each other. Radio ranging navigation has the defect of mirror orbit [6,7]. Angles-only navigation method based on optical camera has the problem of unobservability or weak observability in relative orbit, and the environment in space greatly affects measurement accuracy of the camera [8–10]. In addition, the method that combines radio signals and laser can be applied, which uses the full sky coverage characteristics of radio beams to achieve target orientation, and then guides laser signals to complete distance measurement. However, formation flying of spacecraft often has strict restrictions on the volume and size of measurement equipment and payloads, which requires the use of as few measurement devices as possible to determine the relative orbit.

Range-only measurement via radio signals and angels-only optical navigation devices are relatively simple and reliable in spacecraft formation flying, thus becoming major trend in the field, and lots of research has been conducted by scholars. Dianetti et al. [11] utilized UWB ranging and phase angle difference information to solve the relative spacecraft navigation problem in short-range rendezvous and docking. Woffiden et al. [12] proposed orbital maneuver method to improve angles-only relative navigation system, but frequent orbital maneuvers will cause fuel consumption. Gaias et al. [13] studied the angles-only relative navigation from the perspective of relative orbit elements, and concluded that the semi-major axis of the orbit is not observable. Newman et al. [14] established a second-order nonlinear relative motion equation using QV (Quadratic Volterra) series, thus, to some extent, solved the observability problem of angles-only relative navigation, though the computational complexity is relatively large. Chen et al. [15–17] adopted a cooperative dual-satellite measurement strategy, Gao et al. [18] introduced measurement baseline to solve the observability problem of angles-only relative navigation by adopting dual-camera measurement strategy, which increases hardware cost. Wang et al. [19] solved the unobservability of range-only relative navigation in near-circular orbit by introducing consensus constraints in spacecraft formation, but relative orbit ambiguity problem still exists for angles-only relative navigation.

The main contribution of this paper is to develop a novel consensus constrained relative navigation algorithm for Multi-Spacecraft Formation in Close-Range that based on the lever arm effect of the sensor offset from the spacecraft center of mass, which will avoid angles-only relative navigation algorithm from converging to the mirror orbit. Orbital maneuver and computational burden brought by complex dynamic model are avoided in the proposed method, only single optical camera is needed to realize relative navigation of close-range spacecraft formation flying.

This paper begins with a brief review of Hill-Clohessy-Wiltshire dynamics and camera offset measurement model in Section 2. In Section 3, the consensus constraint model for the relative orbit state is constructed based on which the consensus unscented Kalman filter is designed. In Section 4, the observability analysis of the proposed angles-only relative navigation algorithm is addressed. In Section 5, Monte Carlo simulations with errors and uncertainties are conducted to verify the theoretical results. At last, conclusions are presented in Section 6.

2 Problem Statement and Formulation

The origin of a rotating local vertical local horizontal (LVLH) reference frame is collocated with the chief spacecraft center of mass. The axes of the LVLH frame are aligned with the chief spacecraft inertial position vector (x axis or radial), the normal to orbit plane (z axis or cross track), and the along-track direction (y axis completes the orthogonal set).

The position and velocity of the deputy spacecraft center of mass relative to the chief center of mass observed from the chief LVLH coordinates is denoted by

Then, under the assumptions of two-body problem and the range between the chief and deputy spacecraft is small compared to the radial distance to the center of Earth, the relative motion of the deputy with respect to the chief that is orbiting near-circular can be governed by the well-known Hill-Clohessy-Wiltshire dynamics [20] as follows:

where

where n is the angular velocity of the chief spacecraft. B is the input matrix of control forces

2.2 Angles-Only Measurement Model

It is assumed that the origin of the chief-fixed body reference frame is co-located with the chief center of mass. Without loss of generality, an optical-sensor (camera is considered in this work) offset from the chaser center of mass in the chief fixed body frame, i.e.,

where

where the assumption of constant attitude could be realized by attitude control which has been demonstrated by D'Amico et al. [21].

3 Relative Orbit Estimation Algorithm

Consider a formation of multiple (at least two) spacecraft, in which the inertial orbit of each spacecraft is assumed to be unknown. Furthermore, it is assumed that each spacecraft installs a directed camera used to measure the line-of-sight relative to other spacecraft and transmits its own estimation to other spacecraft by undirected broadcasting network.

As shown in Fig. 1, there is the distributed measurement and estimation scheme, each spacecraft obtains the measurement and estimate the relative orbit towards another spacecraft in its own LVLH frame. Obviously, if three or more spacecraft are involved in the formation, the relative orbits could form a vector loop which may be used to constrain the estimation. However, the constraint of vector loop would disappeared if only two spacecraft are considered. Then, different estimation method could be designed based on different available information. Thus, these two cases are discussed respectively in the following subsections.

3.1 Two-Spacecraft Formation Case

When only two spacecraft are in flight as a formation, there will be no other information except the angles-only measurements could be used to estimate the relative orbit. EKF algorithm is only suitable for the estimation of weakly nonlinear system because it expands the original system and measurement by Taylor series and retains only the linear term. Since the proposed angles-only navigation algorithm represents a nonlinear system, then the UKF introduced by Wan et al. [22] can be utilized to process the measurements for estimation. UKF does not have the linearization process for any nonlinear systems, so it can obtain higher estimation accuracy than EKF. Under the assumption of that the process and measurement noises are purely additive, four steps of the addictive form of UKF algorithm are summarized as follows:

(1) Initialization

(2) Calculate sigma points and scale weights

(3) Time update

(4) Measurement update

where the superscript–marks the priori estimate,

3.2 Three or More Spacecraft Formation Case

When multiple (at least three or more) spacecraft are involved in the formation, the constraint based on geometrical topology information between spacecraft may be used to improve the estimation. Then, Consensus Unscented Kalman Filter (CUKF) is a good and easy way to utilize the constraint to achieve a better estimation. The key of conducting CUKF to the orbital estimation is to construct the consensus condition. Thus, the consensus would be modeled firstly for the problem and then used in designing CUKF algorithm in the following.

As can be seen from Fig. 1, the position vectors of every three spacecraft are formed a vector loop which naturally is a physical constraint on the orbit estimations. From the viewpoint of observability, the observability of a system improves whenever additional constraints are applied on the system [19]. Thus, it is natural and feasible to force the orbit estimations to satisfy this physical constraint for improving the state observability. Further, satisfying the constraint is also a process of achieving consensus between the members of the formation.

Since the distributed estimate strategy is considered, the relative orbit estimations are resolved in different LVLH frames of each spacecraft. Thus, after coordinate transformation, the position vector loop can be expressed as follows:

where i, j, and k are the labels of different spacecraft;

Differentiating on the both side of (26) yields the constraint between the spacecraft velocities

Then, combing and re-organizing (26) and in matrix form produces

where

So far, the physical constraint on the relative orbital vectors of the in-loop spacecraft is achieved, which can be used as the consensus condition.

Next, the distributed Consensus Unscented Kalman Filter is considered to be used to estimate the relative orbit for each spacecraft, because of the convergence characteristic of CUKF when smooth and bounded vector field of the dynamics and the measurement are given [23]. According to the theorem of CUKF, all the other steps of CUKF are the same as those of UKF shown in (11)–(25) except the measurement update, as follows:

where

4 Observability Analysis for Relative Orbit

In this section, the Lie derivative method of the observability analysis for nonlinear systems is introduced, then theoretical observability analysis for the proposed offset camera line-of-sight measurement relative navigation system is presented.

For a general nonlinear dynamic system defined as

where

where

It has been shown that if

The system state is a 6-dimensional vector, and the observation state is a 3-dimensional unit vector but 2 bearing angles in essence. In order to make the observability matrix potentially full rank, the Lie derivatives are required to calculated at least three times. Without loss of generality, the line-of-sight measurement is adopted to perform the observability analysis of the system. The complex observability matrix is as follows:

where

Consider a constant vector

the relationship between

where

therefore, we can infer that

where

similarly, from Eq. (45) we can get

where

If and only if

Eq. (48) tells us that the system is unobservable if

The proposed algorithm is established in MATLAB simulation environment to verify theoretical conclusions mentioned above. The spacecraft parameter settings are shown in Table 1, and UKF filter parameter settings are shown in Table 2. The Hill-Clohessy-Wiltshire dynamics assumes that the chief spacecraft is running in a near-circular orbit. Therefore, the eccentricity settings of the three spacecraft should be small enough, as shown in Table 1 is 0, 0.0002 and 0.0003, respectively. The spacecraft fly in near-earth orbit, and the distance between the members is 1∼7 km, and the perturbation factors such as

In order to verify the effectiveness and performance of the proposed algorithm, the following two sets of simulation are performed: in the first group, offset situations are simulated to see whether the relative motion trajectory estimated by the UKF algorithm converges, and in the second group, same offset condition is set to compare convergence performance of CUKF algorithm and UKF algorithm. The statistics of 200 Monte Carlo shooting results are shown in Figs. 2 and 3, the green lines depict the mean estimated error while the red and blue lines describes

5.1 Two-Spacecraft Formation Case

Fig. 2 shows three-axis position and velocity estimation error of the UKF for

In order to intuitively compare the effects of different camera-offset length on the angles-only relative navigation algorithm proposed in this paper, the following statistics are defined

where

Applying mean error

5.2 Three or More Spacecraft Formation Case

Suppose the camera offset of the three spacecraft are

Under such camera offset conditions, combined with the results of the previous observability analysis, we can predict:

A new angles-only cooperative relative navigation algorithm for spacecraft formation in close-range is studied in this paper. Based on the Hill-Clohessy-Wiltshire dynamics, this paper studied the convergence of UKF and CUKF when the measurement sensor (camera) is installed offset from the center of mass of the spacecraft. The research work of this paper mainly includes four aspects: (1) The relative motion model between spacecraft and the sensor measurement model with camera installed away from the center of mass are established. (2) The observability of the estimated state is analyzed by introducing the Lie derivative criterion, and the observability conditions of relative position and velocity are obtained. (3) A decentralized estimation strategy based on consistent unscented Kalman filter is designed and the consistent estimation is constructed by using multiple physical constraints. (4) The effectiveness of the algorithm is verified by standard Monte Carlo simulation, and the performance of the algorithm is tested. The results show that for the spacecraft formation with a short distance of 1–7 km, the relative navigation accuracy is within 10 m when 5 m camera offset is designed. The relative navigation algorithm proposed in this paper is based on three spacecraft. When more spacecraft participate in formation or cluster, the decentralized strategy and nonlinear estimation algorithm will be more complex, which will be the main work of future research.

Funding Statement: This work is supported in part by the Natural Science Foundation of China (11802119), Science and Technology on Aerospace Flight Dynamics Laboratory (6142210200306), and Foundation of Science and Technology on Space Intelligent Control Laboratory (6142208200303).

Conflicts of Interest: The authors declare that they have no conflicts of interest to report regarding the present study.

## References

- Meng, Y. H. (2014). Introduction to spacecraft formation flying. Beijing, China: Defense Industry Press.
- Zhang, H., & Gurfil, P. (2018). Cooperative orbital control of multiple satellites via consensus.
*IEEE Transactions on Aerospace and Electronic Systems*,*54(5)*, 2171-2188. [Google Scholar] [CrossRef] - Zhang, H., & Gurfil, P. (2016). Distributed control for satellite cluster flight under different communication topologies.
*Journal of Guidance, Control, and Dynamics*,*39(3)*, 617-627. [Google Scholar] [CrossRef] - Ma, G. F., Wang, W., Huang, Q. L., Peng, Y. M., & Zhang, X. (2020). Astronomical integrated autonomous navigation method for small thrust orbit change.
*Journal of Astronautics*,*41(9)*, 1166-1174. [Google Scholar] [CrossRef] - Alfriend, K. T., Vadali, S. R., Gurfil, P. (2010). Spacecraft formation flying: Dynamics control and navigation. Oxford, UK: Elsevier.
- Shi, J. J., Gong, B. C., Li, S., Bai, Y. P., & Li, X. (2018). Analytical method of initial relative orbit determination for small satellite proximity operation with range-only measurement.
*Journal of Astronautics*,*39(8)*, 856-862. [Google Scholar] [CrossRef] - Gong, B. C., Li, W., Li, S., Ma, W. H., & Zheng, L. L. (2018). Angles-only initial relative orbit determination algorithm for non-cooperative spacecraft proximity operations.
*Astrodynamics*,*2*, 217-231. [Google Scholar] [CrossRef] - Guo, X. C., Meng, Z. J., & Huang, P. F. (2019). State estimation of non-cooperative target stars using monocular vision.
*Journal of Astronautics*,*40(10)*, 1243-1250. [Google Scholar] [CrossRef] - Gong, B. C., Li, S., Yang, Y., Shi, J. J., & Li, W. D. (2019). Maneuver-free approach to range-only initial relative orbit determination for spacecraft proximity operations.
*Acta Astronautica*,*163(B)*, 87-95. [Google Scholar] [CrossRef] - Hu, Y. X., Huang, P. F., Meng, Z. J., Liu, Z. X., & Zhang, Y. Z. (2019). Optimal approximation control of space tethered robots with limited vision guidance.
*Journal of Astronautics*,*40(4)*, 415-424. [Google Scholar] [CrossRef] - Dianetti, A. D., Gnam, C., Crassidis, J. L. (2021). Spacecraft proximity operations using ultra-wideband communication devices. AIAA Scitech 2021 Forum.
- Woffinden, D., & Geller, D. (2009). Optimal orbital rendezvous maneuvering for angles-only navigation.
*Journal of Guidance, Control and Dynamics*,*32(4)*, 1382-1387. [Google Scholar] [CrossRef] - Gaias, G., D'Amico, S., & Ardaens, J. (2014). Angles-only navigation to a noncooperative satellite using relative orbital elements.
*Journal of Guidance, Control and Dynamics*,*37(2)*, 439-451. [Google Scholar] [CrossRef] - Newman, B., Lovell, A., Pratt, E., Duncan, E. (2015). Hybrid linear-nonlinear initial determination with single iteration refinement for relative motion. 25th AAS/AIAA Space Flight Mechanics Meeting, Williamsburg, USA.
- Chen, T., & Xu, S. (2010). Double line-of-sight measuring relative navigation for spacecraft autonomous rendezvous.
*Acta Astronautics*,*67(1–2)*, 122-134. [Google Scholar] [CrossRef] - Wang, K., Xu, S. J., Li, K., & Tang, L. (2018). Error analysis and formation design for double line-of-sight measuring relative navigation method.
*Acta Aeronautica et Astronautica Sinica*,*39(9)*, 152-166. [Google Scholar] [CrossRef] - Wang, K., Chen, T., & Xu, S. J. (2011). A method of double line-of-sight measurement relative navigation.
*Acta Aeronautica et Astronautica Sinica*,*32(6)*, 1084-1091. [Google Scholar] - Gao, X. H., Liang, B., & Pan, L. (2015). High-orbit non-cooperative target multi-line of sight distributed relative navigation method.
*Journal of Astronautics*,*36(3)*, 292-299. [Google Scholar] [CrossRef] - Wang, J., Butcher, E., & Tansel, Y. (2019). Space-based relative orbit estimation using information sharing and the consensus kalman filter.
*Journal of Guidance, Control and Dynamics*,*42(3)*, 491-507. [Google Scholar] [CrossRef] - Curtis, H. (2013). Orbital mechanics for engineering students. Elsevier, Ltd., USA.
- D'Amico, S., Ardaens, J. S., & Gaias, G. (2013). Noncooperative rendezvous using angles-only optical navigation: System design and flight results.
*Journal of Guidance, Control and Dynamics*,*36(6)*, 1576-1595. [Google Scholar] [CrossRef] - Wan, E. A., Van Der Merwe, R. (2000). The unscented Kalman filter for nonlinear estimation. Proceedings of IEEE Adaptive Systems for Signal Processing, Communications, and Control Symposium, pp. 153–158. Alberta.
- Battistelli, G., & Chisci, L. (2016). Stability of consensus extended kalman filter for distributed state estimation.
*Automatica*,*68*, 169-178. [Google Scholar] [CrossRef] - Olfati-Saber, R. (2010). Kalman-consensus filter: Optimality, stability, and performance. Proceedings of the 48th IEEE Conference on Decision and Control Held Jointly with 2009 28th Chinese Control Conference, pp. 7036–7042. Georgia.

## Cite This Article

Wang, S., He, C., Gong, B., Ding, X., Yuan, Y. (2023). Cooperative Angles-Only Relative Navigation Algorithm for Multi-Spacecraft Formation in Close-Range.*CMES-Computer Modeling in Engineering & Sciences, 134(1)*, 121–134.