Improved noise covariance estimation in visual servoing using an autocovariance least-squares approach
File(s)CAMS_ALS_2019_Short.pdf (1.4 MB)
Accepted version
Author(s)
Brown, Jasper
Su, Daobilige
Kong, He
Sukkarieh, Salah
Kerrigan, Eric
Type
Conference Paper
Abstract
For pose estimation in visual servoing, by assuming the relative motion over one sample period to be constant, many existing works adopt a linear time invariant (LTI) dynamic model. Since the standard feature point transformation is nonlinear, extended Kalman filtering (EKF) has become popular due to its simplicity. Thus, the problem at hand becomes filtering of an LTI system with a time-varying output matrix. To obtain satisfactory performance, accurate knowledge of the noise covariances is essential. Various methods have been proposed on how to adaptively update their values to improve performance. However, these techniques cannot guarantee the positive semidefiniteness (PSD) of the covariance estimates. In this paper, we propose to apply the autocovariance least-squares (ALS) approach to covariance identification in pose estimation. The ALS approach can provide reliable estimates of the covariance matrices while maintaining their PSD and imposing desired structural constraints. Our tests show that using the covariance estimates from the ALS method in EKF can reduce the average pose estimation error by more than 30% in simulation, and the average position estimation error by about 30% using experimental data, respectively, compared to a hand-tuned EKF.
Date Issued
2019-11-26
Date Acceptance
2019-06-25
Citation
IFAC-PapersOnLine, 2019, 52 (22), pp.37-42
ISSN
2405-8963
Publisher
Elsevier
Start Page
37
End Page
42
Journal / Book Title
IFAC-PapersOnLine
Volume
52
Issue
22
Copyright Statement
© 2019, IFAC (International Federation of Automatic Control) Hosting by Elsevier Ltd.
Source
Joint 12th IFAC Conference on Control Applications in Marine Systems, Robotics, and Vehicles 1st IFAC Workshop on Robot Control
Subjects
visual servoing
pose estimation
Kalman filtering
noise covariance identification
MOTION
Publication Status
Published
Start Date
2019-09-18
Finish Date
2019-09-20
Coverage Spatial
Daejeon, Korea
Date Publish Online
2019-11-26