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 robotic system comprising:
a robotic mechanism configured to support and manipulate a tool;
an image capture device configured to generate a captured image of the tool at a point-in-time; and
a processor configured to:
generate a three-dimensional computer model of the tool using a computer aided design technique;
receive information of the captured image of the tool;
determine an initial estimated position and orientation of the tool at the point-in-time from kinematic information provided at the point-in-time by one or more encoders coupled to the robotic mechanism;
project the three-dimensional computer model of the tool onto the captured image of the tool according to the initial estimated position and orientation of the tool at the point-in-time, so as to position and orient the three-dimensional computer model of the tool at the initial estimated position and orientation of the tool at the point-in-time in reference to the captured image; and
modify the position and orientation of the three-dimensional computer model of the tool, which is at the initial estimated position and orientation of the tool at the point-in-time, in reference to the captured image, until the three-dimensional computer model of the tool approximately overlays an image of the tool in the captured image, so as to generate a corrected estimated position and orientation of the tool at the point-in-time.
2. The robotic system according to claim 1 , wherein the processor is further configured to modify the position and orientation of the three-dimensional computer model of the tool with respect to the image of the tool in the captured image by minimizing a spatial difference between the three-dimensional computer model of the tool and the image of the tool.
3. The robotic system according to claim 1 , wherein the image capture device comprises a stereo endoscope.
4. The robotic system according to claim 1 , wherein the processor is further configured to:
extract a silhouette of the three-dimensional computer model of the tool;
extract edges of the image of the tool in the captured image; and
position and rotate the silhouette of the three-dimensional computer model of the tool until the silhouette of the three-dimensional computer model of the tool approximately overlays the edges of the image of the tool in the captured image.
5. The robotic system according to claim 4 , wherein the processor is further configured to:
remove lines in the silhouette of the three-dimensional 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 three-dimensional computer model of the tool until the silhouette of the three-dimensional computer model of the tool approximately overlays the edges of the image of the tool within the captured image.
6. The robotic system according to claim 4 , wherein the processor is further configured to position and rotate the silhouette of the three-dimensional computer model of the tool until the silhouette approximately overlays the edges of the image of the tool within the captured image, by: determining a spatial difference between the silhouette of the three-dimensional computer model of the tool and the image of the tool in the captured image; and positioning and rotating the silhouette of the three-dimensional computer model of the tool until the spatial difference is minimized.
7. The robotic system according to claim 6 , wherein the spatial difference to be minimized is indicated by a sum of absolute differences between edge pixels extracted from the tool image and their closest silhouette edges.
8. The robotic system according to claim 6 , wherein the view of the area where the tool is inserted is captured as a grid of pixels by at least one camera inserted in the area.
9. The robotic system according to claim 1 , wherein the image capture device is further configured to generate a subsequent captured image of the tool at a subsequent point-in-time; and
wherein the processor is further configured to:
receive information of the subsequent captured image of the tool;
project the three-dimensional computer model of the tool onto the subsequent captured image of the tool according to the corrected estimated position and orientation of the tool at the point-in-time, so as to position and orient the three-dimensional computer model of the tool at the corrected estimated position and orientation of the tool at the point-in-time in reference to the captured image; and
modify the position and orientation of the three-dimensional computer model of the tool, which is at the corrected estimated position and orientation of the tool at the point-in-time, in reference to the subsequent captured image, until the three-dimensional computer model of the tool approximately overlays an image of the tool in the subsequent captured image, so as to generate a second corrected estimated position and orientation of the tool at the subsequent point-in-time.