We’re sorry, something doesn't seem to be working properly.
Please try refreshing the page. If that doesn't work, please contact support so we can address the problem.
Abstract
Problem
Intraoperative tracking of surgical instruments is an inevitable task of computer-assisted surgery. An optical tracking system often fails to precisely reconstruct the dynamic location and pose of a surgical tool due to the acquisition noise and measurement variance. Embedding a Kalman filter (KF) or any of its extensions such as extended and unscented Kalman filters (EKF and UKF) with the optical tracker resolves this issue by reducing the estimation variance and regularizing the temporal behavior. However, the current KF implementations are computationally burdensome and hence takes long execution time which hinders real-time surgical tracking.
Aim
This paper introduces a fast and computationally efficient implementation of linear KF to improve the measurement accuracy of an optical tracking system with high temporal resolution.
Methods
Instead of the surgical tool as a whole, our KF framework tracks each individual fiducial mounted on it using a Newtonian model. In addition to simulated dataset, we validate our technique against real data obtained from a high frame-rate commercial optical tracking system. We also perform experiments wherein a diffusive material (such as a drop of blood) blocks one of the fiducials and show that KF can substantially reduce the tracking error.
Results
The proposed KF framework substantially stabilizes the tracking behavior in all of our experiments and reduces the mean-squared error (MSE) by a factor of 26.84, from the order of\(10^{-1}\) to\(10^{-2}\) mm\(^{2}\). In addition, it exhibits a similar performance to UKF, but with a much smaller computational complexity.
This is a preview of subscription content,log in via an institution to check access.
Access this article
Subscribe and save
- Get 10 units per month
- Download Article/Chapter or eBook
- 1 Unit = 1 Article or 1 Chapter
- Cancel anytime
Buy Now
Price includes VAT (Japan)
Instant access to the full article PDF.
Similar content being viewed by others
References
Aissa BC, Fatima C (2017) Neural networks trained with Levenberg-Marquardt-iterated extended Kalman filter for mobile robot trajectory tracking. J Eng Sci Technol Rev 10(4):191–198
Arun KS, Huang TS, Blostein SD (1987) Least-squares fitting of two 3-d point sets. IEEE Trans Pattern Anal Mach Intell 5:698–700
Chowdhary G, Jategaonkar R (2010) Aerodynamic parameter estimation from flight data applying extended and unscented Kalman filter. Aerosp Sci Technol 14(2):106–117
Dai JS (2015) Euler-Rodrigues formula variations, quaternion conjugation and intrinsic connections. Mech Mach Theory 92:144–152
Dorfmüller-Ulhaas, K (2007) Robust optical user motion tracking using a kalman filter
Elfring R, de la Fuente M, Radermacher K (2010) Assessment of optical localizer accuracy for computer aided surgery systems. Comput Aided Surg 15(1–3):1–12
Enayati N, De Momi E, Ferrigno G (2015) A quaternion-based unscented Kalman filter for robust optical/inertial motion tracking in computer-assisted surgery. IEEE Trans Instrum Meas 64(8):2291–2301
Hartmann, G., Huang, F., Klette, R (2013) Landmark initialization for unscented kalman filter sensor fusion for mo-nocular camera localization
Jazwinski AH (1970) Stochastic process and filtering theory. Academic Press, A subsidiary of Harcourt Brace Jovanovich Publishers, San Diego
Joukhadar A, Hanna DK, Al-Izam EA (2020) Ukf-based image filtering and 3d reconstruction. In: Machine vision and navigation, pp. 267–289. Springer
Julier SJ, Uhlmann JK (1997) New extension of the Kalman filter to nonlinear systems. In: Signal processing, sensor fusion, and target recognition VI, vol 3068, pp 182–193. International Society for Optics and Photonics
Kraft E (2003) A quaternion-based unscented Kalman filter for orientation tracking. In: Proceedings of the sixth international conference of information fusion, vol 1, pp 47–54. IEEE Cairns, Queensland, Australia
Li L, Wang T, Xia Y, Zhou N (2020) Trajectory tracking control for wheeled mobile robots based on nonlinear disturbance observer with extended Kalman filter. J Franklin Inst 357(13):8491–8507
Ma T, Song Z, Xiang Z, Dai JS (2019) Trajectory tracking control for flexible-joint robot based on extended Kalman filter and PD control. Front Neurorobot 13:25
Mkhoyan T, de Visser CC, De Breuker R (2021) Adaptive state estimation and real-time tracking of aeroelastic wings with augmented kalman filter and kernelized correlation filter. In: AIAA Scitech 2021 Forum
Moore T, Stouch D (2016) A generalized extended kalman filter implementation for the robot operating system. In: Intelligent autonomous systems vol 13, pp 335–348. Springer
Pham DT, Verron J, Roubaud MC (1998) A singular evolutive extended kalman filter for data assimilation in oceanography. J Mar Syst 16(3–4):323–340
Prevost CG, Desbiens A, Gagnon E (2007) Extended Kalman filter for state estimation and trajectory prediction of a moving object detected by an unmanned aerial vehicle. In: 2007 American control conference, pp 1805–1810. IEEE
Singh RR, Godse MJ, Biradar TD (2013) Video object tracking using particle filtering. Int J Eng Res Technol 2(9):2987–2993
Vaccarella A, De Momi E, Enquobahrie A, Ferrigno G (2013) Unscented Kalman filter based sensor fusion for robust optical and electromagnetic tracking in surgical navigation. IEEE Trans Instrum Meas 62(7):2067–2081
VanDyke MC, Schwartz JL, Hall CD (2004) Unscented Kalman filtering for spacecraft attitude state and parameter estimation. Adv Astronaut Sci 118(1):217–228
Welch G, Bishop G (1995) An introduction to the Kalman filter
Xu Z, Yang SX, Gadsden SA (2020) Enhanced bioinspired backstepping control for a mobile robot with unscented Kalman filter. IEEE Access 8:125899–125908
Acknowledgements
The authors acknowledge funding from Natural Science and Engineering Research Council of Canada (NSERC).
Author information
Md Ashikuzzaman and Noushin Jafarpisheh have equal contribution, order of appearance is determined by flipping a coin.
Authors and Affiliations
Department of Electrical and Computer Engineering, Concordia University, 1455 boul. De Maisonneuve O, Montreal Quebec, H3G 1M8, Canada
Md Ashikuzzaman, Noushin Jafarpisheh & Hassan Rivaz
Advanced Products, THINK Surgical, 5th Floor - 1275 Avenue Des Canadiens de Montreal, Montreal, Quebec, H3B 0G4, Canada
Sunil Rottoo & Pierre Brisson
- Md Ashikuzzaman
You can also search for this author inPubMed Google Scholar
- Noushin Jafarpisheh
You can also search for this author inPubMed Google Scholar
- Sunil Rottoo
You can also search for this author inPubMed Google Scholar
- Pierre Brisson
You can also search for this author inPubMed Google Scholar
- Hassan Rivaz
You can also search for this author inPubMed Google Scholar
Corresponding author
Correspondence toMd Ashikuzzaman.
Ethics declarations
Conflict of interest
Md Ashikuzzaman, Noushin Jafarpisheh, Sunil Rottoo, Pierre Brisson and Hassan Rivaz declare that they have no conflict of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Ashikuzzaman, M., Jafarpisheh, N., Rottoo, S.et al. Fast and robust localization of surgical array using Kalman filter.Int J CARS16, 829–837 (2021). https://doi.org/10.1007/s11548-021-02378-1
Received:
Accepted:
Published:
Issue Date:
Share this article
Anyone you share the following link with will be able to read this content:
Sorry, a shareable link is not currently available for this article.
Provided by the Springer Nature SharedIt content-sharing initiative