Body SLAM
Minimally invasive surgery (MIS) has been shown to reduce patient trauma and shorten hospitalization stays, but when operating through a small incision, a surgeon loses the “bird’s eye view” of the operation that he or she is accustomed to with open surgery. A recent approach to surgical guidance, called image-guidance, combines tool tracking with patient specific rendered organ models to display a detailed computer generated 3D rendered visualization that the surgeon can rotate the 3D rendered models on the computer screen to gain a better spatial understanding of where the tool or robot is located with respect to an anatomical target (see above). Current image-guidance systems are limited to only specific surgeries, can be inaccurate, and do not convey all available information. The goal of our Medical SLAM project is to improve the accuracy and efficacy of IGS through the adoption of mobile robot simultaneous localization and mapping (SLAM) algorithms to the medical field. SLAM is the problem of estimating an environment map with a mobile robot while simultaneously estimating the pose of the robot in the incrementally constructed map. The advantages of using SLAM for surgery are 1) the potential improvement in accuracy, 2) the estimation of dynamic information, and 3) the inference of deformation and stiffness.
Another sub-topic of our Medical SLAM project is constrained filtering for registering a tool to the surface models. The registration problem involves aligning the coordinate frame of the tool to the coordinate frame of a preoperative surface model. Conventionally, to register a surgical tool to medical images, the iterative closest point (ICP) algorithm is used. This works by touching the tool to many locations on the surface of an anatomical structure and then aligning the resulting point cloud with a point cloud extracted from the preoperative models.
We have developed a novel method for registration using constrained Kalman filtering. The technique we introduced estimates parameters for the registration problem with a Kalman filter. When the uncertainty of the Kalman filter reduces to a small region, the registration problem is solved. The filter gains information by recognizing when the tool/robot is in an infeasible state. To incorporate this information, we have developed a new method for constrained filtering called uncertainty projection. We have been able to demonstrate the feasibility of our constrained filtering approach with data collected from an experiment involving a surgical robot navigating on the epicardial surface of a porcine heart (see above).
Papers
- Using Lie Algebra to estimate the shape of medical snake robots. In the proceedings of the 27th IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Chicago, USA, September 2014
- Constrained Filtering with Contact Detection Data for the Localization and Registration of Continuum Robots in Flexible Environments . Proc. 2012 IEEE International Conference on Robotics and Automation (ICRA), May, 2012.
- Inequality Constrained Kalman Filtering for the Localization and Registration of a Surgical Robot. Proc. 2011 IEEE International Conference on Intelligent Robots and Systems (IROS), Sept, 2011.
