Adaptive Trajectory Estimation with Power Limited Steering Model under Perturbation Compensation

Trajectory estimation of maneuvering objects is applied in numerous tasks like navigation, path planning and visual tracking. Many previous works get impressive results in the strictly controlled condition with accurate prior statistics and dedicated dynamic model for certain object. But in challenging conditions without dedicated dynamic model and precise prior statistics, the performance of these methods significantly declines. To solve the problem, a dynamic model called the power-limited steering model (PLS) is proposed to describe the motion of non-cooperative object. It is a natural combination of instantaneous power and instantaneous angular velocity, which relies on the nonlinearity instead of the state switching probability to achieve switching of states. And the renormalization group is introduced to compensate the nonlinear effect of perturbation in PLS model. For robust and efficient trajectory estimation, an adaptive trajectory estimation (AdaTE) algorithm is proposed. By updating the statistics and truncation time online, it corrects the estimation error caused by biased prior statistics and observation drift, while reducing the computational complexity lower than O(n). The experiment of trajectory estimation demonstrates the convergence of AdaTE, and the better robust to the biased prior statistics and the observation drift compared with EKF, UKF and sparse MAP. Other experiments demonstrate through slight modification, AdaTE can also be applied to local navigation in random obstacle environment, and trajectory optimization in visual tracking.

[1]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[2]  S MaybeckP,et al.  Investigation of constant turn-rate dynamics models in filters for airborne vehicle tracking. , 1982 .

[3]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[4]  Jorge Nocedal,et al.  On the limited memory BFGS method for large scale optimization , 1989, Math. Program..

[5]  R. Berg Estimation and prediction for maneuvering target trajectories , 1983 .

[6]  Frank Dellaert,et al.  iSAM: Incremental Smoothing and Mapping , 2008, IEEE Transactions on Robotics.

[7]  Wolfram Burgard,et al.  A Tutorial on Graph-Based SLAM , 2010, IEEE Intelligent Transportation Systems Magazine.

[8]  Changsheng Xu,et al.  Multi-task Correlation Particle Filter for Robust Object Tracking , 2017, 2017 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[9]  Tor Arne Johansen,et al.  The eXogenous Kalman Filter (XKF) , 2017, Int. J. Control.

[10]  Levente Kovács,et al.  Controller Design Solutions for Long Distance Telesurgical Applications , 2011 .

[11]  Y. Bar-Shalom,et al.  State estimation for systems with sojourn-time-dependent Markov model switching , 1991 .

[12]  Visakan Kadirkamanathan,et al.  Unscented Rauch-Tung-Striebel smoothing for nonlinear descriptor systems , 2015, 2015 European Control Conference (ECC).

[13]  Jianke Zhu,et al.  A Scale Adaptive Kernel Correlation Filter Tracker with Feature Integration , 2014, ECCV Workshops.

[14]  R. Singer Estimating Optimal Tracking Filter Performance for Manned Maneuvering Targets , 1970, IEEE Transactions on Aerospace and Electronic Systems.

[15]  Frank Dellaert,et al.  Incremental smoothing and mapping , 2008 .

[16]  Matsuo Yoshiki,et al.  Real-time cooperative collision avoidance method of multiple mobile robots , 2004 .

[17]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[18]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[19]  Byeong-Seok Shin,et al.  A shortest path planning algorithm for cloud computing environment based on multi-access point topology analysis for complex indoor spaces , 2016, The Journal of Supercomputing.

[20]  R. Zwanzig Nonequilibrium statistical mechanics , 2001, Physics Subject Headings (PhySH).

[21]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[22]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[23]  Luc Van Gool,et al.  An adaptive color-based particle filter , 2003, Image Vis. Comput..

[24]  Ralph S. Bryan Cooperative Estimation of Targets by Multiple Aircraft , 1980 .

[25]  Byron Boots,et al.  Incremental sparse GP regression for continuous-time trajectory estimation and mapping , 2017, Robotics Auton. Syst..

[26]  Xiaogang Yang,et al.  Online maximum likelihood filtering for aircraft tracking under low accuracy observations , 2017, 2017 Chinese Automation Congress (CAC).

[27]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[28]  P. Moral Nonlinear filtering : Interacting particle resolution , 1997 .

[29]  Scott A. Bortoff,et al.  Path planning for UAVs , 2000, Proceedings of the 2000 American Control Conference. ACC (IEEE Cat. No.00CH36334).

[30]  George K. I. Mann,et al.  Developing a Cubature Multi-state Constraint Kalman Filter for Visual-Inertial Navigation System , 2017, 2017 14th Conference on Computer and Robot Vision (CRV).

[31]  Kyu Ho Park,et al.  A fast path planning by path graph optimization , 2003, IEEE Trans. Syst. Man Cybern. Part A.

[32]  Mattia Zorzi,et al.  Robust Kalman Filtering Under Model Perturbations , 2015, IEEE Transactions on Automatic Control.

[33]  Giuseppe Carlo Calafiore,et al.  Planar Pose Graph Optimization: Duality, Optimal Solutions, and Verification , 2016, IEEE Transactions on Robotics.

[34]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[35]  Levente Kovács,et al.  Models for force control in telesurgical robot systems , 2015 .

[36]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[37]  C. Striebel,et al.  On the maximum likelihood estimates for linear dynamic systems , 1965 .

[38]  Jiangtao Xi,et al.  Reduced-complexity Krylov subspace methods for large-scale MIMO channel estimation , 2018, Digit. Signal Process..

[39]  Tor Arne Johansen,et al.  Nonlinear filtering with exogenous Kalman filter and double Kalman filter , 2016, 2016 European Control Conference (ECC).

[40]  Xi Liu,et al.  > Replace This Line with Your Paper Identification Number (double-click Here to Edit) < , 2022 .

[41]  Daniel Cremers,et al.  LSD-SLAM: Large-Scale Direct Monocular SLAM , 2014, ECCV.

[42]  Michael Felsberg,et al.  Discriminative Scale Space Tracking , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[43]  Danilo P. Mandic,et al.  A generalized normalized gradient descent algorithm , 2004, IEEE Signal Processing Letters.

[44]  Fredrik Gustafsson,et al.  On Resampling Algorithms for Particle Filters , 2006, 2006 IEEE Nonlinear Statistical Signal Processing Workshop.

[45]  Guoliang Fan,et al.  Generative Model for Maneuvering Target Tracking , 2010, IEEE Transactions on Aerospace and Electronic Systems.

[46]  X. R. Li,et al.  Survey of maneuvering target tracking. Part I. Dynamic models , 2003 .