Objects motion estimation via BSP tree modeling and Kalman filtering of stereo images