A fast dynamic pose estimation method for vision-based trajectory tracking control of industrial robots

Abstract

Vision-based robotic trajectory tracking control is considered a promising technology. However, the slow sampling rate and latency of the vision sensor enormously limit the tracking performance. To conquer the issues, this paper proposes a dual-space error-state Kalman filter (DS-ESKF). By combining the encoder measurement with the vision measurement, the end-effector’s pose between adjacent vision measurements is restored, and the pose estimation cycle is synchronized with the control cycle. The critical distinguishing of DS-ESKF is that the encoder-driven error-state kinematics for the industrial robot is reconstructed. The experimental results on the Staubli TX60 industrial robot show that compared with the existing dual-rate Kalman filters (DR-KF), DS-ESKF can reduce estimation errors by about 50 % and have robust estimation performance. By applying the trajectory tracking control scheme combining DS-ESKF with a simple PID controller to Staubli TX60, the tracking accuracy is significantly improved (±0.11 mm for position and ± 0.05°for orientation).