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

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.


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.

Basic Registration Model
Consider the th radar, where  = {1, 2}, which is installed on the th moving carrier through three-axis gyrostabilized platform.The geographic coordinates of the th platform are latitude   , longitude   , and altitude   , which are known in real-time.Figure 1 provides an illustration of satelliteborne 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 Δ, pitch bias Δ, and roll bias Δ, respectively [11], which can be seen in Figure 2(a).For ENU frame, its origin  is located at the center of the gyrostabilized platform; three mutually orthogonal axes , , and  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 Figure 2(b) depicts radar measurement in the platform frame, where radar  is located at the origin  and   denotes the true target location.   denotes the ghost target influenced by the azimuth bias only and   denotes the ghost target influenced by all the biases.  ,    , and   denote the corresponding projections on the platform frame     plane, respectively.  denotes the projection of the true target on the horizontal plane of the ENU frame.The measurements of target from the th radar include the range   , azimuth   (the true north corresponds to  = 0, and the clockwise direction denotes the increment of ), and elevation   , which contain the true target position information (such as the true range   , azimuth   , and elevation   ), radar OBs (such as the range bias Δ  , the gain of range   which arise from (or in) atmospheric refraction [12], azimuth Δ  , and elevation Δ  .Polarity definitions of Δ  and Δ  are identical to  and , resp.),ABs of the gyrostabilized platform, and random MEs (such as the range error   , azimuth   , and elevation   ).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   represent the true rectangular coordinates of the target at the observation instance  in the platform frame, ENU frame, and ECEF frame, respectively [13], of the th sensor.The superscript "" 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.

Radar raw measurement
Usually, all OBs and random MEs are small in magnitudes, in order to simplify the development of registration equations below; X   () can be approximated by first-order Maclaurin series about OBs and random MEs as where According to the polarity definition of ABs and the rotation transformation order, the transition from the platform frame to ENU is given by [7] where T  2ENU denotes the rotation matrix from the platform frame to ENU, which is an orthogonal matrix; that is, 32  = sin (Δ  ) , (5i) Similarly, (5a) can be approximated by the first-order Maclaurin series about ABs as where I is a 3 × 3 identity matrix, and Substituting ( 2) and ( 6) into (4) and omitting the higher order terms, (4) can be expanded as 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 ", " the errors can be written as where   ,   , and   denote the errors caused by ABs in , , and  coordinates, respectively.Then, the equivalent range MEs caused by ABs can be expressed as [8] Δ  (Δ, Δ, Δ) = √ ( +   ) Substituting ( 9) into (10) and selecting ABs in (10) as variables, the first-order Maclaurin series expansion of (10) can be written as Δ  (Δ, Δ, Δ) = 0 +  (Δ, Δ, Δ) .
Similarly, the equivalent azimuth measurement error is The equivalent elevation measurement error is Since errors caused by ABs are equivalent to MEs, then TTCs in ENU frame can be written out directly without using rotation transformation as Substituting ( 11)-( 13) into (14a) and omitting time stamp "k" for brevity, (14a) produces The transition of TTCs from ENU to ECEF frame is given by Zhou et al. [14] as where X  denotes the th radar ECEF coordinates converted from its geographic coordinates, and T  is the rotation matrix.
Both variables are only correlated with radar geographic coordinates at time .Since substituting (14a) and ( 16) into (17), the first-order linearized registration model can be approximated in the form of where   = [  1 ,  2 ] denotes the state vector consisting of all OBs and ABs of both radars.w  = [w  1 ,w  2 ] is a column vector which contains both radars' measurement noises.

Observability Analysis
Assuming a constant bias registration model, for which the state equations can be described as 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 -step random OM can be written as [8] M (,  −  + 1) where {w()w  ()} = R() and {} denotes the expectation of "."  is a positive integer which is unrelated to .R() 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 () is a constant matrix then two of the column vectors in the coefficient matrix H () are proportional-US.
Proof.Without loss of generality, assuming that column vectors h 1 () and h 2 () ( =  −  + 1, . . ., ) are first and second column vectors in H (), respectively, and satisfy h 1 () /h 2 () = , where the proportionality factor  is a constant, then OM can be written as Assuming that m () = H  () CR −1 C  H () and k 1 () and k 2 () are the first and second row vectors in m (), respectively, then it is obvious that k 1 () /k 2 () =  as follows: that is, the first and second row vectors of OM M are proportional and the proportionality factor is .Then M = 0-US.
Condition 2. When C() or H() is time-varying then the system is observable or-OS.
Proof.In this case, m () = H  () C () R −1 C  () H () is an  ×  matrix, and the rank of m () is 3 because the rank of where the symbol [] denotes the nearest integer greater than or equal to , the rank of ∑  =−+1 m () is equal to , and OM M is positive definite-OS.Condition 3. When C () and the proportionality factor of two column vectors in H () 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 () is very big because two column vectors in H () 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 () 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 where   denotes the combined vector and w   denotes the remaining minor noises caused by the independent parts.

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 where According to above analyses, in (25) it is optimum to select 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 (  ) and is independent with TCs (  ,   ,   ).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 Δ  and   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 Δ   and Δ   are no longer constants; they are varying with different target locations.Equations ( 26) and ( 27) can be differentiated individually about the time argument as The subscript "" which identifies different radars and time stamp "" are omitted in (29a) and (30) for brevity.Assume that velocities of the target in , , and  directions in radar  ENU frame are mutually independent zero-mean Gaussian white noises whose standard deviations are  V  ,  V  , and  V  , respectively.According to (29a) and (30), (Δ  ) and (Δ  ) are zero-mean Gaussian random processes, whose covariance can be written out as where T denotes radar scanning period.Var {} denotes the variance of "." The cross covariance can be written as {} denotes the expectation of "." 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 where T  (), A  (), C  (), and w  () are completely the same as (2), and 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 where The covariance matrix of w  can be written as 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 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.

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 where Figure 4: The block diagram of URM.
Then just adding (43) to the corresponding terms of (38), URM can be applied to varying ABs situation.

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 ∘ , 116 ∘ , 10 m] and [40.75 ∘ , 115.34 ∘ , 10 m], 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 -coordinate (east), V  -velocity, -coordinate (north), V  -velocity, -coordinate (up), and V  -velocity, respectively.Same standard deviations of both ships' process noise are employed in , , and  coordinates by 0.1 m/s 2 , 0.1m/s 2 , and 0m/s 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 [60 km, −170 m/s, 30 km, 30 m/s, 5 km, 1 m/s].Standard deviations of the process noise in , , and  coordinates are set to 1 m/s 2 , 1 m/s 2 , and 0.1 m/s 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  Standard deviations of the random measurement noises for both radars are   = 50m and   =   = 0.5 ∘ , respectively.ABs of both platforms are assumed to be equal with the form of (40), where Δ  = Δ  = Δ  = 1 ∘ , and for all ABs,   is a linear increasing function with 1 ∘ /ℎ 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 intervals  = 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  URM , it is assumed that the maximum magnitudes are 2 ∘ for each attitude bias of both platforms, and the standard deviation for velocities in , , and  directions are [200,200,20] m/s, respectively.Figure 6   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.

Figure 1 :
Figure 1: The diagram of mobile radar installed on the gyrostabilized platform.
(a) shows the conversion process from the platform frame to ENU, where   ,   , and   denote , , and  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 -axis of the platform frame by the roll angle Δ, then rotating about the intermediate -axis by the pitch angle Δ, and rotating about the final -axis by the yaw angle Δ.Customarily, the polarity definitions of Δ and Δ abide by the left-hand rule, and Δ abides by the right-hand rule.

Figure 2 :
Figure 2: (a) Conversion from the platform frame to ENU and (b) measurement in platform frame.

Figure 3 :
Figure 3: The flow chart for MRR.

Figure 5 :
Figure 5: The geometry of radar and target.
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.