Used a Kalman filter to estimate the objects' 6dof
refactoring: coupled translation and rotation