Kozłowski, K. “New Computational Algorithms for a Discrete Kalman Filter in Robot Dynamics”. Engineering Transactions, vol. 39, no. 3-4, Dec. 1991, pp. 325-49, http://et.ippt.gov.pl/index.php/et/article/view/1630.