The Nonsequential Fusion Method for Localization from Unscented Kalman Filter by Multistation Array Buoys Gou

Based on special features of array buoy and the research field of location and tracking of underwater target, the research combines the highly adaptive nonlinear filtering algorithmunscentedKalmanfilterwith the nonlinear programming ofmultistation array buoy positioning system. In accordance with the model of nonsequential target location, the research utilizes Unscented Transformation to update the measuring error and covariance matrix of state error, aiming at estimating the filtering of state variable and acquiring the object’s current state of motion.The research analyzes the positioning performance of algorithm, pursuit path, astringency, and other performance indexes of target-relevant parameter through numerical simulation experiment. From the result, the conclusion that multistation array buoy can complete the task of tracing target track very well can be reached, which provides theoretical foundation for putting the algorithm into engineering practice.


Introduction
Sonobuoy is a very important part in integrated aviation antisubmarine, which is mainly used in large-scale exploratory search of enemy submarine.Sonobuoy is small in size and can explore large-area maritime space in short time.Sonobuoys have low requirements for the installation objects: they can be carried in quantity by airplanes and be equipped in helicopter, seaplane, or other fixed wing aircraft.Sonobuoy floats on the ocean and is slightly influenced by the noise of its carrier.Therefore, sonobuoy obtains the best detection effect.
One of buoy's major tasks is the effective location and tracking of underwater target [1].Buoy's task is utilizing underwater sound sensors to conduct continuous measurement and estimation of targets' motion parameters such as orientation, speed, and course.
Traditional buoys mainly adopt liner array sensor to form wave beam in horizontal or vertical directions.Many buoys are arranged in the water to form geometric shape to explore underwater targets.The traditional method has low positioning accuracy and high requirements of relative location among buoys.The current randomness of buoys in the ocean current will influence the positioning accuracy and cause errors.
The new array buoy adopts plane array and can form wave beam in both horizontal and vertical directions, which improves the spatial gain and lower the working frequency.The combination of receiving array and buoy can greatly improve the noise detection of buoy system and obtain accurate measurement information.Theoretically, single array buoy can measure the location of target.However, because of the complexity and diversity of missions, the need of optimizing performance index of single array buoy cannot be satisfied.Therefore, researches begin to arrange multistation array buoys according to certain formations and integrate the data from multisensor nodes to locate the underwater targets accurately [2][3][4][5][6].Compared with detecting result of single-station array buoy, multistation array buoy is equipped with acoustic aperture, which can obtain more reliable and accurate estimation information.
The centralized structure of fusion model combines the measurement data coming from different sensors into the fusion center and then the fusion center will process all measurement data together.Because of the huge amount of data, the centralized structure has high requirements for the processing ability of central nodes.However, compared with distributed and multisensor system, the centralized structure has higher accuracy thanks to the unified disposal of original data.With the rapid development of central processing unit, the target estimation and tracking issue which is based on centralized multisensor system, as a basic question of the information fusion among multisensor, has received more and more attention from researches.
In the centralized real-time processing and fusion model of time series information, buoys will transmit the observation data of target signals which comes from respective buoys to fusion processing center.However, in the complicate transmission process in maritime channel, out-of-sequence measurements (OOSM) problems will occur due to transport delay.For example, for the same object, the measurements of earlier time come later than the measurements of later time.Out-of-sequence measurement will negatively influence the reliability and accuracy of multiplatform fusion system.In order to solve the problem of OOSM, Bar-Shalom et al. [7,8] put forward a series of suboptimal algorithms; the purpose is to use the out-of-sequence measurements for the current moment to update the target state, in order to obtain more accurate state estimation and its error covariance matrix.Zhou et al. [9] analyzed theoretically the optimality algorithm which is put forward by Bar-Shalom, point out that its optimality is associated with the discretization of process noise model, and propose an improved algorithm based on discrete time model, improving the accuracy of the filter.Bar-Shalom et al. [10] used the method of equivalent observation data in the original literature which extended one-step-lag OOSM to the multistep lag OOSM.The paper by Zhang et al. [11] was proposed based on the best linear unbiased estimation criterion of OOSM.Shen et al. [12] and Yu et al. [13] put forward solving the data fusion problem of multisensor OOSM based on one-step-lag OOSM.
In the real problem of tracking underwater target, Gaussian assumptions of the linear and noise of system model cannot be met.Therefore, the positioning and tracking issue of underwater target is a nonlinear system filter issue.Unscented Kalman filter (UKF) algorithm, based on Unscented Transformation (UT) and Kalman filter technology, selects some sampling points and approximates the mean value and variance through nonlinear variation.UKF not only makes nonlinear system filter reach high accuracy, but also adapts the noise very well.Therefore, UKF can be used to optimize the problem of OOSM filter fusion.When OOSM occurs, adopting OOSM algorithm which is based on UT to conduct current state estimation and update covariance will get a more accurate state estimation and its covariance.In order to improve the robustness during the operation of this algorithm, there appears square root unscented Kalman filtering algorithm.In order to add the nonlinear transformation of a noise distribution to a state estimation process, Wu et al. [14] give unscented Kalman filtering algorithm of a dimension expanding form.Simo [15,16] deduces a smoothing algorithm of unscented Kalman filtering algorithm.Directing at interactive target moving model, Babu et al. [17] and Xu and Han [18] introduce UKF into the trace analysis of a maneuvering target by a passive sonar.
This paper is organized as follows.We discuss the localization principle and UKF filtering algorithm by multiarray buoys in Sections 2 and 3. Section 4 derived the nonsequential fusion UKF algorithm.In Section 5, simulation results are briefly described, and Section 6 is a conclusion.

The Positioning Technology of Multistation Array Buoy
2.1.Geometric Model.The site location and system equipment of multiarray buoys are shown as Figure 1.Currently, as for the operational command of sonarmen, the measurement of targets' three-dimensional coordinate is finished through the cooperation of two-dimensional sonar and heightmeasurement sonar.Two-dimensional sonar can measure the location and distance of targets.Height-measurement sonar can conduct supplementary measurement of height, which is accurate, simple, easy to control, and low in cost.
In Figure 1, the positioning system of (T/R)  multistation array buoy consists of  single-station array buoys.T represents the transmitting station and R represents the receiving station

Positioning Principle.
The stations of (T/R)  multistation array buoy cooperate with each other; when measuring S(x, y) the target's direction, azimuth angle information ( 1 ,  2 ⋅ ⋅ ⋅   ) could be simply used for positioning.See Figure 2.
The system model takes the base line between two buoys as -axis, lets the midpoint be the origin of coordinates, and establishes a rectangular coordinate system.The positioning equation is solving (1) to acquire the target location, (2)

Positioning Error Analysis.
Under the assumed conditions, angle measuring errors of the two buoys and a station measuring error are   1 ,   2 , and   .To keep them constant, the positioning error equation ( 3) as shown below is differentiating from (2): wherein Equation ( 3) is written as a matrix form: solving (5) to acquire the error vector of the target location: The relationships between the target location error in the rectangular coordinate system (d, d), the angle measuring error (d 1 , d 2 ), and the station measuring errors (d 1 , d 1 ) and (d 2 , d 2 ) can be seen from (7).

The Geometric Interpretation of Positioning Precision.
Any positioning system has different positioning precisions for targets in different spatial positions, which means the positioning error of a target location is closely related to the geometrical relationship of the target relative to a positioning station.Positioning stations with different geometric distributions have different positioning errors for targets in the same spatial positions.Therefore, the relationship between positioning errors and the geometric distributions of positioning stations has to be studied.Meanwhile, under that condition that the geometric distributions of positioning stations have been determined, knowing the positioning errors distributions of this positioning system for different spatial positions is necessary for effectively using the positioning system and accurately positioning and tracking a target.
In order to describe the relationship between a positioning error and geometry and measuring the influence of a geometric position on positioning performance, a noun, "geometric dilution of precision" (short for GDOP), is defined and can be expressed in a two-dimensional surface as follows: Geometric dilution of precision describes the relationship between the positioning error and the base station geometric distribution participating in the positioning.It can become a standard studying the distribution regularities of positioning errors in different geometric distributions, and it can also become a reference for choosing the position of a base station when establishing a new buoy system.

The Filtering Algorithm Based on UKF
3.1.UT Transforming Principle.The traditional method [19] has low positioning accuracy and high requirements of relative location among buoys.The current randomness of buoys in the ocean current will influence the positioning accuracy and cause errors.
UKF is a filtering algorithm [20] combining UT (Unscented Transformation) and Kalman filtering technique.By specially selecting some Sigma sampling points and better approximating the mean and variance of random variables after nonlinear transformation, UKF can not only make the nonlinear system filter arrive at a higher precision, but also adapt well to a noise.
UKF filter firstly applies UT to a state equation and then estimates the filter by transformed state variables.UT is selecting some points in an original state distribution according to certain rules to make matrix and covariance of these points equal the mean and covariance of the original state distribution and to substitute these points into a nonlinear system function; thus acquire data points of a relevant nonlinear function; finally evaluate the transformed mean and covariance according to the point set.
Assume that there is an -dimension random vector  ∼ (, ); -dimension random vector  is one nonlinear function of ,  = (); the statistical property of  is (,   ); and the statistical property of , (,   ) is transmitted by a nonlinear function ().

Evaluating Points
wherein  =  2 ( + ) − ;  is the dimensionality of the state vector ; a scale parameter  determines the dispersion degree of points ; and  is usually a small positive number.
In order to ensure that the covariance matrix is a positively definite matrix,  is usually 0.  describes the distribution information of state  (if the distribution information of state  follows Gaussian distribution, the optimal value of  is 0).(√( + )  ) represents the line of Cholesky resolution. ()  ( = 0, 1, . . ., 2) and  ()  ( = 0, 1, . . ., 2) represent the weights of a first-order statistical property and a second-order statistical property, respectively.

Calculating the Results of Points 𝜎, 𝛾
( = 0, 1, . . ., ), Transmitted by (), and Acquiring (11).Consider UT is different from Monte Carlo method.The former is selecting a few points  from the given distribution based on the certain rules but not determining the points by random sampling.In addition, the UT is not a common method of weighting, so it is also not a sampling statistics.

UKF Filtering Algorithm. If using UT to replace the local linearization means in EKF algorithm, UKF filtering algorithm can be acquired. The equation of UKF filter is as follows:
(A) For a given state x−1|−1 and a covariance matrix  −1|−1 , it is easy to acquire a one-step predicted value x|−1 and a covariance matrix  |−1 for forecasting an error based on a target movement model: Calculating a measurement one-step prediction, a covariance of a measurement error, and a crosscovariance matrix between a state error and a measurement error after UT, that is, (C) After acquiring a new measurement value   , updating the filter, and acquiring the update value of the filter and the covariance matrix of an evaluated error, wherein   is a gain matrix of the filter.

Fusion Model.
A centralized fusion structure sends measurement values given by all the not fixed coding sensors after observing targets to a fusion center, and let a center processor uniformly process this measurement information.
In the information fusion center, the observation platforms of sensors are numbered consecutively combined with a sequential fusion idea.First, predict and update the state in the first sensor.To be clear that the first sensor is not a single sensor but refers to the first to be processing nodes and is not necessarily the same sensor in every processing time.Then input the updated result of the first sensor as the updated state of the second sensor and continue updating.Similarly, update the values of state estimation using the measurement values of many

Centralized fusion center
Motion target S M e a s u r e m e n t s ig n a l S e q u e n t i a l s i g n a l sensors and ensure that the updated sequence of the sensors would not affect the final result of fusion during the process of updating.The purpose is to ensure the precision of estimated results based on certain calculation complexity.As for out-ofsequence centralized fusion structure, see Figure 3.

Out-of-Sequence UKF Algorithm.
The state equation and measurement equation of underwater multistation buoy array of nonlinear system model can be expressed as follows: wherein  is the state transition function, ℎ is the measurement function,   ∼ (0,   ) is the process noise, and   ∼ (0,   ) is measurement noise and also is the innovation.Those two noises, irrelevant to each other, are zero mean gauss noises.When using UKF algorithm, first we need to define the extended state and the covariance matrix as according to formula (10) to get 2  + 1 sampling points   , and the weight allocation of sampling points  ()  .
By using UT conversion, information prediction equation can be acquired as formula (14).Defined   is information state contribution and   is the covariance matrix of   as wherein   is the Jacobian matrix,   is process noise covariance, and   is measurement noise covariance and   =   − ℎ(x |−1 ).Therefore information contribution value can be updated as On the condition of multistation buoy observation, the information contribution value of No.  ( = 1, 2, . . ., ) buoy is Therefore, we can acquire the integrated result of multistation array buoy as follows:

Numerical Simulation and Result Analysis
According to the principle that double-station array buoy uses angle information to conduct two-dimensional positioning described in Section 3.1, we carried out simulation to positioning performance of algorithm.The parameters when making simulation are the following: the target moves towards  direction ±20 km and towards  direction ±20 km, underwater sound velocity V  = 1.5 km/s, the coordinate of T/R station is (−7.5, 0) km, and  station is (7.5, 0) km, angulation errors    = 1.5 mrad,    = 1.5 mrad, stations measuring error   = 15m, Monte-Carlo: 500 times.We can get two-dimensional positioning error graph and threedimensional GDOP graph, as shown in Figures 4 and 5, respectively.
From the two abovementioned graphs, we can see that when positioning using double-station array buoy, the distribution of positioning error is as follows: the whole graph is a regular butterfly in shape, comprising three areas: baseline area (two array buoy connection parts), wide board area (the extended part outside the baseline), and side board area (the extended part with two stations as vertex).The positioning precision in the baseline area is worse; the wide board area has the typical feature of bistatic sonar system with balanced error distribution; GDOP isoline extends outside from the baseline with slowly decreased precision, covering most of areas; side board area is the worst area in positioning precision.Based on the analysis on abovementioned positioning and UKF filtering step described in Section 3.2, we conducted numerical simulation to the tracking effect of double-station array buoy.The parameters of simulation are as follows: acoustic velocity: 1500 m/s, sampling interval: 1 s, simulation length sampling for 1000 times, buoy direction-finding error of mean square deviation: 5 /180, frequency measurement error of mean square deviation: 0.1 Hz, target initial position: (−2500, 4500), velocity: 10 m/s, course: 3/4, and frequency: 1000 Hz, and the mean square deviations of the disturbance noises from velocity, course, and frequency are all defined as 0.1.Figures 6 and 8 show the simulation results of the simulation matrix of determinant, in which the doublestation and four-station array buoys are vertical to the target course.Figures 7 and 9 show the estimation astringency curves of relevant parameters including velocity, frequency, and course.In order to obtain the data about the changes of target frequency over time, we use short-time Fourier transform method to estimate frequency.For each FFT, transform the lengths of 256 sampling points with 50% overlapping ratio and 1024 algorithm length.
After obtaining FFT of each interval, select the largest frequency point as the measured frequency of the interval.Conduct smooth filtering to the calculated frequency signal using 32-pecking-order-number of FIR low-pass filter with 100 Hz low pass cut-off frequency.From Figures 6 and 9, we can see that the proposed algorithm in this paper can track the target trajectory well and parameters such as target speed, frequency, and course can be converged efficiently.Contrasting Figures 7 and 9, the number of iterations decreased from 500 to 200.The results show that multistation array buoy can effectively improve the computation efficiency.
In industry application, the cost of dropping buoy is one of the factors we must take into consideration.Therefore, it is reasonable to balance the accuracy requirements and computation time is very necessary.

Figure 6 :
Figure 6: Schematic diagram of a single simulation tracking.

Figure 8 :
Figure 8: Schematic diagram of a single simulation tracking.