- About this Journal
- Abstracting and Indexing
- Aims and Scope
- Annual Issues
- Article Processing Charges
- Articles in Press
- Author Guidelines
- Bibliographic Information
- Citations to this Journal
- Contact Information
- Editorial Board
- Editorial Workflow
- Free eTOC Alerts
- Publication Ethics
- Reviewers Acknowledgment
- Submit a Manuscript
- Subscription Information
- Table of Contents
Abstract and Applied Analysis
Volume 2014 (2014), Article ID 127643, 6 pages
A Filtering Algorithm for Maneuvering Target Tracking Based on Smoothing Spline Fitting
1College of Information Science and Technology, Dalian Maritime University, Dalian 116026, China
2Department of Engineering, Faculty of Technology and Science, University of Agder, 4898 Grimstad, Norway
Received 15 October 2013; Revised 14 December 2013; Accepted 20 December 2013; Published 6 February 2014
Academic Editor: Zexu Zhang
Copyright © 2014 Yunfeng Liu et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.
Maneuvering target tracking is a challenge. Target’s sudden speed or direction changing would make the common filtering tracker divergence. To improve the accuracy of maneuvering target tracking, we propose a tracking algorithm based on spline fitting. Curve fitting, based on historical point trace, reflects the mobility information. The innovation of this paper is assuming that there is no dynamic motion model, and prediction is only based on the curve fitting over the measured data. Monte Carlo simulation results show that, when sea targets are maneuvering, the proposed algorithm has better accuracy than the conventional Kalman filter algorithm and the interactive multiple model filtering algorithm, maintaining simple structure and small amount of storage.
In modern society, radar plays an increasingly important role, where the sea target detection and tracking is a very important aspect and has great practical value. Low-speed objects such as sea ice and others bring great danger to the ship sailing on the sea, and the performance of sea target detection directly affects the safety of navigation. Tracking is an important part of radar system. Especially the maneuvering target tracking is more complex in clutter environment.
In conventional target tracking, the most common method is the standard Kalman filter algorithm . When the target state and observation equations are linear equations and the observation noise is Gaussian white noise, the Kalman filter algorithm is the optimal algorithm in the sense of minimum variance. When the target maneuver occurs, Kalman filtering accuracy will be reduced or even diverged due to the model mismatch and noise characteristics that cannot be known exactly. In view of the limitations of the Kalman filter algorithm, the multimodel filtering algorithm [2–8] and the adaptive Kalman filter algorithm [9–12] emerged. The multiple-model algorithm is the algorithm using the weighted sum of multiple models to approximate the actual motion model of the target. Subsequently, the interacting multiple model algorithm emerged [5, 6]. It is the fusion result of multimodel by updating probability of models. It has better performance than multimodel filtering algorithm.
During maneuvering, target maneuver has still regularity which is reflected in the measured values and cannot be properly represented by the Kalman filter algorithm. Therefore, this paper proposes a filtering algorithm based on the smoothing spline fitting. The proposed algorithm fits through the measured values reflecting the movement regularity. The difference between the proposed algorithm and the standard Kalman filter algorithm is that the latter calculates estimations through the sum of the predicted values and the measured values weighted and the former algorithm fits values individually from the measured values to determine the estimations.
The paper is organized as follows. In Section 2, Kalman filter algorithm is proposed. In Sections 3 and 4, interacting multiple model algorithm and spline fitting filtering algorithm are introduced, respectively. In Section 5, simulation results are given to illustrate the effectiveness of the proposed algorithms. Finally, concluding remarks are provided in Section 6.
2. Kalman Filtering (KF) Algorithm
The Kalman filtering (KF) flowchart is shown in Figure 1.
As can be seen from Figure 1, the weighted predicted values and the weighted measured values determine the estimate value of the KF; the predicted value is generated from the motion model. However, a single model cannot meet all the maneuvering of the target; the covariance plays a link between the model and the weighting. When filtering, the weighting of the measured value tends to be a constant value and contribution to the estimate becomes smaller. So the KF algorithm cannot escape from the shackles of a single model.
Application of the KF algorithm to real-time problem depends on a priori knowledge of the mean square error of the state and the observation process . Moreover the optimal estimation of covariance matrix for the state and observation processes does not exist. In order to solve this problem, some research proposed suboptimal solutions, they estimate one or more parameters of mean variance matrix of the state and the observe process [14–16], or estimate the gain adaptively [17, 18]. Also, the authors [19, 20] proposed algorithms with the divergence criterion and forgetting factor preventing filter divergence, but the divergence criterion cannot reflect filter divergence exactly.
The KF algorithm uses a single model which cannot meet every maneuver, only suitable for the steady situation. When the model does not suit the motion model, the gain coefficient or the covariance will be adjusted to remedy the motion model. These methods do not get rid of the computing framework of the Kalman system, nothing more than a feedback loop .
3. Interacting Multiple Model (IMM) Algorithm
The IMM algorithm has become a standard tool for maneuvering target tracking [5, 6, 22]. It has a recursive algorithm structure, which using finite state model represents the entire system to try to solve the problem of a single target motion model mismatch. The IMM approximates nonlinear systems by finite linear model and estimates the system state by the sum of weighted estimation of models. The IMM requires models to represent the entire state of the system, usually this is difficult to achieve.
While maneuvering occurs, the accuracy of the IMM is superior to the KF. However, the shortcomings of the IMM are more models more calculation, the competition between models. All of these affect performance of the IMM. The IMM has multiple models to remedy the motion model when the model does not suit the motion model. The similarity of the standard Kalman filter algorithm and the IMM algorithm is using motion model to predict movement position; filtering results are decided by the weighted values of predicted and measured. When maneuvering, the measured values reflect better regularity of motion, but the weight of the measured values does not increase more in both algorithms.
The IMM flowchart is shown in Figure 2.
Where represents the output estimate of time , represents the measurement data of time , represents the possibility vector of model , represents the model probability vector, represents transition probability for model to model , represents state estimate of model at time , and is the result of the interaction of .
As can be seen from Figure 2, IMM algorithm has four steps.
Step 1 (input interact). At time , set state estimation and covariance matrix value are and , .
After the interaction, at time , the input of filter is where
Step 2 (filtering predict). The first step result is the model input at time . We get the output from KF filter as follows:
Step 3 (probability update). Update probability of model as follows: where
Step 4 (data fusion). The interact outputs, at time , will be obtained, respectively, after getting output and probability of every model:
where is the state covariance.
Then we perform the first interactive multiple model algorithm recursive process.
4. Spline Fitting Filtering (SFF) Algorithm
The KF algorithm requires the system model to be linear, which greatly limits the scope of application of the KF algorithm. The IMM increases the number of model to close the motion model. And predicted and measured weighted values decide the estimate values in both algorithms. When the target maneuver occurs, the predicted value cannot immediately react because both algorithms did not accurately and rapidly adjust the weight of the measured values. However, the measured values can give faster and more sensitive response. To improve on this, the paper proposes, in the filtering process, the measured value that contains the true information of the motion. The measured value reflects the regularity of target maneuvering more promptly than the predicted value, and the regularity reflects from a certain smoothing of the curve. Therefore, the estimated value of the filter should be closely linked to the measured value. When sea targets maneuver, they still have regularity of motion despite the measurement errors and systematic errors. The cubic spline is used to approximate the mathematical model of targets maneuvering, and the smoothing spline function reflects the regularity of maneuvering. Therefore, the novel point of SFF is the using of spline function to reflect sea targets maneuvering, abandonment of the motion model. The advantage of SFF can be seen in Figures 4 and 5. The SFF is closer to the true value than the KF and IMM. When the target maneuver occurs, the error of the SFF is the smallest one in three algorithms.
Assumed measured point , here is a cubic spline function. The problem is to find a function that minimizes where , represent the horizontal and vertical coordinates of the measured value, respectively, represents the number of nodes, represents the second derivative of , is a smoothing parameter, and . When , is a spline function to fit the data in the least squares sense; when , is the cubic spline interpolation. Formula (7) is a least-squares problem, where the first term quantifies the error between the measured data points and the model . The second term imposes a smoothness constraint on the solution. In practice, we set for better reflecting the regularity of maneuvering by smoothing spline curve.
The SFF algorithm is as follows: suppose the measured value is .
First, mean the measured values . Second, the filtering estimate results are fitted by the spline function from filtered measured values. So the cycle continues. Taking into account the experimental results and the complexity of the algorithm, three points are used for the spline fitting.
The SFF flowchart is shown in Figure 3.
5. Simulation Results
The simulation environment is Intel CPU 2.53 GHz, 1 GB Memory, and MATLAB R2009b. Assume sea target departures at coordinates (8000 m and 8000 m):(1)0–49 s, the target uniform linear motion (30 m/s at -axis direction, 40 m/s at axis direction);(2)50–90 s, the target turning movement at the turn rate 3°/s, 50 m/s speed;(3)91–119 s, the target uniform linear motion at 50 m/s speed;(4)120–160 s, the target turning movement at the turn rate 3°/s, 50 m/s speed;(5)161–210 s, the target uniform linear motion at 50 m/s speed.
As can be seen from Figure 4, the KF motion model meets the target motion model during the uniform linear motion and filtering results converge; as other periods, the filtering results of the KF will increase errors or divergence. The reason is the weight of the measured values is much smaller that cannot influence the filtering results. The filtering results determined by the weighted sum of the prediction values and the measured values. As the target maneuvers, the algorithm model mismatches the uniform linear motion model, and the predictive value is still the main content of the filtering value. It cannot keep up with the change of motion, which leads to increasing error and even divergence. For the same set of data, the IMM has three corresponding models.
The filtering result of the IMM is better than the KF during the turning movement, but the filter effect of the IMM is reduced or even diverged as the IMM model mismatch. The SFF filtering effects is the same with the IMM. When the target maneuvers, the SFF is superior to the former algorithms.
As can be seen from Figure 5(a), the filtering trajectory of the SFF is closer to the true value than the KF and IMM; when the target maneuver occurs, the average error of the SFF is smaller than that of the KF and IMM as can be seen from Figure 5(b); from Figure 5(c), there is a large fluctuation of standard deviation for the KF and IMM as target motion, while the standard deviation of the SFF has small change.
When selecting the type of steering ratio, the conclusion is consistent and uniform.
In the three algorithms, the KF is optimal in uniform linear motion when its model meets the motion model. On the other movement, the accuracy of the SFF is better than the accuracy of the KF and IMM because the impact of the measured value of the SFF is more prominent in filtering and measurements reflect the movement regularity in time.
The paper proposed a target tracking filtering algorithm based on spline function fitting the measured value. For the same set of data, the estimation error of the proposed algorithm compares with the estimation error of KF algorithm and IMM algorithm. Monte Carlo results clearly show that the SFF has higher estimation accuracy. Particularly it has obvious advantages to the standard Kalman filter algorithm and maintains a simple structure and small amount of storage.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
The author likes to thank Professor Jidong Suo and Professor Xiaoming Liu for their useful support throughout this work. The authors are grateful to their collaborators for their constructive comments on the paper.
- R. Kalman, “A new approach to linear filtering and prediction problems,” Journal of Basic Engineering, vol. 82, pp. 35–45, 1960.
- D. T. Magill, “Optimal adaptive estimation of sampled stochastic processes,” IEEE Transactions on Automatic Control, vol. 10, no. 4, pp. 434–439, 1965.
- D. G. Lainiotis, “Optimal adaptive estimation: structure and parameter adaptation,” IEEE Transactions on Automatic Control, vol. 16, no. 2, pp. 160–170, 1971.
- H. Blom, “An efficient filter for abruptly changing systems,” in Proceedings of the 23rd IEEE Conference on Decision and Control, pp. 656–658, 1984.
- H. A. P. Blom and Y. Bar-Shalom, “Interacting multiple model algorithm for systems with Markovian switching coefficients,” IEEE Transactions on Automatic Control, vol. 33, no. 8, pp. 780–783, 1988.
- E. Mazor, A. Averbuch, Y. Bar-Shalom, and J. Dayan, “Interacting multiple model methods in target tracking: a survey,” IEEE Transactions on Aerospace and Electronic Systems, vol. 34, no. 1, pp. 103–123, 1998.
- X. R. Li, “Multiple-model estimation with variable structure: some theoretical considerations,” in Proceedings of the 33rd IEEE Conference on Decision and Control, pp. 1199–1204, December 1994.
- Y. Wan, S. Y. Wang, and X. Qin, “IMM iterated extended particle filter algorithm,” Mathematical Problems in Engineering, vol. 2013, Article ID 970158, 8 pages, 2013.
- R. E. Kalman and R. S. Bucy, “New results in linear filtering and prediction theory,” Journal of Basic Engineering, vol. 83, pp. 95–108, 1961.
- S. Sage and G. Husa, “Adaptive filtering with unkown prior statistics,” in Proceedings of the Joint Automatic Control Conference, pp. 760–769, 1969.
- R. K. Mehra, “Approaches to adaptive filtering,” IEEE Transactions on Automatic Control, vol. 17, no. 5, pp. 693–698, 1972.
- X. Kan, H. S. Shu, and Y. Che, “Asymptotic parameter estimation for a class of linear stochastic systems using Kelman-Bucy filtering,” Mathematical Problems in Engineering, vol. 2012, Article ID 342705, 15 pages, 2012.
- Z. Ma, “Spacecraft attitude determination by adaptive Kalman filtering,” in Proceedings of the 23rd Chinese Control Conference, pp. 255–259, 2004.
- L. Weiss, “A survey of discrete Kalman-Bucy filtering with unknown noise covariance,” in Proceedings of the Control and Flight Mechanics Conference, pp. 17–19, 1970.
- E. Lichtfuss, Non-GPS Navigation Using Vision-Aiding and Active Radio Range Measurements, Department of the Air Force Air University, Air Force Institute of Technology, Wright-Patterson Air Force Base, Wright-Patterson, Ohio, USA, 2011.
- W. Su, C. Huang, P. Liu, and M. Ma, “Application of adaptive Kalman filter technique in initial alignment of inertial navigation system,” Journal of Chinese Inertial Technology, vol. 18, no. 1, pp. 44–47, 2010.
- H. Fu, Y. Wu, and T. Lou, “Adaptive unscented incremental filter method,” Journal of Aerospace Power, vol. 28, no. 2, pp. 259–263, 2013.
- K. W. Chiang, C. Lin, and K. Y. Peng, “The performance analysis of an AKF based tightly coupled INS/GNSS sensor fusion scheme with non-holonomic constraints for land vehicular applications,” Innovation for Applied Science and Technology, vol. 284–287, pp. 1956–1960, 2012.
- Q. Liu and L. Chen, “A new compensation method for filtering divergence caused by model errors,” Command Control and Simulation, vol. 34, no. 3, pp. 95–101, 2012.
- S. Xu, X. Lin, and D. Zhao, “Strong tracking SRCKF and its application in vessel dynamic positioning,” Chinese Journal of Scientific Instrument, vol. 34, no. 6, pp. 1266–1272, 2013.
- J. Wang, H. Shui, and H. Ma, “Implementation framework of filters in Kalman structure,” Journal of Data Acquisition and Processing, vol. 24, no. 1, pp. 61–66, 2009.
- X. R. Li and V. P. Jilkov, “Survey of maneuvering target tracking—part V: multiple-model methods,” IEEE Transactions on Aerospace and Electronic Systems, vol. 41, no. 4, pp. 1255–1321, 2005.