Dynamic Augmented Kalman Filtering for Human Motion Tracking under Occlusion Using Multiple 3D Sensors

In this paper real-time human motion tracking using multiple 3D sensors has been demonstrated in a relatively large industrial robot work cell. The proposed solution extends state-of-the-art by augmenting the constant velocity model and Kalman filter with low-pass filtered velocity states. The presented method is able to handle occlusions by dynamically inclusion in the Kalman filter of only those 3D sensors which provide valid human position data. Human motion tracking was achieved at a frame rate of 20 Hz, with a typical delay of 50 ms to 100 ms and an estimation accuracy of typically 0.10 m to 0.15 m.