Attitude Bias Conversion Model for Mobile Radar Error Registration

L. Chen; G. H. Wang; S. Y. Jia; I. Progri

doi:10.1017/S0373463312000239

Attitude Bias Conversion Model for Mobile Radar Error Registration

Published online by Cambridge University Press: 10 July 2012

L. Chen ,

G. H. Wang ,

S. Y. Jia and

I. Progri

Show author details

L. Chen*: Affiliation:
(Department of Electronic and Information Engineering, Naval Aeronautical and Astronautical University, Yantai, China)
G. H. Wang: Affiliation:
(Department of Electronic and Information Engineering, Naval Aeronautical and Astronautical University, Yantai, China)
S. Y. Jia: Affiliation:
(Department of Electronic and Information Engineering, Naval Aeronautical and Astronautical University, Yantai, China)
I. Progri: Affiliation:
(Giftet Inc, Worcester, MA 01604USA)
*: (E-mail: [email protected])

Article contents

Abstract
INTRODUCTION
REGISTRATION MODELS
SIMULATION RESULTS
CONCLUSIONS
References

Rights & Permissions

Abstract

Besides offset biases (such as range, the gain of range, azimuth, and elevation biases), for mobile radars, platform attitude biases (such as yaw, pitch, and roll biases) induced by the accumulated errors of the Inertial Measurement Units (IMU) of the Inertial Navigation System (INS) can also influence radar measurements. Both kinds of biases are coupled. Based on the analyses of the coupling influences and the observability of 3-D radars’ error registration model, in the article, an Attitude Bias Conversion Model (ABCM) based on Square Root Unscented Kalman Filter (SRUKF) is proposed. ABCM can estimate 3-D radars’ absolute offset biases under the influences of platform attitude biases. It converts platform attitude biases into radar measurement errors, by which the target East-North-Up (ENU) coordinates can be obtained from radar measurements directly without using the rotation transformation, which was usually used in the transition from platform frame to ENU considering attitude biases. In addition, SRUKF can avoid the inaccurate estimations caused by linearization, and it can weaken the adverse influences of the poor attitude bias estimation results in the application of ABCM. Theoretical derivations and simulation results show that 1) ABCM-SRUKF can improve elevation bias estimate accuracy to about 0·8 degree in the mean square error sense; 2) linearization is not the main reason for poor estimation of attitude biases; and 3) unobservability is the main reason.

Keywords

Error Registration Attitude Bias Attitude Bias Conversion Model (ABCM)Square Root Unscented Kalman Filter (SRUKF)

Type: Research Article
Information: The Journal of Navigation , Volume 65 , Issue 4 , October 2012 , pp. 651 - 670

DOI: https://doi.org/10.1017/S0373463312000239 [Opens in a new window]
Copyright: Copyright © The Royal Institute of Navigation 2012

1. INTRODUCTION

With the growing military and civilian demands for navigation and detection systems, more and more sensors are installed on moving platforms such as trucks, ships and aircraft. In order to obtain target locations, these sensors need to know the real-time attitude information of their platforms to rectify radar measurements. However, the attitude angles provided by the Inertial Navigation System (INS) are biased because of the accumulated errors in the Inertial Measurement Units (IMU) of INS. In addition, the sensors have native systematic biases which are usually called offset biases. The attitude biases and offset biases always influence the sensor measurements simultaneously and their adverse influences are coupled. It is impossible for a single sensor to rectify these biases. Fortunately, in order to estimate and compensate for these biases, many error registration methods have been proposed; this is one of the key technologies to be tackled first in sensor networking and directly affects the accuracies of the sensor networks in target tracking, fusion, and recognition.

At present, the methods for registration are mostly focused on the networks composed of stationary radars and the algorithms used include the parameter estimation methods such as weighted mean (Burke, Reference Burke1966), least square (Sudano, Reference Sudano1993), maximum likelihood (Zhou and Henry, Reference Zhou and Henry1997), and the state estimation methods such as Kalman Filter [KF] (Kousuge and Okada, Reference Kousuge and Okada1996), Unscented Kalman Filter [UKF] (Li et al., Reference Li, Leung and Zhou2004), EM method (Li and Leung, Reference Li and Leung2006), and so on. The difficulty for mobile radar registration, which is different from stationary radars, is to estimate offset biases of radars and attitude biases of platforms simultaneously. The influences of the attitude biases on radar measurements are nonlinear and related to the geometry between target(s) and radars. They take on the form of varying radar measurement errors and are coupled with the native offset biases of radars. In order to solve the coupling problems, Dela Cruz et al., (Reference Dela Cruz, Alouani, Rice and Blair1992); Helmick and Rice, (Reference Helmick and Rice1993); Wang et al., (Reference Wang, Chen and Jia2012) have made some efforts.

A two-stepped method was proposed by Dela Cruz et al., (Reference Dela Cruz, Alouani, Rice and Blair1992), which first estimated radar offset biases using a KF without considering the influences of attitude biases, that is, all the attitude biases were set zeroes. Subsequently, another KF was used to merely estimate attitude biases by using raw radar measurements rectified by the offset bias estimates obtained from the first step. This method ignored the coupling. That is, the offset biases were solved independently of the attitude biases. The model proposed by Helmick and Rice (Reference Helmick and Rice1993) considered the coupling influences adequately, however, it assumed that the sensors were close enough (e.g., they were located on the same platform). For models proposed by Dela Cruz et al., (Reference Dela Cruz, Alouani, Rice and Blair1992) and Helmick and Rice (Reference Helmick and Rice1993), they both selected relative offset biases and relative attitude biases as their system state variables. So, their methods could only obtain the relative bias estimates. However, the absolute bias estimates of each sensor are very important for the Integrated Situation Awareness (ISA) in large regions, which cannot be obtained by their methods. Wang et al., (Reference Wang, Chen and Jia2012) used all the absolute biases as state variables. They gave the equivalent measurement error expressions induced by the attitude biases by using linearization. Then, an Optimized Bias Estimation Model (OBEM) was proposed which omitted radar pitch and roll biases in the state vector when establishing the registration equations. However, OBEM did not make the best of equivalent error expressions to simplify the models and the reasons for poor estimate results of roll and pitch biases have not been fully explained.

In fact, the All Augmented Model (AAM) in Wang et al., (Reference Wang, Chen and Jia2012), which is the basic model for the moving platform registration, and OBEM are both linearized models, so, the errors caused by linearization may be the main reason for the poor estimates of attitude biases. In order to analyse the effects of the linearization, we establish the nonlinear registration models and use Square Root Unscented Kalman Filter (SRUKF), as can be seen in Merwe and Wan (Reference Merwe and Wan2001). In addition, based on the equivalent error expressions given in this paper, an Attitude Bias Conversion Model (ABCM) is proposed, in which the attitude biases are converted to radar measurement errors. This changes the coupling characteristic from multiplicative to additive and simplifies the modelling process. ABCM also uses all the absolute radar offset biases and attitude biases as the state variables to establish nonlinear equivalent measurement equations and use SRUKF as filter. Theorem 1 in Appendix B and the simulation results prove that the linearization is not the main reason for poor estimates of the attitude biases. The estimate results of ABCM-SRUKF are very close to OBEM because the former's estimate values of roll and pitch biases are zeros and the latter sets them to zeros, which suggest that observability is the main reason for poor estimates. To simplify the problems, in this paper, it is assumed that all the systematic biases are time-invariant parameters. It is also assumed that both radars have accurate position information for themselves; they are synchronized and have the same sampling intervals.

This paper is organized as follows: In section 2, the detailed descriptions of ABCM-SRUKF and the other comparative models such as AAM, OBEM, et al., are given. Then, in Section 3, we test the comparative models and ABCM-SRUKF with a simulated track data. Conclusions are given in Section 4. In Appendices A and B, the validity of the model is verified and the estimate errors induced by the linearization are analysed.

2. REGISTRATION MODELS

The problem addressed in this work can be stated as follows. Consider the ith radar, where i=1, 2, which is installed on the ith moving ship. The geographic coordinates of the ith ship are latitude Ls _i, longitude Rs _i, and altitude H _i, which are known in real time. Three-axis gyro-stabilized platform of radar can steadily track local East-North-Up (ENU) frame. Chapter 2 of Progri's pioneering work (Progri, Reference Progri2011) provides an excellent environment description of local and global reference coordinates and an illustration of various potential applications of this technology. For the ENU frame, its origin o locates at the centre of the gyro-stabilized platform, three mutually orthogonal axes x, y, and z refer to the directions of East, North and Up, respectively. The plane xoy is horizontal. The output Cartesian coordinates of the gyro-stabilized platform is defined as platform frame, which has the same origin as the ENU frame, but its axes have angle biases with the corresponding axes of the ENU. These biases are attitude biases. Figure 1 shows the conversion process from the platform frame to ENU, where x _p, y_p, and z _p denotes x, y, and z axis of platform frame, respectively, and the axes drawn in dashed lines are the intermediate axes. As shown in Figure 1, the transition of the target coordinates from the platform frame to ENU is accomplished by first rotating about the y-axis of the platform frame by the roll angle Δψ, then rotating about the intermediate x-axis by the pitch angle Δη, and rotating about the final z-axis by the yaw angle Δϕ. Customarily, the polarities of Δϕ and Δψ abide by the left-hand rule, while Δψ abides by the right-hand rule.

Figure 1. Conversion from the platform frame to ENU.

Radar measurements are based on measurement frame which shares the same origin with the platform frame. There are azimuth and elevation biases between the corresponding axes of two frames. The measurements of the targets from the ith radar include the range r _i, the azimuth θ _i, and the elevation ε _i, which contain the true target position information (such as the true range r _it, azimuth θ _it, and elevation ε _it), radar offset biases (such as the range bias Δr _i, the gain of the range k _ri, azimuth Δθ _i, and elevation Δε _i), the attitude biases of gyro-stabilized platform (such as the yaw bias Δϕ _i, pitch Δη _i, and roll Δψ _i), and random measurement errors (such as the range error δ _ri, azimuth δ _θi, and elevation δ _εi) which are zero-mean, Gaussian with known standard deviations.

The main work for mobile radar registration is to estimate radar offset biases and attitude biases simultaneously using both radars’ raw measurements. Figure 2 is the main procedures usually used to establish mathematic models. First, radar offset biases and random measurement errors included in the raw measurements are removed to obtain the True Target Coordinates (t.t.c.) in the platform frame. Then, the conversion to ENU is accomplished according to the attitude biases. Finally, the conversion from ENU to the Earth-Centered Earth-Fixed (ECEF) frame (see Zhou et al., Reference Zhou, Henry and Martin1999) is used to obtain the t.t.c. in a common reference frame. The theoretical basis for the alignment algorithm is that the t.t.c. included in both radars’ raw measurements are equal when they are converted to a common reference frame.

Figure 2. The general procedure for mobile radar registration.

From Figure 2, we know that the whole process is complicated and the conversion from the platform frame to ENU needs three rotation transformations. If we use the equivalent error expressions caused by the attitude biases, we can write out the t.t.c. in ENU frame directly from radar measurements. When the nonlinear filter is used for the model, such as SRUKF, the linearization process can also be deleted. As shown in Figure 3, the main modelling procedures are given step by step as follows:

Figure 3. The block diagram of ABCM-SRUKF.

2.1. Selection of the State Vector

Usually, for the moving radar registration equations, the offset and attitude biases of both radars are written sequentially in the state vector as (the order can be changed):

(1)

${\bi \beta \prime} = [{\rm \Delta} r_1, k_{r1}, {\rm \Delta} \theta _1, {\rm \Delta} \varepsilon _1, {\rm \Delta} r_2, k_{r2}, {\rm \Delta} \theta _2, {\rm \Delta} \varepsilon _2, {\rm \Delta} \phi _1, {\rm \Delta} \eta _1, {\rm \Delta} \psi _1, {\rm \Delta} \phi _2, {\rm \Delta} \eta _2, {\rm \Delta} \psi _2 ]^T,$

where the superscript “T” denotes the matrix or vector transposition.

According to (Wang et al., Reference Wang, Chen and Jia2012), in the first-order linearized equations of the systematic bias estimation models, the coefficients of the azimuth bias of radar i and the yaw bias of platform i are equivalent and both biases are linearly dependent. In this situation, if Equation (1) was used as state vector to establish the registration equations, the system is unobservable, and the estimates obtained individually for both biases are meaningless. On the contrary, when the subtraction of the yaw bias from the azimuth bias serves as one variable, the system is observable. That is, the state vector should be selected as:

(2)

${\bi \beta} = [\Delta r_1, k_{r1}, (\Delta \theta _1 - \Delta \phi _1 ),\Delta \varepsilon _1, \Delta r_2, k_{r2}, (\Delta \theta _2 - \Delta \phi _2 ), \Delta \varepsilon _2, \Delta \eta _1, \Delta \psi _1, \Delta \eta _2, \Delta \psi _2 ]^T$

In view of this, all the linearized models will select Equation (2) as their state vectors. Since all the biases are selected as the state variables, this kind of model is called the All Augmented Model (AAM) by Wang et al. (Reference Wang, Chen and Jia2012).

As for the nonlinear models, given the multiplicative coupling of biases and the existence of high-order terms, it is impossible to use (Δθ _i–Δϕ _i) as one variable when nonlinear filter (such as UKF) is used. Both biases are estimated separately, that is, Equation (1) is selected as the state vector. However, the linear dependences are still in being although they were testified in the linearized models, that is, the estimates for each variable are meaningless when they are used separately. On the contrary, if they are combined as one term or used simultaneously, they become meaningful, which can be seen in the following simulations. For convenience of comparison, the subtractions of both biases’ estimates are used in the nonlinear models when we compute the Root Mean Square Errors (RMSE).

2.2. True Target Coordinates in ENU Frame

Given the true target coordinates in radar iENU frame as [x _i, y_i, z_i], and the attitude biases of the platform i as [Δϕ _i, Δη _i, Δψ _i], Wang et al., (Reference Wang, Chen and Jia2012) derived the expressions for the equivalent measurement errors of the attitude biases as:

(3)

$\Delta r_{ic} = 0 + o(\Delta \phi, {\kern 1pt} \Delta \eta, {\kern 1pt} \Delta \psi ),$

(4)

${\rm \Delta} \theta _{ic} = - {\rm \Delta} \phi _i + \displaystyle{{y_i z_i {\rm \Delta} \psi _i - x_i z_i {\rm \Delta} \eta _i} \over {x_i^2 + y_i^2}} + o({\rm \Delta} \phi, {\kern 1pt} {\rm \Delta} \eta, {\kern 1pt} {\rm \Delta} \psi ),$

(5)

${\rm \Delta} \varepsilon _{ic} = \displaystyle{{ - x_i {\rm \Delta} \psi _i - y_i {\rm \Delta} \eta _i} \over {\sqrt {x_i^2 + y_i^2}}} + o({\rm \Delta} \phi, {\kern 1pt} {\rm \Delta} \eta, {\rm \Delta} \psi ).$

According to Equations (3)–(5), given the ith radar measurements at time “k” (r _i(k), θ _i(k), ε _i(k)), the systematic biases (Δr _i(k), k _ri(k), Δθ _i(k), Δε _i(k)), and the random measurement errors (δr _i(k), δ _θi(k), δ _εi(k)), the t.t.c. in the ENU frame can be written as:

(6)

$\eqalign{{\bi X}_{i\_ENU}^{\prime} = [x_{i\_ENU}^{\prime}, y_{i\_ENU}^{\prime}, z_{i\_ENU}^{\prime} ]^T = (r_i - \Delta r_i - \delta _{ri} - k_{ri} r_i ) \times \left[ {\matrix{ {{\rm sin(}\rho _i {\rm )cos}(\mu _i )} \cr {{\rm cos}(\rho _i ){\rm cos}(\mu _i )} \cr {{\rm sin}(\mu _i )} \cr}} \right],\quad\hskip-13pt$

where $\rho _i = \theta _i - (\Delta \theta _i - \Delta \phi _i ) - {\textstyle{{y_i z_i \Delta \psi _i - x_i z_i {\rm \Delta} \eta _i} \over {x_i^2 + y_i^2}}} - \delta _{\theta i}$ , $\mu _i = \varepsilon _i - \Delta \varepsilon _i + {\textstyle{{x_i \Delta \psi _i + y_i {\rm \Delta} \eta _i} \over {\sqrt {x_i^2 + y_i^2}}}} - \delta _{\varepsilon i}$ .

For simplicity, the time argument “k” is omitted in Equation (6). Since the true range of the target r _it cannot be obtained, it can be approximated by the range measurement r _i, and:

(6a)

$\left[ {\matrix{ {x_i} \cr {y_i} \cr {z_i} \cr}} \right] = \left[ {\matrix{ {r_i \sin(\theta _i )\cos(\varepsilon _i )} \cr {r_i \cos(\theta _i )\cos(\varepsilon _i )} \cr {r_i \sin(\varepsilon _i )} \cr}} \right]$

2.3. Transition from ENU to ECEF Frame

According to Zhou et al., (Reference Zhou, Henry and Martin1999), given the ith radar geographic coordinates, it is convenient to transform the t.t.c. from ENU to ECEF frame as:

(7)

${\bi X}_{i\_ECEF}^{\prime} (k) = {\bi X}_{is} (k) + {\bi T}_i (k) \times {\bi X}_{i\_ENU}^{\prime} (k),$

where:

(8)

${\bi T}_i \left( k \right) = \left[ {\matrix{ { - \sin Rs_i (k)} & { - \sin Ls_i (k)\cos Rs_i (k)} & {\cos Ls_i (k)\cos Rs_i (k)} \cr {\cos Rs_i (k)} & { - \sin Ls_i (k)\sin Rs_i (k)} & {\cos Ls_i (k)\sin Rs_i (k)} \cr 0 & {\cos Ls_i (k)} & {\sin Ls_i (k)} \cr}} \right].$

and:

${\bi X}_{i\_ECEF}^{\prime} (k)$ denotes the t.t.c. in the ECEF frame obtained from the measurements of the ith radar.
X_is(k) denotes the ith radar ECEF coordinates converted from its geographic coordinates.
T _i(k) is the rotation matrix.
X_is(k) and T _i(k) are only correlated with the geographic coordinates of the ith radar at time k.

2.4. Nonlinear ABCM Based on the SRUKF (ABCM-SRUKF)

In view of the fact that the true coordinates of the same target in the ECEF frame denoted by the different radar measurements are equal, we can obtain:

(9)

${\bi X}_{1s} (k) + {\bi T}_1 (k) \times {\bi X}_{1\_ENU}^{\prime} (k) = {\bi X}_{2s} (k) + {\bi T}_2 (k) \times {\bi X}_{2\_ENU}^{\prime} (k).$

Equation (9) can be rewritten in the form of nonlinear measurement (registration) equations as:

(10)

${\bi Z}_{ABCM} (k) = {\bi h}_{ABCM} ({\bi \beta}{{\prime} (k),{\bi w}(k)),$

where:

Z_ABCM(k)=X_2s(k)−X_1s(k);
${\bi h}_{ABCM} ({\bi \beta} ^{{\prime}} (k),{\bi w}(k)) = {\bi T}_1 (k) \times {\bi X}_{1\_ENU}^{{\prime}} (k) - {\bi T}_2 (k) \times {\bi X}_{2\_ENU}^{{\prime}} (k)$ ;
w(k)=[w₁^T(k), w₂^T(k)]^T.

In Equation (10), all the offset biases and attitude biases are assumed to be constants, then, the state equations can be written as

(11)

${\bi \beta} ^{{\prime}} (k + 1) = {\bi \beta}{{\prime} (k).$

In Equation (11), the state transition matrix is a unit matrix and the process noises for systematic biases are assumed to be zeroes.

Here, the model that converts the attitude biases into radar measurement errors and does not use the rotation transformation is called ABCM. The UKF proposed by Julier and Uhlmann (Reference Julier and Uhlmann2004), whose theoretical basis is the unscented transformation, can apply to nonlinear models and the computation burden does not increase much compared with a KF. SRUKF is the improvement of UKF which can ensure consistent estimation. For a detailed description of SRUKF see: Julier and Uhlmann (Reference Julier and Uhlmann2004); Li et al. (Reference Li, Wang, Rizos, Mumford and Ding2006); Jwo et al., (Reference Jwo and Lai2009); and Xu et al., (Reference Xu, Li, Rizos and Xu2010). In this paper, SRUKF is used for the nonlinear models composed of Equations (10) and (11), and we call this algorithm ABCM-SRUKF. The complete algorithm block diagram for ABCM-SRUKF is given in Figure 3 and the flowchart for ABCM-SRUKF is given in Figure 4.

In order to compare ABCM-SRUKF, nonlinear AAM and linearized ABCM (which is equivalent to linearized AAM) are given below.

2.5. Comparative Models

2.5.1. Nonlinear AAM based on SRUKF (AAM-SRUKF)

The dynamic equations of AAM are established according to the mechanisms of radar measurements.

First, the t.t.c. in radar i platform frame can be written as:

(12)

$\eqalign{{\bi X}_{i\_p} (k) = \left\{ {\matrix{ {[x_{i\_p} (k),y_{i\_p} (k),z_{i\_p} (k)]^T =}\hfill \cr {[r_i (k) - \Delta r_i (k) - \delta _{ri} (k) - k_{ri} (k)r_{it} (k)] \times \left[ {\matrix{ {{\rm sin}[\rho _i (k)]{\rm cos}[\mu _i (k)]} \cr {{\rm cos}[\rho _i (k)]{\rm cos}[\mu _i (k)]} \cr {{\rm sin}[\mu _i (k)]} \cr}} \right]} \cr}} \right.,$

where ρ _i(k)=θ _i(k)−Δθ _i(k)−δ _θi(k), μ _i(k)=ε _i(k)−Δε _i(k)−δ _εi(k).

Secondly, transition from the platform frame to ENU can be written as:

(13)

${\bi X}_{i\_ENU} (k) = [x_{i\_ENU} (k),y_{i\_ENU} (k),z_{i\_ENU} (k)]^T = {\bi T}_{i\_p2ENU} (k){\bi X}_{i\_p} (k),$

where:

X_{i_ENU}(k) denotes the t.t.c. in the ith radar ENU frame.
T_{i_p2ENU}(k) is an orthogonal matrix which denotes the rotation matrix from the platform frame to ENU.

and:

${\bi T}_{i\_p2ENU} = \left[ {\matrix{ {t_{11\_i}} & {t_{12\_i}} & {t_{13\_i}} \cr {t_{21\_i}} & {t_{22\_i}} & {t_{23\_i}} \cr {t_{31\_i}} & {t_{32\_i}} & {t_{33\_i}} \cr}} \right],\hfill$

where:

$t_{11\_i} = \cos\Delta \psi _i \cos\Delta \phi _i - \sin\Delta \psi _i \sin\Delta \eta _i \sin\Delta \phi _i$ ; $t_{12\_i} = {\rm cos\Delta} \eta _i {\rm sin}\Delta \phi _i$ ;
$t_{13\_i} = - \sin\Delta \psi _i \cos\Delta \phi _i - \cos\Delta \psi _i \sin\Delta \eta _i \sin\Delta \phi _i$ ;
$t_{21\_i} = - \cos\Delta \psi _i \sin\Delta \phi _i - \sin\Delta \psi _i \sin\Delta \eta _i \cos\Delta \phi _i$ ;
$t_{22\_i} = \cos\Delta \eta _i \cos\Delta \phi _i$ ; $t_{23\_i} = \sin\Delta \psi _i \sin\Delta \phi _i - \cos\Delta \psi _i \sin\Delta \eta _i \cos\Delta \phi _i$ ;
$t_{31\_i} = \sin\Delta \psi _i \cos\Delta \eta _i$ ; $t_{32\_i} = \sin\Delta \eta _i$ ; $t_{33\_i} = \cos\Delta \psi _i \cos\Delta \eta _i$ .

Thirdly, substituting Equations (12), (13) into Equation (7), the t.t.c. in ECEF frame can be written as:

(14)

${\bi X}_{i\_ECEF} (k) = {\bi X}_{is} (k) + {\bi T}_i (k) \times {\bi X}_{i\_ENU} (k).$

Fourthly, the nonlinear AAM registration equations can be written as:

(15)

${\bi X}_{1s} (k) + {\bi T}_1 (k) \times {\bi X}_{1\_ENU} (k) = {\bi X}_{2s} (k) + {\bi T}_2 (k) \times {\bi X}_{2\_ENU} (k).$

Equations (11) and (15) are the dynamic equations for the nonlinear AAM, and SRUKF can be used to estimate the offset and attitude biases simultaneously.

Figure 4. The complete algorithm flowchart for ABCM-SRUKF.

2.5.2. Linearized AAM based on Kalman filter (AAM-KF)

The linearized model of Equation (15) and Equation (2) were used as the state vector. The description of linearized AAM can be written as:

(16)

${\bi Z}_{AAM} (k) = {\bi H}(k){\bi \beta} (k) + {\bi C}(k){\bi w}(k),$

where:

Z_AAM(k)=X_2s(k)−X_1s(k)+T₂(k)X₂(k)−T₁(k)X₁(k),
${\bi X}_i (k) = \left[ {\matrix{ {x_i (k)} \cr {y_i (k)} \cr {z_i (k)} \cr}} \right] = \left[ {\matrix{ {r_i (k){\rm sin}[\theta _i (k)]{\rm cos}[\varepsilon _i (k)]} \cr {r_i (k){\rm cos}[\theta _i (k)]{\rm cos}[\varepsilon _i (k)]} \cr {r_i (k){\rm sin}[\varepsilon _i (k)]} \cr}} \right]$ ,
H(k)=[T₁(k)A₁(k),−T₂(k)A₂(k),D₁(k),−D₂(k)],
C(k)=[C₁(k),−C₂(k)],
A _i(k)=∂X_{i_p}(k)∂β_i(k),
C_i(k)=∂X_{i_p}(k)/∂w_i(k)
β_i(k)=[Δr _i(k), k _ri(k), Δθ _i(k), Δε _i(k)]^T,
w_i(k)=[δ _ri(k), δ _θi(k), δ _εi(k)]^T,
${\bi D}_i = \left[ {\matrix{ {y_i {\rm cos}(Ls_i ){\rm cos}(Rs_i ) + z_i {\rm sin}(Ls_i ){\rm cos}(Rs_i )} & {x_i {\rm cos}(Ls_i ){\rm cos}(Rs_i ) + z_i {\rm sin}(Rs_i )} \cr {y_i {\rm cos}(Ls_i ){\rm sin}(Rs_i ) + z_i {\rm sin}(Ls_i ){\rm sin}(Rs_i )} & {x_i {\rm cos}(Ls_i ){\rm sin}(Rs_i ) - z_i {\rm cos}(Rs_i )} \cr {y_i {\rm sin}(Ls_i ) - z_i {\rm cos}(Ls_i )} & {x_i {\rm sin}(Ls_i )} \cr}} \right]$ ,

The state equations can be written as:

(17)

${\bi \beta} (k + 1) = {\bi \beta} (k).$

Using KF for the dynamic equations composed of Equations (16) and (17), the model can be called the all augmented model based on a KF.

2.5.3. Linearized ABCM Based on Kalman Filter (ABCM-KF)

Selecting Equation (1) as the state vector, Equation (10) can be linearized by using the first-order Maclaurin expansion, then, KF can be used for estimation. This model is named as ABCM based on KF. ABCM-KF is equivalent to AAM-KF in essence, which will be proved in appendix A.

The comparisons of the models mentioned above can be seen in Table 1, where different rows denote different models mentioned in this paper. The column of ‘System variables’ denotes all the variables used in the state vectors of different models. The column of ‘Characteristic of the model’ denotes the characteristic of the dynamic equations. The column of ‘Filter’ denotes the filter used for different models.

Table 1. Comparison of AAM, ABCM, and OBEM.

3. SIMULATION RESULTS

In order to analyse the performance of ABCM-SRUKF and another three algorithms OBEM (Wang et al., Reference Wang, Chen and Jia2012), AAM-SRUKF and ABCM-KF, which are equivalent in essence to AAM-KF(Wang et al., Reference Wang, Chen and Jia2012), they are all compared in the same test environment. The system test setup block diagram of ABCM-SRUKF can be seen in Figure 5, which is also applicable to the other three algorithms.

Figure 5. System test setup block diagram.

The four alignment algorithms mentioned above are tested by generating a common track for two radars installed on different ships. It is assumed that Ship 1 and Ship 2 are moving with a constant velocity model and the initial geographical coordinates are [40°, 116°, 10m], [40·4°, 115·8°, 10m], respectively. The initial states of both ships in their native ENU frames are the same, i.e., [0,10m/s,0,10m/s,0,0]. In the state vector, the variables denote x-coordinate, x-velocity, y-coordinate, y-velocity, z-coordinate, and z-velocity, respectively. The standard deviations of both ships’ process noises are equal which are given in x, y, and z coordinates by 0·1m/s ², 0·1m/s ², and 0m/s ², respectively. The fusion centre is located at the initial position of Ship 1. The constant velocity model is also used for the target. The initial state of the target in fusion centre is [60km, −150m/s, 50km, 0m/s, 5km, 1m/s]. The standard deviations of the process noises in x, y, and z coordinates are set to 1m/s ², 1m/s ², and 0·1m/s ², respectively. The geometry of radars and target is shown in Figure 6. The true offset biases of both radars are assumed to be constants and equal as Δr _i=300m, k _ri=0·01, Δθ _i=2°, Δε _i=2°, respectively. The standard deviations of the random measurement noises for both radars are σ _ri=50m, σ _θi=0·5°, and σ _εi=0·5°, respectively. The attitude biases of both platforms are also assumed to be constant and equal as Δϕ _i=1°, Δη _i=1°, and Δψ _i=1°, respectively. It is assumed that both radars are synchronized with the same sampling intervals T=5s. 200 scans of the target are simulated and the number of Monte Carlo runs is set to 100. For length limitation, only the estimation results of radar 1 are given below.

Figure 6. The geometry of radar and target.

Figure 7 are the RMSEs of Radar 1 offset bias estimates, where the green lines represent the results of ABCM-KF, the blue lines represent OBEM-KF, the red lines represent ABCM-SRUKF, and the magenta lines represent AAM-SRUKF.

Figure 7(a) represents the gross range bias which is the sum of the range bias and the range bias induced by the gain of the range.

Figure 7(b) is the equivalent azimuth bias which is the subtraction of the yaw bias from azimuth bias.

Figure 7(c) is the elevation bias.

Figure 7. RMSEs of Radar 1 bias estimates. (a) gross range bias; (b) equivalent azimuth bias; (c) elevation bias.

Compared with the other three models, the attitude bias estimates of ABCM-SRUKF are always zeros regardless of the different attitude bias magnitudes, because in ABCM, the target location information weakens the influences of the attitude biases and restricts their amplitude of variation, which can be seen from the equivalent radar measurement error expressions at Equations (3)–(5). On the contrary, there is no weakening in AAM, which leads to bigger attitude estimate magnitudes (see Figure 8). In reality, attitude biases are usually small, then, the estimate errors will be unacceptable. According to Equation (5), the big estimate errors of attitude biases influence the estimate accuracies of radar elevation biases. So, ABCM-SRUKF has the best estimation results for elevation biases. For pitch and roll biases, OBEM sets them to zeros, which coincides with the results of ABCM-SRUKF. So, they have the similar estimate accuracies in elevation biases. Figure 7(b) shows that the RMSE of the subtraction of yaw bias from azimuth bias is less than 0·3°, which verifies the correctness of the selection of state vector.

Figure 8. RMSEs of the attitude bias estimates of both platforms. (a) pitch bias; (b) roll bias.

The RMSEs of pitch and roll biases estimated by three models (except OBEM) are given in Figure 8. The results show that the estimates deviate from the true values significantly. It is not ideal for the three models to estimate the attitude biases.

Figure 9 shows the RMSEs of Radar 1 measurements rectified by offset bias estimates. Since the attitude estimate errors are large, the attitude biases are omitted when the raw measurements are rectified. In Figure 9, the black lines represent the RMSE curves of raw measurements. Figure 9(c) shows that ABCM-SRUKF and OBEM have significant performances on rectifying z-coordinate errors.

Figure 9. RMSEs of Radar 1 measurements rectified by the offset bias estimation results. (a) x-coordinate; (b) y-coordinate; (c) z-coordinate.

Comparing four methods above, it is obvious that ABCM-SRUKF and OBEM have better and closer performance. Besides that, the former has simplified process for modelling and the idea of the conversion from attitude biases to measurement errors is both novel and prospective. It can be applied to all the detection systems with attitude biases and it does not need linearization. However, the latter has lower system state dimension, which can reduce the computation burden. Both algorithms have their own merits and they can be used for mobile radar registration.

4. CONCLUSIONS

For mobile 3-D radar registration, Wang et al., (Reference Wang, Chen and Jia2012) gave the equivalent measurement error expressions caused by the attitude biases. According to these expressions, they proposed Optimized Bias Estimation Model (OBEM), which is a linearized model and omits pitch and roll biases to establish registration model. Compared with All Augmented Model (AAM), which uses all the radar offset biases and platform attitude biases as state vector for registration, OBEM can obtain better elevation bias estimates and its calibration effects on radar raw measurements are better than AAM. However, OBEM cannot explain why the estimates of the attitude biases are poor. In order to testify the influences of linearization on the attitude bias estimates, in this paper, the nonlinear AAM and ABCM are proposed which use SRUKF as filter. ABCM uses the equivalent measurement error expressions to convert radar measurements to ENU frame directly without using rotation transformation, which simplifies the modelling process. Appendix A proves that linearized AAM and ABCM are equivalent in essence, and it also proves the validity of the derivations of the equivalent measurement error expressions at Equations (3)–(5). Appendix B gives the influences of linearization on attitude bias estimates mathematically and explains that the linearization is not the main reason for the poor estimates of attitude biases. The simulation results in Appendix B prove these results.

The observability proof for AAM in proposition 1 in Wang et al., (Reference Wang, Chen and Jia2012) and good estimate results for yaw bias in OBEM remind us that other dependencies may exist for pitch and roll biases with radar offset biases.

According to Equations (3)–(5), ${\rm \Delta} \theta - {\rm \Delta} \phi + {\textstyle{{yz{\rm \Delta} \psi - xz{\rm \Delta} \eta} \over {x^2 + y^2}}}$ , and ${\rm \Delta} \varepsilon + {\textstyle{{ - x{\rm \Delta} \psi - y{\rm \Delta} \eta} \over {\sqrt {x^2 + y^2}}}}$ should serve as one variable to keep the observability of the system. We will develop this method in our future work.

ACKNOWLEDGEMENTS

This work was supported in part by the National Natural Science Foundation of China 61032001, 61102165, 61002006 and Special Foundation Program for Mountain Tai Scholars of China.The authors would like to thank Giftet Inc. for its outstanding support and for enabling Dr. Progri to write portions of this article.

APPENDIX A

In order to testify the validity of the equivalent measurement error expressions caused by the attitude biases, the true target coordinates in ENU frame obtained from two different methods should be compared, that is, from the ABCM method and the rotation transformation method. The following are the derivations.

A1. THE ABCM METHOD

A first-order Taylor series expansion can be made for the nonlinear ABCM Equation (6) about zero systematic biases and random measurement errors as:

(A1)

${\bi X}_{i\_ENU}^{\prime} = [x_{i\_ENU}, y_{i\_ENU}, z_{i\_ENU} ]^T = {\bi X}_{\bi i}^{\prime} + {\bi A}_i^{\prime} {\bi \beta} _i + {\bi D}_i^{\prime} {\bi a}_i + {\bi C}_i^{\prime} {\bi w}_i,$

where:

(A2)

${\bi a}_i = [{\rm \Delta} \phi _i, {\rm \Delta} \eta _i, {\rm \Delta} \psi _i ]^T$

(A3)

${\bi X}_i^{\prime} = \left. {{\bi X}_{i\_ENU}^{\prime}} \right|_{\matrix{ {{\bi \beta} _i = 0} \cr {{\bi w}_i = 0} \cr}} = \left. {{\bi X}_{i\_p}} \right|_{\matrix{ {{\bi \beta} _i = 0} \cr {{\bi w}_i = 0} \cr}} = {\bi X}_i ;$

(A4)

${\bi A}_i^{\prime} = \displaystyle{{\partial {\bi X}_{i\_ENU}^{\prime}} \over {\partial {\bi \beta} _i}} = \displaystyle{{\partial {\bi X}_{i\_p}} \over {\partial {\bi \beta} _i}} = {\bi A}_i ;$

(A5)

${\bi C}_i^{\prime} = \displaystyle{{\partial {\bi X}_{i\_ENU}^{\prime}} \over {\partial {\bi w}_i}} = \displaystyle{{\partial {\bi X}_{i\_p}} \over {\partial {\bi w}_i}} = {\bi C}_i ;$

(A6)

${\bi D}_i^{\prime} = \displaystyle{{\partial {\bi X}_{i\_ENU}^{\prime}} \over {\partial {\bi a}_i}} = \left[ {\matrix{ {{\bi D}_i^{\prime} (1,1)} & {{\bi D}_i^{\prime} (1,2)} & {{\bi D}_i^{\prime} (1,3)} \cr {{\bi D}_i^{\prime} (2,1)} & {{\bi D}_i^{\prime} (2,2)} & {{\bi D}_i^{\prime} (2,3)} \cr {{\bi D}_i^{\prime} (3,1)} & {{\bi D}_i^{\prime} (3,1)} & {{\bi D}_i^{\prime} (3,3)} \cr}} \right],$

where the elements of matrix ${\bi D}_i^{\prime}$ can be written further as:

(A7)

${\bi D}_i^{\prime} (1,1) = r_i {\rm cos}(\theta _i ){\rm cos}(\varepsilon _i ) = y_i ;$

(A8)

${\bi D}_i^{\prime} (2,1) = - r_i {\rm sin}(\theta _i ){\rm cos}(\varepsilon _i ) = - x_i ;$

(A9)

${\bi D}_i^{\prime} (1,2) = \displaystyle{{x_i z_i} \over {x_i^2 + y_i^2}} r_i {\rm cos}(\theta _i ){\rm cos}(\varepsilon _i ) + \displaystyle{{ - y_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm sin}(\theta _i ){\rm sin}(\varepsilon _i ) = 0;$

(A10)

${\bi D}_i^{\prime} (1,3) = \displaystyle{{ - y_i z_i} \over {x_i^2 + y_i^2}} r_i {\rm cos}(\theta _i ){\rm cos}(\varepsilon _i ) + \displaystyle{{ - x_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm sin}(\theta _i ){\rm sin}(\varepsilon _i ) = - z_i ;$

(A11)

${\bi D}_i^{\prime} (2,2) = \displaystyle{{ - x_i z_i} \over {x_i^2 + y_i^2}} r_i {\rm sin}(\theta _i ){\rm cos}(\varepsilon _i ) + \displaystyle{{ - y_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm cos}(\theta _i ){\rm sin}(\varepsilon _i ) = - z_i ;$

(A12)

${\bi D}_i^{\prime} (2,3) = \displaystyle{{y_i z_i} \over {x_i^2 + y_i^2}} r_i {\rm sin}(\theta _i ){\rm cos}(\varepsilon _i ) + \displaystyle{{ - x_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm cos}(\theta _i ){\rm sin}(\varepsilon _i ) = 0;$

(A13)

${\bi D}_i^{\prime} (3,2) = \displaystyle{{y_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm cos}\varepsilon _i = y_i ;$

(A14)

${\bi D}_i^{\prime} (3,3) = \displaystyle{{x_i} \over {\sqrt {x_i^2 + y_i^2}}} r_i {\rm cos}\varepsilon _i = x_i.$

A2. THE ROTATION TRANSFORMATION METHOD

X_{i_ENU} obtained by using the first-order linearization can be written out as:

(A15)

${\bi X}_{i\_ENU} = {\bi X}_i + {\bi A}_i {\bi \beta} _i + {\bi C}_i {\bi w}_i + \Delta _i {\bi X}_i.$

In Equation (A15), X_i, A_i, and C_i are the same as those in Equation (16), and the higher-order minor terms are omitted. Also, the only term which contains the attitude biases is Δ_iX_i which can be rewritten as:

(A16)

${\rm \Delta} _i {\bi X}_i = \left[ {\matrix{ 0 & {{\rm \Delta} \phi _i} & { - {\rm \Delta} \psi _i} \cr { - {\rm \Delta} \phi _i} & 0 & { - {\rm \Delta} \eta _i} \cr {{\rm \Delta} \psi _i} & {{\rm \Delta} \eta _i} & 0 \cr}} \right]\left[ {\matrix{ {x_i} \cr {y_i} \cr {z_i} \cr}} \right] = \left[ {\matrix{ {y_i} & 0 & { - z_i} \cr { - x_i} & { - z_i} & 0 \cr 0 & {y_i} & {x_i} \cr}} \right]\left[ {\matrix{ {{\rm \Delta} \phi _i} \cr {{\rm \Delta} \eta _i} \cr {{\rm \Delta} \psi _i} \cr}} \right] = {\bi D}_i {\bi a}_i.$

Then, Equation (A15) can be rewritten as:

(A17)

${\bi X}_{i\_ENU} = {\bi X}_i + {\bi A}_i {\bi \beta} _i + {\bi C}_i {\bi w}_i + {\bi D}_i {\bi a}_i$

Comparing D_i in (A16) with ${\bi D}_i^{\prime}$ in Equation (A6), we can obtain:

(A18)

${\bi D}_i = {\bi D}_i^{\prime}.$

According to Equations (A1), (A3), (A4), (A5), and (A17):

(A19)

${\bi X}_{i\_ENU} = {\bi X}_{i\_ENU}^{\prime}.$

Equation (A19) proves the equivalence between ABCM and the normal model, which also proves the validity of the equivalent radar measurement error expressions caused by the attitude biases.

APPENDIX B

B1. THEOREM 1

Incorrect covariance of measurement noises induced by linearization is not the main factor to affect the estimate accuracy.

B2. PROOF

In order to analyse the effects of the incorrect covariance of the measurement noises in ABCM, we use the linearized model of ABCM which consists of Equations (24) and (25) based on Seo et al., (Reference Seo, Lee and Park2006).

Assuming that the complete information on the initial state covariance P(0) and the measurement noise covariance R(k) are not known, the KF designed for Equations (24) and (25) is no longer optimal, it can be expressed by:

(B1)

${\bi \hat \beta} _M (k + 1) = {\bi L}_M (k){\bi \hat \beta} _M (k) + {\bi K}_M (k + 1){\bi z}(k + 1);\;{\bi P}_M^ - (k + 1) = {\bi P}_M (k),$

(B2)

$\openup3{\bi K}_M (k + 1) = \left\{ {\matrix{ {{\bi P}_M^ - (k + 1){\bi H}^T (k + 1)[{\bi H}(k + 1){\bi P}_M^ - (k + 1){\bi H}^T (k + 1)} \cr { + {\bi C}(k + 1){\bi R}_M (k + 1){\bi C}^T (k + 1)]} \cr}} \right.,$

(B3)

${\bi P}_M (k + 1) = \left\{ {\matrix{ {{\bi L}_M (k){\bi P}_M^ - (k + 1){\bi L}_M^T (k) +} \cr {{\bi K}_M (k + 1)C(k + 1){\bi R}_M (k + 1){\bi C}^T (k + 1){\bi K}_M^T (k + 1)} \cr}} \right.,$

(B4)

${\bi L}_M (k) = {\bi I} - {\bi K}_M (k + 1){\bi H}(k + 1),$

where:

(B5)

${\bi P}_M (0) \equiv {\bi P}(0) + \Delta {\bi P}(0)\;{\rm and}\;{\bi R}_M (k) \equiv {\bi R}(k) + \Delta {\bi R}(k)$

are model representations of P(0) and R(k) respectively. ΔP(0) and ΔR(k) denote the respective modelling errors. Then, the mean-squared error of the estimate is expressed by:

(B6)

$E\{\Vert {\bi \hat \beta} _M (k + 1) - {\bi \beta} (k + 1)\Vert^2 \} = tr\{ {\bi P}(k + 1)\},$

where P(k+1) is an actual covariance matrix of the suboptimal estimate in (B1)–(B5), and:

(B7)

$\openup3pt{\bi P}(k + 1) = \left\{ {\matrix{ {{\bi L}_M (k){\bi P}^ - (k + 1){\bi L}_M^T (k) +} \cr {{\bi K}_M (k + 1)C(k + 1){\bi R}_M (k + 1){\bi C}^T (k + 1){\bi K}_M^T (k + 1)} \cr}} \right..$

From Equation (B7):

(B8)

$\eqalign{{\bi P}^ - (k + 1) = \left\{ {\matrix{ {P(k) =} \cr {{\bi L}_M (k - 1){\bi P}^ - (k){\bi L}_M^T (k - 1) + {\bi K}_M (k)C(k){\bi R}_M (k){\bi C}^T (k){\bi K}_M^T (k)} \cr}} \right..$

Proceeding in this way and substituting Equations (B5) and (B8) into Equation (B7), we can obtain:

(B9)

$\eqalign{{\bi P}(k + 1) = \left\{ {\matrix{ {\left[ {\mathop \prod \limits_{i = k}^0 {\bi L}_M (i)} \right]({\bi P}_M (0) - \Delta {\bi P}(0))\left[ {\mathop \prod \limits_{i = k}^0 {\bi L}_M (i)} \right]^T +}\hfill \cr {\mathop \sum \limits_{\,j = 0}^k \left\{ {\left[ {\mathop \prod \limits_{i = k}^j {\bi L}_M (i)} \right]{\bi K}_M (\,j){\bi C}(\,j)({\bi R}(\,j) + \Delta {\bi R}(\,j)){\bi C}^T (\,j){\bi K}_M^T (\,j)\left[ {\mathop \prod \limits_{i = k}^j {\bi L}_M (i)} \right]^T} \right\} +} \cr {{\bi K}_M (k + 1)C(k + 1)({\bi R}(k + 1) + \Delta {\bi R}(k + 1)){\bi C}^T (k + 1){\bi K}_M^T (k + 1)} \cr}.} \right.$

Let $\Delta {\bi P}_{{\bi P}_0}$ and ΔP_R denote the mean-squared errors of the estimation caused by ΔP(0) and ΔR(k), respectively, according to Equation (B9), we have

(B10)

$\Delta {\bi P}_{{\bi P}_0} (k + 1) = - \left[ {\mathop \prod \limits_{i = k}^0 {\bi L}_M (i)} \right]\Delta {\bi P}(0)\left[ {\mathop \prod \limits_{i = k}^0 {\bi L}_M (i)} \right]^T,$

(B11)

$\eqalign{\Delta {\bi P}_{\bi R} (k + 1) = \left\{ {\matrix{ {\mathop \sum \limits_{j = 0}^k \left\{ {\left[ {\mathop \prod \limits_{i = k}^j {\bi L}_M (i)} \right]{\bi K}_M (j){\bi C}(j)\Delta {\bi R}(j){\bi C}^T (j){\bi K}_M^T (j)\left[ {\mathop \prod \limits_{i = k}^j {\bi L}_M (i)} \right]^T} \right\} +} \cr {{\bi K}_M (k + 1)C(k + 1)\Delta R(k + 1){\bi C}^T (k + 1){\bi K}_M^T (k + 1)} \cr}} \right..$

According to Equations (B10) and (B11), the influences of the incorrect initial covariance on P(k+1) will diminish with time. In view of this, the errors of the equivalent measurement error covariance in Equation (24) caused by linearization are probably the main factor. Following is the computation of ΔR(j) in (B11).

For nonlinear registration model Equation (27), it can be written in the exact first-order Maclaurin series as:

(B12)

$\eqalign{{\bi Z}_{AAM} = {\bi H\beta} + {\bi Cw} + {\bi E}({\bi \beta}, {\bi w});\;{\bi E}({\bi \beta}, {\bi w}) = \displaystyle{1 \over 2}\left( {{\bi \beta} \displaystyle{\partial \over {\partial {\bi \beta}}} + {\bi w}\displaystyle{\partial \over {\partial {\bi w}}}} \right)^2 {\bi h}_{AAM} (a{\bi \beta}, a{\bi w})\;(0 \lt a \lt 1),$

where E(β, w)=[E_x, E_y, E_z]^T denotes the exact remainder terms in x, y, and z coordinate, respectively.

In Equation (B12), there are 10 variables, so, each element of E contains 10×10=100 terms. Since the coefficients of the attitude biases are smaller than 1, for the sake of simplicity of analysis, the errors caused by the attitude biases will not be considered. Then, each direction in E has only 49 terms. From Equation (B12), we can obtain:

(B13)

$\eqalign{{\bi E}_x = \left\{ {\matrix{ {\matrix{ {\cos (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,({\rm \Delta} r{\rm \Delta} \theta + \delta _r {\rm \Delta} \theta + {\rm \Delta} r\delta _\theta + \delta _r \delta _\theta ) -} \cr {\sin (\theta + \theta _e )\,{\rm sin}(\varepsilon + \varepsilon _e )\,({\rm \Delta} r{\rm \Delta} \varepsilon + \delta _r {\rm \Delta} \varepsilon + {\rm \Delta} r\delta _\varepsilon + \delta _r \delta _\varepsilon ) +} \cr {(r + r_e )\cos (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(k_r {\rm \Delta} \theta + k_r \delta _\theta ) -} \cr}} \cr {(r + r_e )\sin (\theta + \theta _e )\sin (\varepsilon + \varepsilon _e )\,(k_r {\rm \Delta} \varepsilon + k_r \delta _\varepsilon ) -} \cr {\matrix{ {1/2(r + r_e )\sin (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(({\rm \Delta} \theta )^2 + (\delta _\theta )^2 + 2{\rm \Delta} \theta \delta _\theta ) -} \cr {\matrix{ {(r + r_e )\cos (\theta + \theta _e )\sin (\varepsilon + \varepsilon _e )\,({\rm \Delta} \theta {\rm \Delta} \varepsilon + {\rm \Delta} \theta \delta _\varepsilon + \delta _\theta {\rm \Delta} \varepsilon + \delta _\theta \delta _\varepsilon ) -} \cr {1/2(r + r_e )\sin (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(({\rm \Delta} \varepsilon )^2 + (\delta _\varepsilon )^2 + 2{\rm \Delta} \varepsilon \delta _\varepsilon )} \cr}} \cr}} \cr}} \right.,$

(B14)

$\eqalign{{\bi E}_y = \left\{ {\matrix{ {\matrix{ { - \sin (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,({\rm \Delta} r{\rm \Delta} \theta + \delta _r {\rm \Delta} \theta + {\rm \Delta} r\delta _\theta + \delta _r \delta _\theta ) -} \cr {\cos (\theta + \theta _e )\,{\rm sin}(\varepsilon + \varepsilon _e )\,({\rm \Delta} r{\rm \Delta} \varepsilon + \delta _r {\rm \Delta} \varepsilon + {\rm \Delta} r\delta _\varepsilon + \delta _r \delta _\varepsilon ) -} \cr {(r + r_e )\sin (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(k_r {\rm \Delta} \theta + k_r \delta _\theta ) -} \cr}} \cr {(r + r_e )\cos (\theta + \theta _e )\sin (\varepsilon + \varepsilon _e )\,(k_r {\rm \Delta} \varepsilon + k_r \delta _\varepsilon ) -} \cr {\matrix{ {1/2(r + r_e )\cos (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(({\rm \Delta} \theta )^2 + (\delta _\theta )^2 + 2{\rm \Delta} \theta \delta _\theta ) +} \cr {(r + r_e )\sin (\theta + \theta _e )\sin (\varepsilon + \varepsilon _e )\,({\rm \Delta} \theta {\rm \Delta} \varepsilon + {\rm \Delta} \theta \delta _\varepsilon + \delta _\theta {\rm \Delta} \varepsilon + \delta _\theta \delta _\varepsilon ) -} \cr {1/2(r + r_e )\cos (\theta + \theta _e )\cos (\varepsilon + \varepsilon _e )\,(({\rm \Delta} \varepsilon )^2 + (\delta _\varepsilon )^2 + 2{\rm \Delta} \varepsilon \delta _\varepsilon )} \cr}} \cr}} \right.,$

(B15)

$\eqalign{{\bi E}_z = \left\{ {\matrix{ {cos(\varepsilon + \varepsilon _e )\,({\rm \Delta} r{\rm \Delta} \varepsilon + \delta _r {\rm \Delta} \varepsilon + {\rm \Delta} r\delta _\varepsilon + \delta _r \delta _\varepsilon ) +} \cr {(r + r_e )\cos (\varepsilon + \varepsilon _e )\,(k_r {\rm \Delta} \varepsilon + k_r \delta _\varepsilon ) -} \cr {1/2(r + r_e )\sin (\varepsilon + \varepsilon _e )\,(({\rm \Delta} \varepsilon )^2 + (\delta _\varepsilon )^2 + 2\Delta \varepsilon \delta _\varepsilon )} \cr}} \right.,$

where:

$r_e = - a_{{\rm \Delta} r} {\rm \Delta} r - a_{k_r} k_r r_t - a_{\delta _r} \delta _r$ ; $\theta _e = - (a_{{\rm \Delta} \theta} {\rm \Delta} \theta - {\rm \Delta} \phi ) - {\textstyle{{yz{\rm \Delta} \psi - xz{\rm \Delta} \eta} \over {x^2 + y^2}}} - a_{\delta _\theta} \delta _\theta$ ;
$\varepsilon _e = - a_{{\rm \Delta} \varepsilon} {\rm \Delta} \varepsilon + {\textstyle{{x{\rm \Delta} \psi + y{\rm \Delta} \eta} \over {\sqrt {x^2 + y^2}}}} - a_{\delta _\varepsilon} \delta _\varepsilon$ ; and $0 \lt a_{{\rm \Delta} r}, \; a_{k_r}, a_{{\rm \Delta} \theta}, \; a_{{\rm \Delta} \varepsilon}, \; a_{\delta _r}, a_{\delta _\theta}, \; a_{\delta _\varepsilon} \lt 1$

Using the well-known inequalities:

(B16)

$0 \leqslant |{\rm sin}(\theta )|,|\cos (\theta )| \leqslant 1\;\;{\rm and}\;\;r + r_e \leqslant r + |{\rm \Delta} r| + |k_r r_t | + |\delta _r |,$

and substituting the true bias values in the standard deviation for random measurement error terms in Equations (B13)–(B15), the maximum values of E_x, E_y, and E_z, respectively will be obtained.

Then:

(B17)

${\bi C}(k)\Delta {\bi R}(k){\bi C}^T (k) \lt diag([{\bi E}_{x\_max}^2 (k),\; {\bi E}_{y\_max}^2 (k),\; {\bi E}_{z\_max}^2 (k)]),$

where diag(V) denotes a square matrix whose main diagonal elements are composed of the elements of vector V, and the other elements are zeros. Substituting Equation (B17) into Equation (B11), the upper bounds of ΔP_R can be calculated.

Figure A1 is the square root of the diagonal elements of covariance matrix of the estimate. The thick lines represent the covariance of the linearized model using KF, and dotted lines represent the actual covariance upper bounds considering errors caused by linearization. For the range upper bounds, it's a little bigger, because in Equation (B13), Equation (B17) and the absolute value for each term can amplify the errors, and the number of the terms in Equation (B13) is large. Despite the amplification, the upper bound is only about 100 m bigger than the calculated one. The upper bounds for the other biases are very close to the calculated values which show that the effects of the linearization errors are small.

Figure A1. Estimated covariance considering linearization errors

From Equations (B13)–(B15), we know that the second-order remainder terms are smaller by an order of magnitude than the first-order terms. In addition, Figure A1 proves that the incorrect covariance of P(0) and R(k) are not the main factors for the poor estimates of the attitude biases and that the instability of the system should be the main factor. According to the definition of stability, when the system is stable, the adverse effects of P(0) will be diminished with time automatically which can be seen in Qin et al., (Reference Qin, Zhang and Wang1998). One of the sufficient conditions for stability is the controllability and observability of the system. Though it is not the necessary condition, the instability of the model we used in this paper shows that the system may be uncontrollable or unobservable, which will be studied in our future work.

References

REFERENCES

Burke, J. (1966). The SAGE Real Quality Control Fraction and its Interface with BUIC II/BUIC III. [R]. [s.l.]: MITRE Corporation.Google Scholar

Dela Cruz, E. J., Alouani, A. T., Rice, T. R. and Blair, W. D. (1992). Sensor Registration in MultisensorSystems. SPIE Signal and Data Processing of Small Targets, 1698, 382–393.Google Scholar

Helmick, R. E. and Rice, T. R. (1993). Removal of Alignment Errors in an Integrated System of Two 3-D Sensors. IEEE Trans. Aerospace and Electronic Systems, 29(4), 1333–1343.CrossRef Google Scholar

Julier, S. J. and Uhlmann, J. K. (2004). Unscented Filtering and Nonlinear Estimation. Proceedings of the IEEE, 92(3), 401–422.CrossRef Google Scholar

Jwo, D. J. and Lai, Sh. Y. (2009). Navigation Integration Using the Fuzzy Strong Tracking Unscented Kalman Filter. The Journal of Navigation, 62(2), 303–322.Google Scholar

Kousuge, Y. and Okada, T. (1996). Bias Estimation of Two 3-Dimensional Radars Using KalmanFilter. The 4th International Workshop on Advanced Motion Control, 377–382.Google Scholar

Li, W., Leung, H. and Zhou, Y. F. (2004). Space-time Registration of Radar and ESM Using Unscented Kalman filter. IEEE Trans. Aerospace and Electronic Systems, 40(3), 824–836.CrossRef Google Scholar

Li, Y., Wang, J., Rizos, C., Mumford, P. and Ding, W. (2006). Low-cost Tightly Coupled GPS/INS Integration Based on a Nonlinear Kalman Filtering Design. Proceedings of the 2006 National Technical Meeting of the Institute of Navigation, Monterey, CA, 958–966.Google Scholar

Li, Z. H. and Leung, H. (2006). An Expectation Maximization Based Simultaneous Registration and Fusion Algorithm for Radar Networks. 2006 Canadian Conference on Electrical and Computer Engineering, Ottawa, 31–35.CrossRef Google Scholar

Progri, I. (2011). Geolocation of RF Signals-Principles and Simulations. 1st ed., New York, NY: Springer Science & Business Media, LLC, 330 pp. [Online http://www.springer.com/engineering/electronics/book/978-1-4419-7951-3].Google Scholar

Qin, Y. Y., Zhang, H. Y. and Wang, S. H. (1998). Kalman Filter and Integrated Navigation Theory. Xi'an, Northwestern Polytechnical University Press, ch. 4. (in Chinese).Google Scholar

Seo, J., Lee, J. G. and Park, C. G. (2006). The Effect of the Incorrect Covariances of the Measurement Noises in SDINS, Proceedings of the 2006 National Technical Meeting of the Institute of Navigation, Monterey, CA, 1002–1011.Google Scholar

Sudano, J. J. (1993). A Least Square Algorithm with Covariance Weighting for Computing the Translational and Rotational Errors Between Two Radar Sites. IEEE Trans. Aerospace and Electronic Systems, 29(1), 383–387.Google Scholar

Merwe, R. and Wan, E. A. (2001). The Square-Root Unscented Kalman Filter for State and Parameter-Estimation. IEEE Proceedings on Acoustics, Speech, and Signal Processing, 3461–3464.Google Scholar

Wang, G. H., Chen, L., and Jia, S. Y. (2012). Optimized Bias Estimation Model for 3-D radar Network Considering Platform Attitude Errors. IEEE Aerospace and Electronic Systems Magazine, 27(1), 19–24.CrossRef Google Scholar

Xu, Zh., Li, Y., Rizos, C. and Xu, X. (2010). Novel Hybrid of LS-SVM and Kalman Filter for GPS/INS Integration, The Journal of Navigation, 63(2), 289–299.Google Scholar

Zhou, J., Knedlik, S. and Loffeld, O. (2010). INS/GPS Tightly-Coupled Integration Using Adaptive Unscented Particle Filter. The Journal of Navigation, 63(3), 491–511.CrossRef Google Scholar

Zhou, Y. F. and Henry, L. (1997). An Exact Maximum Likelihood Registration Algorithm for Data Fusion. IEEE Trans. Signal Processing, 45(6), 1560–1572.CrossRef Google Scholar

Zhou, Y. F., Henry, L. and Martin, B. (1999). Sensor Alignment with Earth-Centered Earth-Fixed Coordinate System. IEEE Trans. Aerospace and Electronic Systems, 35(2), 410–416.CrossRef Google Scholar