# Unified Registration Model for Both Stationary and Mobile 3D Radar Alignment

Authors: Lei Chen; G. H. Wang; Ilir F. Progri
Journal: Journal of Electrical and Computer Engineering
 (2014)

---

## Abstract

For mobile radar, offset biases and attitude biases influence radar measurements simultaneously. Attitude biases generated from the errors of the inertial navigation system (INS) of the platform can be converted into equivalent radar measurement errors by three analytical expressions (range, azimuth, and elevation, resp.). These expressions are unique and embody the dependences between the offset and attitude biases. The dependences indicate that all the attitude biases can be viewed as and merged into some kind of offset biases. Based on this, a unified registration model (URM) is proposed which only contains radar “offset biases” in the form of system variables in the registration equations, where, in fact, the “offset biases” contain the influences of the attitude biases. URM has the same form as the registration model of stationary radar network where no attitude biases exist. URM can compensate radar offset and attitude biases simultaneously and has minor computation burden compared with other registration models for mobile radar network.


---

## Body

## 1. Introduction

With 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 theith 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 Lsi, longitude Rsi, and altitude Hi, 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.Figure 1
The diagram of mobile radar installed on the gyrostabilized platform.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Δϕ, pitch bias Δη, and roll bias Δψ, 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 planexoy 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 xp, yp, and zp 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 Δψ, then rotating about the intermediate x-axis by the pitch angle Δη, and rotating about the final z-axis by the yaw angle Δϕ. Customarily, the polarity definitions of Δϕ and Δψ abide by the left-hand rule, and Δη abides by the right-hand rule.(a) Conversion from the platform frame to ENU and (b) measurement in platform frame.
(a)
(b)Figure2(b) depicts radar measurement in the platform frame, where radar i is located at the origin o and Tt denotes the true target location. Tm′ denotes the ghost target influenced by the azimuth bias only and Tm denotes the ghost target influenced by all the biases. op, om′, and om denote the corresponding projections on the platform frame xpoyp plane, respectively. oe 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 ri, azimuth θi (the true north corresponds to θ=0, and the clockwise direction denotes the increment of θ), and elevation εi, which contain the true target position information (such as the true range rit, azimuth θit, and elevation εit), radar OBs (such as the range bias Δri, the gain of range kri which arise from (or in) atmospheric refraction [12], azimuth Δθi, and elevation Δεi. Polarity definitions of Δθi and Δεi are identical to θ and ε, resp.), ABs of the gyrostabilized platform, and random MEs (such as the range error δri, azimuth δθi, and elevation δε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 Figure3, 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.Figure 3
The flow chart for MRR.Let the column vectors(1)Xi_pk=xi_pk,yi_pk,zi_p(k)T,Xi_ENUk=xi_ENUk,yi_ENUk,zi_ENU(k)T,Xi_ECEFk=xi_ECEFk,yi_ECEFk,zi_ECEF(k)T
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;Xi_pk can be approximated by first-order Maclaurin series about OBs and random MEs as
(2)Xi_pk≈Xik+Aikβik+Cikwik,
where
(3)βik=Δri,kri,Δθi,ΔεiT,wik=δrik,δθik,δεikT,Xik=xik,yik,zikT=Xi_pkβik=0wik=0,Aik=∂Xi_pk∂βikβik=0wik=0,Cik=∂Xi_pk∂wikβik=0wik=0.According to the polarity definition of ABs and the rotation transformation order, the transition from the platform frame to ENU is given by [7]
(4)Xi_ENUk=Ti_p2ENUkXi_pk,
where Ti_p2ENU denotes the rotation matrix from the platform frame to ENU, which is an orthogonal matrix; that is, Ti_p2ENU-1=Ti_p2ENUT=Ti_ENU2p, and [8](5a)Ti_p2ENU=t11_it12_it13_it21_it22_it23_it31_it32_it33_i,(5b)t11_i=cos⁡Δψicos⁡Δϕi-sinΔψisinΔηisinΔϕi,(5c)t12_i=cos⁡ΔηisinΔϕi,(5d)t13_i=-sinΔψicos⁡Δϕi-cos⁡ΔψisinΔηisinΔϕi,(5e)t21_i=-cos⁡ΔψisinΔϕi-sinΔψisinΔηicos⁡Δϕi,(5f)t22_i=-cos⁡Δηicos⁡Δϕi,(5g)t23_i=sinΔψisinΔϕi-cos⁡ΔψisinΔηicos⁡Δϕi,(5h)t31_i=sinΔψicos⁡Δηi,(5i)t32_i=sinΔηi,(5j)t33_i=cos⁡Δψicos⁡Δηi.Similarly, (5a) can be approximated by the first-order Maclaurin series about ABs as
(6)Ti_p2ENU≈I+Δik,
where I is a 3×3 identity matrix, and
(7)Δik=0Δϕi-Δψi-Δϕi0-ΔηiΔψiΔηi0.Substituting (2) and (6) into (4) and omitting the higher order terms, (4) can be expanded as(8a)Xi_ENUk≈I+ΔikXik+Aikβik+Cikwik︸≈Xik+Aikβik+Cikwik+ΔikXik,(8b)Xi_ENUk+-Aikβik-Cikwik-ΔikXik≈Xik.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 “i” and time stamp “k,” the errors can be written as
(9)exeyez=-ΔX=-0Δϕ-Δψ-Δϕ0-ΔηΔψΔη0xyz,
where ex, ey, and ez 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]
(10)ΔrcΔϕ,Δη,Δψ=x+ex2+y+ey2+z+ez2-x2+y2+z2.Substituting (9) into (10) and selecting ABs in (10) as variables, the first-order Maclaurin series expansion of (10) can be written as
(11)ΔrcΔϕ,Δη,Δψ=0+oΔϕ,Δη,Δψ.Similarly, the equivalent azimuth measurement error is(12)Δθc=-Δϕ+yzΔψ-xzΔηx2+y2+oΔϕ,Δη,Δψ.The equivalent elevation measurement error is(13)Δεc=-xΔψ-yΔηx2+y2+oΔϕ,Δη,Δψ.Since errors caused by ABs are equivalent to MEs, then TTCs in ENU frame can be written out directly without using rotation transformation as(14a)Xi_ENUk=γrik×sinγθikcos⁡γεikcos⁡γθikcos⁡γεiksinγεik,(14b)γrik=rik-Δri-kriritk-Δrcik-δrik,(14c)γθik=θik-Δθi-Δθcik-δθik,(14d)γεik=εik-Δεi-Δεcik-δεik.Substituting (11)–(13) into (14a) and omitting time stamp “k” for brevity, (14a) produces(15a)γri=ri-Δri-kririt-δri,(15b)γθi=θi-Δθi+Δϕi-yiziΔψi-xiziΔηixi2+yi2-δθi,(15c)γεi=εi-Δεi+xiΔψi+yiΔηixi2+yi2-δεi.The transition of TTCs from ENU to ECEF frame is given by Zhou et al. [14] as
(16)Xi_ECEFk=Xisk+Tik×Xi_ENUk,
where Xis denotes the ith radar ECEF coordinates converted from its geographic coordinates, and Ti is the rotation matrix. Both variables are only correlated with radar geographic coordinates at time k.Since(17)X1_ECEFk=X2_ECEFk.
substituting (14a) and (16) into (17), the first-order linearized registration model can be approximated in the form of
(18)Zk=Hkβk+Ckwk,
where βT=[β1T,β2T] denotes the state vector consisting of all OBs and ABs of both radars. wT=[w1T,w2T] 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(19)βk+1=Iβk,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]
(20)Mk,k-N+1=∑i=k-N+1kIHTiCiR-1iCTiHiI︸HT(i)CiR-1iCTiHi,
where EwkwTk=R(k) and Ex 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.
WhenCi is a constant matrix then two of the column vectors in the coefficient matrix Hi are proportional—US.Proof.
Without loss of generality, assuming that column vectorsh1i and h2i (i=k-N+1,…,k) are first and second column vectors in Hi, respectively, and satisfy h1i/h2i=a, where the proportionality factor a is a constant, then OM can be written as
(21)Mk,k-N+1=∑i=k-N+1kHT(i)CR-1CTHi.
Assuming thatmi=HTiCR-1CTHi and v1i and v2i are the first and second row vectors in mi, respectively, then it is obvious that v1i/v2i=a as follows:
(22)v1k-N+1+v1k-N+2+⋯+v1kv2k-N+1+v2k-N+2+⋯+v2k=a;
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.
WhenC(i) or H(i) is time-varying then the system is observable or—OS.Proof.
In this case,mi=HTiCiR-1CTiHi is an n×n matrix, and the rank of mi is 3 because the rank of Hi is 3. Since Ci or Hi is different in each time, when
(23)N≥n3,
where the symbol x denotes the nearest integer greater than or equal to x, the rank of ∑i=k-N+1kmi is equal to N, and OM M is positive definite—OS.Condition 3.
WhenCi and the proportionality factor of two column vectors in Hi vary slowly between different observation time, though OS, they can be tackled as US.According to the proof of Condition2, though the system is observable, the condition number of the coefficient matrix Hi is very big because two column vectors in Hi 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 Hi 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
(24)β′k+1=β′k+wβ′k+1,
where β′ denotes the combined vector and wβ′ 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
(25)βi′k=Δri,kri,Δθi′k,Δεi′kT,
where
(26)Δθi′k=Δθi-Δϕi+yikzikΔψi-xikzikΔηixi2k+yi2k,(27)Δεi′k=Δεi-xikΔψi+yikΔηixi2k+yi2k.According to above analyses, in (25) it is optimum to select
(28)Δri′k=Δri+kriritk;
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 (ri) and is independent with TCs (xi,yi,zi). 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Δri and kri 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 Δθi′ and Δε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(29a)dΔθ′=dyzΔψ-xzΔηx2+y2=axdx+aydy+azdzx2+y22,(29b)ax=-x2+y2zΔη-2xyzΔψ-xzΔη,(29c)ay=x2+y2zΔψ-2yyzΔψ-xzΔη,(29d)az=x2+y2yΔψ-x2+y2xΔη,(30)
d
Δ
ε
′
=
d
-
x
Δ
ψ
-
y
Δ
η
x
2
+
y
2
=
-
y
2
Δ
ψ
+
x
y
Δ
η
d
x
+
-
x
2
Δ
η
+
x
y
Δ
ψ
d
y
x
2
+
y
2
3
/
2
.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 σvx, σvy, and σvz, respectively. According to (29a) and (30), dΔθ′ and dΔε′ are zero-mean Gaussian random processes, whose covariance can be written out as(31a)σdΔθ′2=Var⁡dΔθ′=Var⁡axTvx+ayTvy+azTvzx2+y22=bx2T2σvx2+by2T2σvy2+bz2T2σvz2x2+y24,(31b)bx=x2-y2zΔη-2xyzΔψ,(31c)by=x2-y2zΔψ+2xyzΔη,(31d)bz=x2+y2yΔψ-x2+y2xΔη,(32)
σ
d
Δ
ε
′
2
=
Var
⁡
d
Δ
ε
′
=
Var
⁡
c
x
v
x
+
c
y
v
y
=
c
x
2
Var
⁡
v
x
+
c
y
2
Var
⁡
v
y
=
c
x
2
σ
v
x
2
+
c
y
2
σ
v
y
2
,
c
x
=
-
y
2
Δ
ψ
+
x
y
Δ
η
T
x
2
+
y
2
3
/
2
,
c
y
=
-
x
2
Δ
η
+
x
y
Δ
ψ
T
x
2
+
y
2
3
/
2
,
whereT denotes radar scanning period. Var⁡x denotes the variance of “x.” The cross covariance can be written as
(33)σdΔθ′dΔε′2=σdΔε′dΔθ′2=EdΔθ′dΔε′=Egxvx2+gyvy2=gxσvx2+gyσvy2,gx=bx-y2Δψ+xyΔηT2x2+y27/2,gy=by-x2Δη+xyΔψT2x2+y27/2.Ex 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
(34)ZURMk=T1kA1k,-T2kA2kβURMk+T1kC1k,-T2kC2kw1kw2k,
where Tik, Aik, Cik, and wik are completely the same as (2), and
(35)ZURMk=X2sk-X1sk+T2kX2k-T1kX1k,βURMk=β1′kT,β2′kTT.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(36)βURMk+1=βURMk+wβk+1,
where
(37)wβ=0,0,wdΔθ1′,wdΔε1′,0,0,wdΔθ2′,wdΔε2′T.The covariance matrix ofwβ can be written as
(38)Q=diag⁡Qβ1′,Qβ2′,
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
(39)Qβi′=0000000000q33q3400q43q44,q33=σdΔθi′2,q34=σdΔθi′dΔεi′2,q43=σdΔεi′dΔθi′2=q34,q44=σdΔεi′2.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.Figure 4
The block diagram of URM.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 β as
(40)βk=β0+fβk+σβk,
where βo represents the constant term, fβt represents the slowly varying term with initial value zero, and σβ represents Gaussian white RNs. For fβ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β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
(41)βk=β0+σβk.Comparing with (41), (40) is only used to generate simulation/measurement data in experiments.For radar OBs, the random termσβ can be easily classified among random measurement noises (gain of the range bias excepted). However, for ABs, according to (26) and (27), σβ 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(42)Δθi′k=Δθi-Δϕi+yikzik[Δψi+fΔψk+σΔψik]-xikzik[Δηi+fΔηk+σΔηik]︸≈yikzikΔψi-xikzikΔηi+yikzikσΔψik-xikzikσΔηikxi2k+yi2k,Δεi′k≈Δεi-xikΔψi+yikΔηixi2k+yi2k-xikσΔψik+yikσΔηikxi2k+yi2k.Since RNs of attitude biases are independent, the additional covariance caused by them can be written as(43)ΔσdΔθ′2=Var⁡gΔψiσΔψik+gΔηiσΔηik︸=gΔψi2σΔψi2+gΔηi2σΔηi2,gΔψi=yikzikxi2k+yi2k,gΔηi=-xikzikxi2k+yi2k,ΔσdΔεʼ2=Var⁡hΔψiσΔψik+hΔηiσΔηik︸=hΔψi2σΔψi2+hΔηi2σΔηi2,hΔψi=xikxi2k+yi2k,hΔηi=yikxi2k+yi2k,ΔσdΔθ′dΔε′2=EgΔψiσΔψik+gΔηiσΔηik×-hΔψiσΔψik-hΔηiσΔηik=-gΔψihΔψiσΔψi2-gΔηihΔηiσΔηi2=xikyikzikxi2k+yi2k3/2σΔηi2-σΔψi2.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 are40°,116°,10m and 40.75°,115.34°,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), vx-velocity, y-coordinate (north), vy-velocity, z-coordinate (up), and vz-velocity, respectively. Same standard deviations of both ships’ process noise are employed in x, y, and z coordinates by 0.1m/s2, 0.1m/s2, and 0m/s2, 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,1m/s. Standard deviations of the process noise in x, y, and z coordinates are set to 1m/s2, 1m/s2, and 0.1m/s2, respectively.The geometry of radar and the target is shown in Figure5. The true systematic OBs of both radars are assumed to be constant and equal as Δri=300m, kri=0.01, and Δθi=Δεi=2°, respectively.Figure 5
The geometry of radar and target.Standard deviations of the random measurement noises for both radars areσri=50m and σθi=σεi=0.5°, respectively. ABs of both platforms are assumed to be equal with the form of (40), where Δϕi=Δηi=Δψi=1°, and for all ABs, fβ is a linear increasing function with 1°/h slope. The standard deviation of the RNs of all ABs is set equal to 0.1°.It is assumed that both radars are synchronized with the same sampling intervalsT=5s. 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.Root mean square errors (RMSEs) of radar gross BEs. (a) Range bias; (b) azimuth bias; (c) elevation bias.
(a)
Time step (T=5 s)
(b)
Time step
(c)
Time stepRMSE of the target location inxyz-coordinates after rectifying radar 1 measurements by BEs. (a) x-coordinates; (b) y-coordinates; (c) z-coordinates.
(a)
Time step
(b)
Time step
(c)
Time step (T=5 s)In order to compute the covariance matrix of the state vectorβURM, it is assumed that the maximum magnitudes are 2° 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°. However, the gross elevation biases are poor with their RMSEs which are more than 1°.Usually, for TCs,z≪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.Figure7 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, whenkri+Δri/ri, the sum of angle biases and random measurement noises are on the order of 10-2; this approximated model works well. In practice (or real world applications), this condition is usually satisfied (e.g., Δθi=2°≈0.03rad).


## 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.



---

*Source: 598463-2014-11-12.xml*