Methods and system for performing 3-D tool tracking by fusion of sensor and/or camera derived data during minimally invasive robotic surgery
Methods and system perform tool tracking during minimally invasive robotic surgery. Tool states are determined using triangulation techniques or a Bayesian filter from either or both non-endoscopically derived and endoscopically derived tool state information, or from either or both non-visually derived and visually derived tool state information. The non-endoscopically derived tool state information is derived from sensor data provided either by sensors associated with a mechanism for manipulating the tool, or sensors capable of detecting identifiable signals emanating or reflecting from the tool and indicative of its position, or external cameras viewing an end of the tool extending out of the body. The endoscopically derived tool state information is derived from image data provided by an endoscope inserted in the body so as to view the tool.
1. A tool tracking method for a surgical tool, the method comprising:
determining a computer model of a surgical tool;
after the determining of the computer model of the surgical tool, receiving a captured image including a view of the surgical tool;
determining an estimated position and orientation of the surgical tool from the captured image;
positioning and orienting the computer model of the surgical tool at the estimated position and orientation of the surgical tool in reference to the captured image including the view of the surgical tool; and
modifying the estimated position and orientation of the computer model of the surgical tool with respect to an image of the surgical tool in the captured image until the computer model of the surgical tool approximately overlays the image of the surgical tool so as to correct the estimated position and orientation of the surgical tool for the captured image.
2. The method according to claim 1 , wherein the modifying of the estimated position and orientation of the computer model of the surgical tool with respect to the image of the surgical tool in the captured image comprises:
determining a modified position and orientation of the computer model that approximately overlays the image of the surgical tool in the captured image by minimizing a difference between the computer model of the surgical tool and the image of the surgical tool.
3. The method according to claim 1 , wherein
the captured image including the view of the surgical tool is captured by a stereo endoscope inserted into an area in a body of a patient.
4. The method according to claim 1 , further comprising:
extracting a silhouette of the computer model of the surgical tool;
extracting edges of the image of the surgical tool in the captured image; and
positioning and rotating the silhouette of the computer model until the silhouette of the computer model approximately overlays the edges of the image of the surgical tool within the captured image.
5. The method according to claim 4 , further comprising:
removing lines in the silhouette of the computer model of the surgical tool corresponding to hidden lines in the image of the surgical tool in the captured image prior to positioning and rotating the silhouette of the computer model until the silhouette of the computer model approximately overlays the edges of the image of the surgical tool within the captured image.
6. A tool tracking method comprising:
determining a computer model of a tool;
extracting a silhouette of the computer model of the tool;
receiving a captured image of an area including a view of the tool;
extracting edges of an image of the tool in the captured image;
determining an estimated position and orientation of the tool from the captured image;
positioning and orienting the computer model of the tool at the estimated position and orientation of the tool in reference to the captured image including the view of the tool;
positioning and rotating the silhouette of the computer model until the silhouette of the computer model approximately overlays the edges of the image of the tool within the captured image by determining a difference between the silhouette of the computer model and the image of the tool in the captured image and positioning and rotating the silhouette of the computer model until the difference is minimized; and
modifying the estimated position and orientation of the computer model of the tool with respect to the image of the tool in the captured image until the computer model of the tool approximately overlays the image of the tool so as to correct the estimated position and orientation of the tool for the captured image.
7. The method according to claim 6 , wherein
the difference to be minimized is a sum of absolute differences between edge pixels extracted from the image of the tool and their closest silhouette edges.
8. The method according to claim 6 , wherein
the captured image of the area including the view of the tool is captured as a grid of pixels by at least one camera inserted in the area.
9. The method according to claim 6 , further comprising:
removing lines in the silhouette of the computer model of the tool corresponding to hidden lines in the image of the tool in the captured image prior to positioning and rotating the silhouette of the computer model until the silhouette of the computer model approximately overlays the edges of the image of the tool within the captured image.