# Unified registration model for both stationary and mobile 3D radar alignment.

1. IntroductionWith the increasing demands of the navigation accuracy in military and civilian applications, it is vitally important to fuse all the information from different sensors to obtain accurate target location estimate and comprehensive attribute information. However, before the benefits of multisensor integration can be realized, the sensor registration problem (or alignment) must be addressed. Sensor registration refers to the process of estimating sensor systematic biases (SBs) and compensating sensor measurements. If no registration is made, when raw measurements of different sensors are sent to the fusion center and transformed to a common reference frame, two kinds of adverse consequences would occur besides inaccurate location estimation: (1) data disassociation; (2) redundant tracks. In order to overcome the adverse influences mentioned above, a lot of registration methods were developed [1] based on stationary radar networks, and SBs in consideration only include range, gain of range, azimuth, and elevation biases referred to as offset biases (OBs).

Different from stationary radars, mobile radars are fixed on mobile carriers, in terms of installation methods, there are two kinds of platforms to fix radar: (1) gyrostabilized platforms (GSP) which can steadily follow systems referenced on local ENU (East-North-Up) frame [2]; (2) "unstabilized" GSP, namely, UGSP, directly fixed on platform and rotates with the platform simultaneously. GSP radar directly provides target coordinates (TCs) in the ENU reference frame. UGSP radar measurements are made in the measurement frame which should be converted to ENU frame by using attitude angles given by INS [3]. The common characteristic for both kinds of mobile radars is that they all need real-time attitude angle information to rectify radar sensitive axes influenced due to platform rotation. However, these attitude angles are biased because the accumulated errors in the inertial measurement units (IMU) of INS are referred to as attitude biases (ABs). Typically, when formulating 3D radar registration equations, both OBs and ABs are simultaneously selected as the state variables. If the system is unobservable (US), some of the biases cannot be estimated. Since both kinds of biases have the same influences on radar measurements (RMs), their dependencies should be analyzed first. If both kinds of biases are dependent, they should be combined to form new variables to make the system observable.

The concept of observability analysis (OA) first introduced for mobile radar registration (MRR) by Bar-Shalom [4] is not appropriate because the criterion he used is applied for linear time invariant system; however, the practical system is time varying. Then Herman and Poore [5] and Kragel et al. [6] gave registration model by using the least squares method and used the singular value decomposition (SVD) of the coefficient matrix (CM) of the registration equations. Possible dependencies among all biases are analyzed qualitatively according to magnitudes of different column vector elements in the unitary matrix obtained from SVD. These criteria use the singularity of matrix to identify the observability of the system (OoS) and US easily in an optimal situation because when dependent variables are contained in the system, CM of the registration equations is singular. However, in practice, especially in noisy circumstances, CM is usually nonsingular even if variables are linearly dependent because small noises in radar measurements can easily make the singular CM nonsingular. In this situation, CM is obviously ill-conditioned and the misjudgement will result in poor Kalman filter (KF) estimation results [7]. So, in noisy circumstances or variables with slowly varying linear dependent coefficients in the registration equations, this SVD criterion can only give the qualitative instead of the exact dependent relations among different variables. Besides the methods above, the optimized bias estimation model (OBEM) was proposed by Wang et al. [8], where it was verified that when the azimuth and yaw biases are combined as one variable, the registration model is observable. The attitude bias conversion model (ABCM) [7] is proposed to explicitly establish nonlinear registration equations using linear dependencies among all biases. Both models can be improved with deeper understanding of the relationships between OBs and ABs.

The linearization-caused estimate errors were analyzed in [7], where it was proved that these errors are minor and can be omitted for MRR model. So, in this paper, the linearized registration model and KF are still used as the basic method to obtain the bias estimates. From the control theory perspective of view, for nonlinear control system with zero input control items, the linearized model can be used directly to construct observability matrix (OM) to analyze the OoS [9]. Furthermore, Wang et al. [8] converted the ABs of the platform into radar measurement errors (MEs) by three analytical expressions. These expressions contain the TCs as well as the ABs as variables. Since the variations of the TCs between two consecutive observation instances are small compared with TCs, each expression can be divided into invariant and variant parts, respectively. The invariant part which is the majority in magnitude represents the dependencies between ABs and OBs, which can be proved by OM criterion. The variant part which is the minority in magnitude can be viewed as noise. These expressions are also deterministic and unique, which manifest that the dependencies between ABs and OBs are unavoidable and the MRR models are always US. Based on the analyses above we know that if the invariant parts converted from the ABs merge into radar OBs, the system will be observable. At the same time, if the minor variant parts are viewed as noises, then all the ABs will be absent in the MRR model, and this model has the same form as that of the stationary radar network. So we call this model the unified registration model (URM) because it can unify the stationary and mobile radar network registration model into one frame. It should be noted that the only difference when URM is used for stationary and mobile radar registration is that for the latter the process noise variances will be enlarged because of the additional noises caused by the variant parts. Compared with other MRR models, URM proposed in this paper has the least number of variables (only has "OBs" as variables) and minor computation burden. The estimates of the "OBs" in fact contain the estimates of ABs, and they can be used directly as OBs to compensate radar raw measurements. Usually the estimates of equivalent range and azimuth biases are accurate. Though many merits of URM, the equivalent elevation bias estimates are poor and need further improvement.

In order the simplify modeling, analysis, and assessment, other sources of biases in radar network such as sensor location bias errors and the timing biases are not discussed. It is assumed that both radars have accurate position information of themselves, and they are synchronized within the same sampling intervals.

Organization. In Section 2, a basic mathematical model for MRR is discussed. Observability analyses based on the basic model are described in Section 3. In Section 4, the detailed URM description based on observability analyses is presented and the variable attitude bias situation is discussed in Section 5. Simulation results with Cramer-Rao lower bounds (CRLBs) are given in Section 6. Finally, in Section 7, the final remarks of this study are given.

2. Basic Registration Model

Consider the ith radar, where i = {1,2}, which is installed on the ith moving carrier through three-axis gyrostabilized platform. The geographic coordinates of the ith platform are latitude Lst, longitude [Rs.sub.i], and altitude [H.sub.i], which are known in real-time. Figure 1 provides an illustration of satellite-borne radar [10], where the gyrostabilized platform of the satellite can steadily track local ENU frame through three sets of IMUs and servo motors in east, north, and up directions, respectively. After initial alignment, when the attitude of the satellite changes, IMUs of each axis can sense this change and convert it to electric signal to drive the corresponding servo motor to rotate in the opposite directions; then the platform frame can catch up with the ENU frame in real-time.

However, for bias errors in IMUs, rectified axes of the gyrostabilized platform have a set of Eulerian angles with corresponding axes of ENU frame. These angles are ABs. Since radar is fixed on the platform, the sensitive axes of radar will rotate with the platform in ENU frame, and ABs of the platform can be passed on to RMs; these ABs together with radar OBs make radar measurement deviate from its true coordinates.

Usually, ABs are defined as yaw bias [DELTA][phi], pitch bias [DELTA][eta], and roll bias [DELTA][psi], respectively [11], which can be seen in Figure 2(a). For ENU frame, its origin o is located at the center of the gyrostabilized platform; three mutually orthogonal axes x, y, and z refer to the directions of east, north, and up, respectively. The plane xoy is horizontal. We define the output Cartesian coordinates of the gyrostabilized platform as the platform frame. The platform frame has the same origin with ENU; Figure 2(a) shows the conversion process from the platform frame to ENU, where [x.sub.p], [y.sub.p], and [z.sub.p] denote x, y, and z axes of the platform frame, respectively, and the axes drawn in dashed lines are the intermediate axes. As shown in Figure 2(a), the transformation of TCs from the platform frame to ENU is accomplished by first rotating about the y-axis of the platform frame by the roll angle [DELTA][psi]y, then rotating about the intermediate x-axis by the pitch angle [DELTA][eta], and rotating about the final z-axis by the yaw angle [DELTA][phi]. Customarily, the polarity definitions of [DELTA][phi] and [DELTA][psi] abide by the left-hand rule, and [DELTA][eta] abides by the right-hand rule.

Figure 2(b) depicts radar measurement in the platform frame, where radar i is located at the origin o and [T.sub.t] denotes the true target location. denotes the ghost target influenced by the azimuth bias only and [T'.sub.m] denotes the ghost target influenced by all the biases. [o.sub.p], [o'.sub.m], and [o.sub.m] denote the corresponding projections on the platform frame [x.sub.p][oy.sub.p] plane, respectively. [o.sub.e] denotes the projection of the true target on the horizontal plane of the ENU frame. The measurements of target from the ith radar include the range [r.sub.i], azimuth [[theta].sub.i] (the true north corresponds to [theta] = 0, and the clockwise direction denotes the increment of [theta]), and elevation [[epsilon].sub.i], which contain the true target position information (such as the true range [r.sub.it], azimuth [[theta].sub.it], and elevation [[epslon].sub.it]), radar OBs (such as the range bias Ari, the gain of range kri which arise from (or in) atmospheric refraction [12], azimuth [DELTA][eta];, and elevation [[DELTA].sub.[epsilon]i]. Polarity definitions of [DELTA][eta]; and [DELTA][[epsilon].sub.i] are identical to 0 and e, resp.), ABs of the gyrostabilized platform, and random MEs (such as the range error Sri, azimuth [delta][[theta].sub.i], and elevation [DELTA][[epsilon].sub.i]). Random MEs are zero-mean Gaussian with known standard deviations. Figure 2(b) also shows that since the existence of ABs, the true target azimuth and elevation in platform frame are different from those in the ENU frame.

The main objective for MRR is to simultaneously estimate OBs and ABs using both radars' raw measurements. As shown in Figure 3, the mathematical registration models are established through the following process: (1) radar OBs, random MEs, and equivalent MEs caused by ABs included in the raw measurements are removed to obtain the true target coordinates (TTCs) in the ENU frame; (2) the conversion from ENU to ECEF frame is used to obtain TTCs in the common reference frame; (3) the registration equations can be established according to the fact that TTCs obtained from two different RMs are equal when they are converted to the common reference frame; (4) bias estimations (BEs) can be obtained by using different estimation algorithms. Initially all OBs and ABs are assumed constants and later as varying biases. The following are the main procedures.

Let the column vectors

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (1)

represent the true rectangular coordinates of the target at the observation instance k in the platform frame, ENU frame, and ECEF frame, respectively [13], of the ith sensor. The superscript "T" denotes matrix or vector transposition. These column vectors are also nonlinear vector functions. Sensor measurements, OBs, ABs, and random MEs are included in each element of the vectors.

Usually, all OBs and random MEs are small in magnitudes, in order to simplify the development of registration equations below; X; p (k) can be approximated by first-order Maclaurin series about OBs and random MEs as

[X.sub.i_p] (k) [approximately equal to] [X.sub.i] (k) + [A.sub.i] (k) [[beta].sub.i] (k) + [C.sub.i] (k) [w.sub.i] (k), (2)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (3)

According to the polarity definition of ABs and the rotation transformation order, the transition from the platform frame to ENU is given by 7]

[X.sub.i_ENU] (k) = [T.sub.i_p2ENU](k) [X.sub.i_p](k), (4)

where [T.sub.i_p2ENU] denotes the rotation matrix from the platform frame to ENU, which is an orthogonal matrix; that is, [T.sup.-1.sub.i_p2ENU] = [T.sub.i_ENU2p], and [8]

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (5a)

[t.sub.11_i] = cos ([DELTA][[psi].sub.i] cos ([DELTA][[phi].sub.i])-sin ([DELTA][[psi].sub.i]) sin ([DELTA][[theta].sub.i] sin [DELTA][[psi].sub.i], (5b)

[t.sub.12_i] = cos ([DELTA][[theta].sub.i]) sin ([DELTA][[psi].sub.i]), (5c)

[t.sub.13_i] = - sin ([DELTA][[psi].sub.i] - cos ([DELTA][[phi].sub.i] - cos [DELTA][[psi].sub.i] sin ([DELTA][[eta].sub.i]) sin [DELTA][[phi].sub.i], (5d)

[t.sub.21_i] = - cos ([DELTA][[psi].sub.i]) sin ([DELTA][[phi].sub.i]) - sin ([DELTA][[psi].sub.i]) sin ([DELTA][[eta].sub.i]) cos ([DELTA][[phi].sub.i]), (5e)

[t.sub.22_i] = - cos ([DELTA][[eta].sub.i]) cos ([DELTA][[phi].sub.i]), (5f)

[t.sub.23_i] = sin ([DELTA][[psi].sub.i]) sin ([DELTA][[phi].sub.i]) - cos ([DELTA][[psi].sub.i]) sin ([DELTA][[eta].sub.i]) cos ([DELTA][[phi].sub.i]), (5g)

[t.sub.31_i] = sin ([DELTA][[psi].sub.i]) cos ([DELTA][[eta].sub.i]), (5h)

[t.sub.32_i] = sin ([DELTA][[eta].sub.i]), (5i)

[t.sub.33_i] = cos ([DELTA][[psi].sub.i]) cos ([DELTA][[eta].sub.i]) (5j)

Similarly, (5a) can be approximated by the first-order Maclaurin series about ABs as

[T.sub.i_p2ENU] [approximately equal to] I + [[DELTA].sub.i] (k), (6)

where I is a 3x3 identity matrix, and

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (7)

Substituting (2) and (6) into (4) and omitting the higher order terms, (4) can be expanded as

[X.sub.i_ENU] (k)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (8a)

[X.sub.i_ENU] (k) + [-[A.sub.i] (k) [[beta].sub.i] (k) - [C.sub.i] (k) [w.sub.i] (k) - [[DELTA].sub.i] (k) [X.sub.i] (k)] [approximately equal to] [X.sub.i] (k). (8b)

Comparing (8a) and (8b) with (2), it is obvious that target location errors caused by ABs can be expressed by the last term of the left hand side of (8b). Omitting the subscript and time stamp "k" the errors can be written as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (9)

where [e.sub.x], [e.sub.y], and [e.sub.z] denote the errors caused by ABs in x, y, and z coordinates, respectively.

Then, the equivalent range MEs caused by ABs can be expressed as [8]

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (10)

Substituting (9) into (10) and selecting ABs in (10) as variables, the first-order Maclaurin series expansion of (10) can be written as

[DELTA][r.sub.c] ([DELTA][phi], [DELTA][eta], [DELTA][psi]) = 0 + o ([DELTA][phi], [DELTA][eta], [DELTA][psi]). (11)

Similarly, the equivalent azimuth measurement error is

[[DELTA][[theta].sub.c] = -[DELTA][phi] + yz[DELTA][psi] - xz[DELTA][eta]/[x.sup.2] + [y.sup.2] + o ([DELTA][phi],{DELTA][eta],[DELTA][psi]). (12)

The equivalent elevation measurement error is

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (13)

Since errors caused by ABs are equivalent to MEs, then TTCs in ENU frame can be written out directly without using rotation transformation as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (14a)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (14b)

[[gamma].sub.[[theta]i] (k) = [[theta].sub.i] (k) - [DELTA][[theta].sub.i] - [DELTA][[theta].sub.ci] (k) - [[delta].sub.[theta]I] (k), (14c)

[[gamma].sub.[epsilon]i] (k) = [[epsilon].sub.i] (k) - [DELTA][[epsilon].sub.i] -[DELTA][[epsilon].sub.ci] (k) - [[delta].sub.[epsilon]I] (k). (14d)

Substituting (11)-(13) into (14a) and omitting time stamp "k" for brevity, (14a) produces

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (15a)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (15b)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (15c)

The transition of TTCs from ENU to ECEF frame is given by Zhou et al. [14] as

[X.sub.i_ECEF] (k) = [X.sub.is] (k) + [T.sub.i] (k) x [X.sub.i_ENU] (k). (16)

where [X.sub.is] denotes the ith radar ECEF coordinates converted from its geographic coordinates, and [T.sub.i] is the rotation matrix. Both variables are only correlated with radar geographic coordinates at time k.

Since

[X.sub.1_ECEF] (k) = [X.sub.2_ECEF] (k). (17)

substituting (14a) and (16) into (17), the first-order linearized registration model can be approximated in the form of

Z (k) = H (k) [beta] (k) + C (k) w (k), (18)

where [[beta].sup.T] = [[[beta].sub.T.sub.1]] [[beta].sub.T.sub.1] denotes the state vector consisting of all OBs and ABs of both radars. [w.sup.T] = [[w.sup.T.sub.1], [w.sup.T.sub.2]] is a column vector which contains both radars' measurement noises.

3. Observability Analysis

Assuming a constant bias registration model, for which the state equations can be described as

[beta] (k+l) = I[beta] (k), (19)

I denotes the corresponding unit matrix.

First-order linearized equivalent measurement equations are assumed to have the similar form of (18).

According to dynamic equations (18) and (19), the N-step random OM can be written as [8]

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (20)

where E{w(k)[w.sup.T](k)} = R(k) and E{x} denotes the expectation of "x." N is a positive integer which is unrelated to k. R(i) in (20) is a constant matrix at different time because the RNs have the same variances at different time.

The system is observable (OS) when OM is positive definite [15]. In the following three cases, the observability of the different system is analyzed, respectively.

Condition 1. When C (i) is a constant matrix then two of the column vectors in the coefficient matrix H (i) are proportional--US.

Proof. Without loss of generality, assuming that column vectors [h.sub.1] (i) and [h.sub.2] (i) (i = k - N + 1, ..., k) are first and second column vectors in H (i), respectively, and satisfy [h.sub.1] (i) /[h.sub.2] (i) = a, where the proportionality factor a is a constant, then OM can be written as

M(k,k - N + 1) = [k.summation over (i=k-N+1)] [H.sup.T] (i)[CR.sup.-1][C.sup.T]H(i). (21)

Assuming that m (i) = [H.sup.T] (i) [CR.sup.-1][C.sup.T]H (i) and [v.sub.1] (i) and [v.sub.2] (i) are the first and second row vectors in m (i), respectively, then it is obvious that [v.sub.1] (i) /[v.sub.2] (i) = a as follows:

[v.sub.1] (k - N + 1) + [v.sub.1] (k - N + 2) + *** + [v.sub.1] (k)/ [v.sub.2] (k - N + 2) + [v.sub.2] (k - N + 2) + *** + [v.sub.2] (k) = a; (22)

that is, the first and second row vectors of OM M are proportional and the proportionality factor is a. Then M = 0--US.

Condition 2. When C(i) or H(i) is time-varying then the system is observable or--OS.

Proof. In this case, m (i) = [H.sub.T] (i) C (i) [R.sub.-1][C.sub.T] (i) H (i) is an nxn matrix, and the rank of m (i) is 3 because the rank of H (i) is 3. Since C (i) or H (i) is different in each time, when

N [greater than or equal to] [n/3], (23)

where the symbol [x] denotes the nearest integer greater than or equal to x, the rank of [[[SIGMA].sup.k.sub.i=k-N+1] m (i) is equal to N, and OM M is positive definite--OS.

Condition 3. When C (i) and the proportionality factor of two column vectors in H (i) vary slowly between different observation time, though OS, they can be tackled as US.

According to the proof of Condition 2, though the system is observable, the condition number of the coefficient matrix H (i) is very big because two column vectors in H (i) are proportional, and solutions of KF for the system are sensitive to noises. Since KF is an iterative algorithm, in each computational cycle, the variables in the state vector corresponding to both proportional column vectors in H (i) should be combined as one variable; then the system is observable, and the dimension of the state vector can also be decreased. Otherwise, if they are estimated separately, the solutions for each variable are unbelievable. As for variations between two different observation instances, if the magnitudes of the variation are small, they can be viewed as noises. Based on this, (19) can be modified as

[beta]' (k + 1) = [beta]' (k)+ [w.sub.[beta]'] (k+1), (24)

where [beta]' denotes the combined vector and [W.sub.[beta]'] denotes the remaining minor noises caused by the independent parts.

4. Unified Registration Model

Since variations of TCs are usually small compared with their coordinates, in MRR (18) derived from (15a), (15b), and (15c), coefficients of ABs and OBs can be divided into two parts: the invariant (or proportional) and variant parts which satisfy Conditions 1 and 2, respectively. According to analyses made for Condition 3, it is optimum to select the united biases as state vector as

[[beta]'.sub.i] (k)= [[DELTA][r.sub.i], [k.sub.ri], [DELTA][[theta]'.sub.i](k), [DELTA][[epsilon]'.sub.i] (k)], (25)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (26)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (27)

According to above analyses, in (25) it is optimum to select

[DELTA][r'.sub.i] (k) = [DELTA][r.sub.i] + [sup.k.sub.ri][r.sub.it] (k); (28)

however, it is not the best although it decreases the dimension of the state vector. The reason is that the constant models are assumed for OBs and ABs, and coupling influences on the radar range measurement caused by ABs are zeros (which can be seen from (11)). The gross range bias only correlates with the target range ([r.sub.i]) and is independent with TCs ([x.sub.i],[y.sub.i),[z.sub.i]). If the range bias uses (28) as the state variable, its state equation will be in the form of a constant plus a noise, which is inaccurate compared to the model using (25). Moreover, it will make the computation of the cross covariance of the state vectors more complicated and the estimation accuracies will be decreased (the simulation results made by authors have verified the results; for the limitation of the article length, the corresponding algorithm will not be given).

Hence, it is preferable to estimate [DELTA][r.sub.i] and [k.sub.ri] individually. However, the estimation results for both variables should be used simultaneously when rectifying radar raw measurements. It is meaningless to evaluate their estimation performance individually.

In the new state vector (25), variables [DELTA][[theta]'.sub.i] and [DELTA][[epsilon]'.sub.i] are no longer constants; they are varying with different target locations. Equations (26) and (27) can be differentiated individually about the time argument as

d ([DELTA][theta]') = d (yz[DELTA][psi] - xz[DELTA][eta])/[x.sub.2] + [y.sub.2]) = [a.sub.x]dx + [a.sub.y]dy + [a.sub.z]dz/[([x.sup.2] + [y.sup.2]).sup.2], (29a)

[a.sub.x] = - ([x.sup.2] + [y.sup.2]) z[DELTA][eta] - 2x (yz[DELTA][psi] - xz[DELTA][eta]), (29b)

[a.sub.y] = ([x.sup.2] + [y.sup.2]) z[DELTA][psi] - 2y (yz[DELTA][psi] - xz[DELTA][eta]), (29c)

[a.sub.z] = ([x.sup.2] + [y.sup.2]) y[DELTA][psi] - ([x.sup.2] + [y.sup.2]) x[DELTA][eta], (29d)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (30)

The subscript "i" which identifies different radars and time stamp "k" are omitted in (29a) and (30) for brevity. Assume that velocities of the target in x, y, and z directions in radar i ENU frame are mutually independent zero-mean Gaussian white noises whose standard deviations are [MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] and [MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] respectively. According to (29a) and (30), d([DELTA][theta]') and d(DELTA][epsilon]') are zero-mean Gaussian random processes, whose covariance can be written out as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (31a)

[b.sub.x] = ([x.sup.2] - [y.sup.2]) z[DELTA][eta] - 2xyz[DELTA][psi], (31b)

[b.sub.x] = ([x.sup.2] - [y.sup.2]) z[DELTA][psi] - 2xyz[DELTA][eta], (31c)

[b.sub.z] = ([x.sup.2] + [y.sup.2]) y[DELTA][psi] - ([x.sup.2] + [y.sup.2]) x[DELTA][eta], (31d)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (32)

where T denotes radar scanning period. Var {x} denotes the variance of "x." The cross covariance can be written as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (33)

E {x} denotes the expectation of "x." According to the state vector (25), substituting (14a) and (16) into (17) and using the first-order Maclaurin series expansion about OBs, ABs, and random measurement noises, the registration equations can be approximated as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (34)

where [T.sub.i] (k), [A.sub.i] (k), [C.sub.i] (k), and [w.sub.i] (k) are completely the same as (2), and

[Z.sub.URM] (k) = [X.sub.2s] (k) - [X.sub.1s] (k) + [T.sub.2] (k) [X.sub.2] (k) - [T.sub.1] (k) [X.sub.1] (k), [[beta].sub.URM] (k) = [[[[beta]'.sub.1][(k).sup.T], [[beta]'.sub.2] [(k).sup.T]].sup.T]. (35)

According to the analyses above, each systematic bias can be equivalent to a constant plus a zero-mean Gaussian white noise. The dynamic equation for them can be written as

[[beta].sub.URM] (k + 1) = [[beta].sub.URM] (k) + [w.sub.[beta]] (k + 1), (36)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (37)

The covariance matrix of [w.sub.[beta]] can be written as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (38)

where diag (x) denotes a matrix whose diagonal elements are composed of the vector x and the other elements of the matrix are zeros, and

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (39)

The linearized registration model is composed of (34) and (36), which unites radar OBs and the equivalent radar MEs caused by ABs as one variable. The system is observable and the estimation results can compensate the influences of OBs and ABs simultaneously. It also has the form of stationary radar registration model which has no ABs to be considered, and it is the extension of the latter. So, this model is called URM. Figure 4 is the block diagram of URM which manifests that the only difference between mobile and stationary radar registration when they use URM is that the former uses additional Gaussian white noises as part of azimuth and elevation biases. This is also the difference between URM and OBEM [1] despite the fact that they use the same state vector and equivalent measurement equations.

In the computation of the covariance matrix of the state vector, the standard deviation of the target velocities and the true ABs should be given previously. However, their true values cannot be obtained in practice; then it is feasible to use possible maximum values to replace them, which will inevitably increase the estimation errors. In fact, from (31a)-(33) the variances caused by the variations of the target locations are very small in magnitude; therefore, these approximations work reasonably well in practice.

5. Varying ABs Situation

Before this section, all OBs and ABs were assumed to be constants. In this discussion they are extended as varying biases. Despite the fact that many models such as constant or one-order Gauss-Markov process have been used for biases [4], we propose the more general model for varying bias p as

[beta] (k) = [[beta].sub.0] + [f.sub.[beta]] (k) + [[sigma].sub.[beta]] (k), (40)

where [[beta].sub.o] represents the constant term, [f.sub.[beta]] (t) represents the slowly varying term with initial value zero, and [[sigma].sub.[beta]] represents Gaussian white RNs. For [f.sub.[beta]] (t), since its form and polarity are unknown and its values vary slowly, it is better to be omitted in the state equations. For example, if the increasing function is used as the state equation and actually [f.sub.[beta]] (t) is decreasing with time, the unmatched model will lead to enlarged estimation errors. Hence, when establishing the registration model, the state equation for any bias can be written as

[beta] (k) = [[beta].sub.0] + [[sigma].sub.[beta]](k). (41)

Comparing with (41), (40) is only used to generate simulation/measurement data in experiments.

For radar OBs, the random term [[sigma].sub.[beta]] can be easily classified among random measurement noises (gain of the range bias excepted). However, for ABs, according to (26) and (27), [[sigma].sub.p] should be converted as explained in URM. According to (41), when URM is applied for varying AB registration, the form of the state equation remains unchanged; the covariance matrix, however, will be changed.

Substituting (40) into (26) and (27), respectively, we have

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (42)

Since RNs of attitude biases are independent, the additional covariance caused by them can be written as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (43)

Then just adding (43) to the corresponding terms of (38), URM can be applied to varying ABs situation.

6. Simulation Results

Both URM and OBEM algorithms are tested and compared in a simulated scenario where a common track is generated for two radars which are installed on different ships. As for AAM [1] (the acronym for "all augmented model," where all the OBs and ABs are augmented directly in the state vector), it has been compared with OBEM in [1] and the estimation performance is poorer than OBEM, especially for the elevation biases. Hence, AAM is not compared here.

Assume that ship 1 and ship 2 are moving with the constant velocity model, and the initial geographical coordinates are [40[degrees], 116[degrees], 10 m] and [40.75[degrees], 115.34[degrees], 10m], respectively. Initial states of both ships in their native ENU frame are [0,10 m/s, 0,10 m/s, 0,0]. State vector variables are x-coordinate (east), [v.sub.x]-velocity, y-coordinate (north), [v.sub.y]-velocity, z-coordinate (up), and [v.sub.z]-velocity, respectively. Same standard deviations of both ships' process noise are employed in x, y, and z coordinates by 0.1 m/[s.sup.2], 0.1m/[s.sup.2], and 0m/[s.sup.2], respectively. Fusion center locates 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 center is [60km, -170m/s, 30km, 30m/s, 5km, 1 m/s]. Standard deviations of the process noise in x, y, and z coordinates are set to 1 m/[s.sup.2], 1 m/[s.sup.2], and 0.1 m/[s.sup.2], respectively.

The geometry of radar and the target is shown in Figure 5. The true systematic OBs of both radars are assumed to be constant and equal as [DELTA][r.sub.i] = 300 m, [k.sub.ri] = 0.01, and [DELTA][[theta].sub.i] = [DELTA][[epsilon].sub.i] = 2[degrees], respectively.

Standard deviations of the random measurement noises for both radars are [[sigma].sub.ri] = 50 m and [[sigma].sub.[theta]i] = [[sigma].sub.[theta]i] = 0.5[degrees], respectively. ABs of both platforms are assumed to be equal with the form of (40), where [DELTA][[phi].sub.i] = [DELTA][[eta].sub.i] = [DELTA][[psi].sub.i] = 1[degrees], and for all ABs, [f.sub.[beta]] is a linear increasing function with 1[degrees]/h slope. The standard deviation of the RNs of all ABs is set equal to 0.1[degrees].

It is assumed that both radars are synchronized with the same sampling intervals T = 5 s. 200 scans of the target are simulated and the number of the Monte Carlo runs is set to 100. Figures 6 and 7 contain all the simulation results.

In order to compute the covariance matrix of the state vector [[beta].sub.URM], it is assumed that the maximum magnitudes are 2[degrees] for each attitude bias of both platforms, and the standard deviation for velocities in x, y, and z directions are [200,200,20] m/s, respectively. Figure 6 depicts the RMSEs of radar bias estimation results. Black solid lines represent the estimation results of OBEM and the red dotted lines represent URM. Thin lines represent radar 1 and thick lines represent radar 2 and green lines represent CRLBs of biases. Here, biases denote gross biases which contain radar OBs and equivalent biases caused by ABs. In computation of RMSEs, the true "gross biases" can be obtained by using (12) and (13) with true values. From these figures, we infer that the performance of URM is very close but superior to OBEM as a whole. The RMSE of gross range bias estimation is about 100 m, and the azimuth bias is about 0.1[degrees]. However, the gross elevation biases are poor with their RMSEs which are more than 1[degrees].

Usually, for TCs, z [much less than] x,y, according to (12), the pitch and roll biases are minor factors to gross azimuth bias compared with the yaw bias, so they can be omitted and the gross azimuth bias is almost constant. According to (31a), the variance of the gross azimuth bias is small. Hence, the estimation of the gross azimuth bias is good. On the contrary, according to (13) and (32), the variance of the gross elevation bias is big and its values are affected by TCs greatly which are obtained from radar raw measurements and have big errors especially when the target is far away from radar. So, the estimation results for the elevation biases are poor.

Figure 7 is RMSEs of TCs in ECEF frame which are obtained by using radar 1 raw measurements and measurements rectified by BEs, respectively; the thick black line represents RMSEs of the raw measurements; thin black lines represent RMSEs of raw measurements rectified by OBEM; red lines represent URM; and green lines represent the raw measurements rectified by true values of all equivalent biases obtained from (12) and (13). Simulation results show that two methods are almost the same. We infer that lines rectified by URM and OBEM are very close to lines rectified by true bias values in x and y coordinates; however, z coordinates have larger errors. This indicates that URM needs further improvement to improve the elevation bias estimation accuracy.

It should be noted that since the derivations of the model are first-order Taylor series approximations, which corresponds to modeling of small biases applications, when [k.sub.ri] + [DELTA][r.sub.i]/[r.sub.i], the sum of angle biases and random measurement noises are on the order of [10.sup.-2]; this approximated model works well. In practice (or real world applications), this condition is usually satisfied (e.g., [delta][[theta].sub.i] = 2[degrees] [approximately equal to] 0.03 rad).

7. Summary and Conclusion

For mobile radar, all the attitude biases can be converted into radar measurement errors by three analytical equations (range, azimuth, and elevation angles, resp.). The converted measurement errors have similar influences with radar offset biases on radar measurements. In fact, both kinds of biases are dependent, which was proved in the paper. In other words, we cannot simultaneously estimate offset and attitude biases separately. Based on this, a unified registration model (URM) was proposed whose registration equations only contain radar "offset biases" as state vector. However, these "offset biases" contain the influences of the attitude biases. These equivalent "offset bias" estimates can be used directly to compensate the influences of the attitude and offset biases on radar raw measurements simultaneously. Though URM has the least number of state variables and minor computation burden compared with other mobile radar registration model, URM is guaranteed to be observable. Simulation results show that URM equivalent range and azimuth bias estimates are well and close to the Cramer-Rao low bounds (CRLBs) except that the equivalent elevation bias estimates should be improved further.

Though the paper is about mobile 3D radar registration, the method and ideas in the paper will be helpful to design all kinds of observation systems on mobile platform.

Appendix

Cramer-Rao Lower Bound of URM

The linearized equivalent measurement equation of (34) can be simplified as

[Z.sub.URM] (k) = H (k) [[beta].sub.URM] (k) + C (k) w (k)

(k = 1, 2 ..., N-1). (A.1)

In order to get the lowest CRLB, [beta] can be viewed as constants since their variations are small. Then the joint probability density function (PDF) can be written as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (A.2)

where [Z.sub.k] = [[Z.sub.URM] (1), [Z.sub.URM] (2), ..., [Z.sub.URM] (k)], which represents the equivalent measurements up to time k.

The Fisher information matrix (FIM) can be given as [16]

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (A.3)

where denotes the true bias values. However, the expectation in (A.3) with respect to p(Z(i); [beta]) can hardly be achieved since H(i) and C(i) are nonlinear functions of radars' raw measurements Z(i) radars. The expectation can be approximated by evaluating the mean of Monte-Carlo simulations; that is, (A.3) can be approximated as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (A.4)

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (A.5)

Equation (A.2) shows that when the biases [beta] are constants, we can obtain the lowest CRLB. CRLBs plotted in Figure 6 are calculated under this assumption. As shown in Figure 6, MMSEs of the range and azimuth biases come close to the corresponding CRLBs. As for the elevation biases, their corresponding MMSEs are closer to CRLB curves corresponding to nonconstant equivalent biases; however, the calculated CRLBs correspond to the constant biases assumption, which is the reason why the MMSEs deviate relatively large from calculated CRLBs in Figure 6(c).

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China 61032001, 61102165, and 61002006 and Special Foundation Program for Mountain Tai Scholars of China.

http://dx.doi.org/10.1155/2014/598463

Correspondence should be addressed to Lei Chen; chenleLhjhy@yahoo.com

Received 16 July 2014; Revised 29 September 2014; Accepted 3 October 2014; Published 12 November 2014

Academic Editor: Peter Jung

References

[1] G. H. Wang, L. Chen, and S. Y. Jia, "Optimized bias estimation model for 3-D radar considering platform attitude errors," IEEE Aerospace and Electronic Systems Magazine, vol. 27, no. 1, pp. 19-24, 2012.

[2] I. F. Progri, Geolocation of RF Signals Principles and Simulations, Springer Science & Business Media, LLC, New York, NY, USA, 1st edition, 2011.

[3] T. N. Upadhyay, I. F. Progri, J. Lomas, and J. Buckler, "Precision relative navigation for automated rendezvous and docking," in Proceedings of the Annual AAS Guidance and Control, pp. 368-379, Breckenridge, Colo, USA, 1999.

[4] Y. Bar-Shalom, "Airborne GMTI radar position bias estimation using static-rotator targets of opportunity," IEEE Transactions on Aerospace and Electronic Systems, vol. 37, no. 2, pp. 695-699, 2001.

[5] S. M. Herman and A. B. Poore, "Nonlinear least-squares estimation for sensor and navigation biases," in Signal and Data Processing of Small Targets, vol. 6263 of Proceedings of SPIE, April 2006.

[6] B. D. Kragel, S. S. Danford, M. Herman, and A. B. Poore, "Bias estimation using targets of opportunity," in Signal and Data Processing of Small Targets, vol. 6699 of Proceedings of SPIE, 2007

[7] L. Chen, G. H. Wang, S. Y. Jia, and I. Progri, "Attitude bias conversion model for mobile radar error registration," Journal of Navigation, vol. 65, no. 4, pp. 651-670, 2012.

[8] G. H. Wang, L. Chen, S. Y. Jia, and I. Progri, "Optimized bias estimation model for mobile radar error registration," The Journal of Navigation, vol. 66, no. 2, pp. 227-248, 2013.

[9] R. Hermann and A. J. Krener, "Nonlinear controllability and observability," IEEE Transactions on Automatic Control, vol. 22, no. 5, pp. 728-740, 1977

[10] A. D. King, "Inertial navigation-past, present, and future," in Proceedings of the IEE Colloquium on Airborne Navigation Systems Workshop, pp. 3/1-3/9, London, UK, 1997

[11] R. E. Helmick and T. R. Rice, "Removal of alignment error in an integrated system of two 3-D sensors," IEEE Transactions on Aerospace and Electronic Systems, vol. 29, no. 4, pp. 1333-1343, 1993.

[12] U. I. Bhatti and W. Y. Ochieng, "Failure modes and models for integrated GPS/INS systems," The Journal of Navigation, vol. 60, no. 2, pp. 327-348, 2007.

[13] W.-K. Tseng and H.-S. Lee, "The vector function for distance travelled in great circle navigation," The Journal of Navigation, vol. 60, no. 1, pp. 158-170, 2007

[14] Y. Zhou, H. Leung, and M. Blanchette, "Sensor alignment with earth-centered earth-fixed (ECEF) coordinate system," IEEE Transactions on Aerospace and Electronic Systems, vol. 35, no. 2, pp. 410-418, 1999.

[15] Y. Y. Qin, H. Y. Zhang, and S. H. Wang, Kalman Filter and Integrated Navigation Theory, Northwestern Polytechnic University Press, Xi'an, China, 1998 (Chinese).

[16] S. M. Kay, Fundamental of Statistical Signal Processing: Estimation Theory, chapter 3, Prentice-Hall, Englewood Cliffs, NJ, USA, 1993.

Lei Chen, (1) G. H. Wang, (1) and Ilir F. Progri (2)

(1) Naval Aeronautical and Astronautical University, Yantai, Shandong 264001, China

(2) GiftetInc., 118 Heywood Street, No.3, Worcester, MA 01604, USA

Printer friendly Cite/link Email Feedback | |

Title Annotation: | Research Article |
---|---|

Author: | Chen, Lei; Wang, G.H.; Progri, Ilir F. |

Publication: | Journal of Electrical and Computer Engineering |

Article Type: | Technical report |

Date: | Jan 1, 2014 |

Words: | 7121 |

Previous Article: | Cross-modality 2D-3D face recognition via multiview smooth discriminant analysis based on ELM. |

Next Article: | The effect of applying 2D enhancement algorithms on 3D video content. |

Topics: |