Kozłowski, K. New Computational Algorithms for a Discrete Kalman Filter in Robot Dynamics. Eng. Trans. 1991, 39 (3-4), 325-349.