Filter3D: Kalman filter documentation