IP Library Granted Patent US 12,364,553
Granted Patent B2
US 12,364,553 · App. 18/373,695 · Granted Jul 22, 2025

Estimation of a position and orientation of a frame used in controlling movement of a tool

Inventors: Tao Zhao (Sunnyvale, CA); Giuseppe Maria Prisco (Sunnyvale, CA); John Ryan Steger (Sunnyvale, CA); David Q. Larkin (Sunnyvale, CA)
Assignee: Intuitive Surgical Operations, Inc.
A61B34/30A61B34/37A61B90/361B25J9/1689B25J9/1697A61B2034/2065
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 12,364,553
App. No.
18/373,695
Granted
Jul 22, 2025
Kind
B2
Abstract

A system includes a control means for receiving an input from a user, a manipulator means configured to support a tool having a tool frame, and processing means configured to perform a method. The method involves receiving, from an image capturing system with an image frame, one or more images. The tool is visible in the one or more images. The method further involves determining an estimated frame transform based on the one or more images. The estimated frame transform is used in defining an unknown frame transform between the image frame and the tool frame. The method also involves determining, in response to the input received at the control means, an output movement for the tool based on the estimated frame transform, and causing movement of the tool based on the output movement.

Claims (68)

1. A system comprising:

a control means for receiving an input from a user;

a manipulator means configured to support a tool having a tool frame; and

processing means configured to perform a method comprising:

receiving, from an image capturing system with an image frame, one or more images, wherein the tool is visible in the one or more images,

determining an estimated frame transform based on the one or more images, wherein the estimated frame transform is used in defining an unknown frame transform between the image frame and the tool frame,

determining, in response to the input received at the control means, an output movement for the tool based on the estimated frame transform, and

causing movement of the tool based on the output movement.

2. The system of claim 1 , wherein determining the estimated frame transform based on the one or more images comprises:

determining whether to perform a vision measurement on an image of the one or more images; and

in response to determining to perform the vision measurement, using the image of the one or more images in determining the estimated frame transform.

3. The system of claim 1 , wherein determining the output movement for the tool comprises:

temporally smoothing the estimated frame transform.

4. The system of claim 1 , wherein determining the estimated frame transform comprises:

determining an image-to-tool frame relationship between the image frame and the tool frame based on the one or more images; and

computing the estimated frame transform based on the image-to-tool frame relationship.

5. The system of claim 4 , wherein determining the image-to-tool frame relationship further comprises:

identifying pose-indicating points of the tool in the one or more images; and

determining the image-to-tool frame relationship using the pose-indicating points.

6. The system of claim 4 , wherein determining the image-to-tool frame relationship comprises:

determining point pairs derived from a single time instant.

7. The system of claim 4 , wherein determining the image-to-tool frame relationship comprises:

determining point pairs derived from a number of time instants.

8. The system of claim 1 , wherein the method further comprises:

specifying a sequence of frames from the image frame to the tool frame, the sequence of frames including the image frame, the tool frame, and one or more additional frames between the image frame and the tool frame; and

specifying a plurality of frame transforms, each frame transform of the plurality of frame transforms corresponding to a pair of frames of the sequence of frames, the plurality of frame transforms including the unknown frame transform.

9. The system of claim 8 ,

wherein at least one parameter of the unknown frame transform is known, and

wherein determining the estimated frame transform comprises: estimating an unknown parameter of the unknown frame transform.

10. The system of claim 8 ,

wherein the plurality of frame transforms further comprises one or more known frame transforms, and

wherein determining the output movement for the tool comprises: using the one or more known frame transforms in addition to the estimated frame transform.

11. The system of claim 8 , further comprising:

a display means viewable by an operator and associated with an eye frame;

wherein the control means corresponds to a master frame; and

wherein determining the output movement for the tool in response to the input at the control means comprises:

determining a master-to-tool transform by: using the estimated frame transform and one or more known frame transforms of the plurality of frame transforms, and aligning a master-to-eye transform with a tool-to-image transform, wherein the master-to-eye transform transforms points in the master frame to corresponding points in the eye frame, and wherein the tool-to-image transform transforming points in the tool frame to corresponding points in the image frame, and

using the master-to-tool transform to determine the output movement in response to the input.

12. The system of claim 8 , wherein the sequence of frames comprises:

a sequence of frames from the image frame to a fixed frame; and

a second sequence of frames from the fixed frame to the tool frame.

13. The system of claim 8 ,

wherein the plurality of frame transforms comprises a second unknown frame transform; and

wherein the method further comprises: determining a second estimated frame transform for the second unknown frame transform, using the estimated frame transform and one or more known frame transforms of the plurality of frame transforms; and

wherein determining the output movement for the tool in response to the input at the control means comprises: using the second estimated frame transform in addition to the estimated frame transform.

14. A method for operating a system comprising a control means and a manipulator means configured to support a tool having a tool frame, the method comprising:

receiving one or more images captured by an image-capturing system, the image-capturing system having an image frame, wherein the tool is visible in the one or more images;

determining an estimated frame transform based on information in the one or more images, wherein the estimated frame transform is used in defining an unknown frame transform between the image frame and the tool frame;

determining, in response to an input at the control means, an output movement for the tool based on the estimated frame transform; and

causing movement of the tool based on the output movement.

15. The method of claim 14 , wherein determining the estimated frame transform based on the one or more images comprises:

determining whether to perform a vision measurement on an image of the one or more images; and

in response to determining to perform the vision measurement, using the image of the one or more images in determining the estimated frame transform.

16. The method of claim 14 , wherein determining the output movement for the tool comprises:

temporally smoothing the estimated frame transform.

17. The method of claim 14 , wherein determining the estimated frame transform comprises:

determining an image-to-tool frame relationship between the image frame and the tool frame based on the one or more images; and

computing the estimated frame transform based on the image-to-tool frame relationship.

18. A non-transitory machine-readable medium comprising a plurality of machine-readable instructions that, when executed by a processing means associated with a system comprising a control means and a manipulator means configured to support a tool having a tool frame, causes the processing means to perform a method comprising:

receiving one or more images captured by an image-capturing system, the image-capturing system having an image frame, wherein the tool is visible in the one or more images;

determining an estimated frame transform based on information in the one or more images, wherein the estimated frame transform is used in defining an unknown frame transform between the image frame and the tool frame;

determining, in response to an input at the control means, an output movement for the tool based on the estimated frame transform; and

causing movement of the tool based on the output movement.

19. The non-transitory machine-readable medium of claim 18 , wherein determining the estimated frame transform based on the one or more images comprises:

determining whether to perform a vision measurement on an image of the one or more images; and

in response to determining to perform the vision measurement, using the image of the one or more images in determining the estimated frame transform.

20. The non-transitory machine-readable medium of claim 19 , wherein determining the output movement for the tool comprises:

temporally smoothing the estimated frame transform.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Oct 27, 2023
From: ZHAO, TAO; PRISCO, GIUSEPPE MARIA; STEGER, JOHN RYAN; LARKIN, DAVID Q.
To: INTUITIVE SURGICAL OPERATIONS, INC.
Reel/Frame 065373/0337 →
Continuity (7)
Continuation 17677866 · Feb 22, 2022
Continuation 16779564 · Jan 31, 2020
Continuation 15719275 · Sep 28, 2017
Continuation 14997257 · Jan 15, 2016
Continuation 13360380 · Jan 27, 2012
Provisional Application 61485706 · May 13, 2011
Related Publication 20240016556A1 · Jan 18, 2024
References Cited (70)
US 5053975A · Tsuchihashi et al. · 1991 [cited by applicant]
US 5631973A · Green · 1997 [cited by applicant]
US 5859934A · Green · 1999 [cited by applicant]
US 6236896B1 · Watanabe et al. · 2001 [cited by applicant]
US 6394998B1 · Wallace et al. · 2002 [cited by applicant]
US 6424885B1 · Niemeyer et al. · 2002 [cited by applicant]
US 6493608B1 · Niemeyer · 2002 [cited by applicant]
US 6799065B1 · Niemeyer · 2004 [cited by applicant]
US 6936042B2 · Wallace et al. · 2005 [cited by applicant]
US 7736356B2 · Cooper et al. · 2010 [cited by applicant]
US 7780651B2 · Madhani et al. · 2010 [cited by applicant]
US 8000890B2 · Litvin et al. · 2011 [cited by applicant]
US 8419717B2 · Diolaiti et al. · 2013 [cited by applicant]
US 8971597B2 · Zhao et al. · 2015 [cited by applicant]
US 9259289B2 · Zhao et al. · 2016 [cited by applicant]
US 9827057B2 · Zhao et al. · 2017 [cited by applicant]
US 9984437B2 · Thienphrapa et al. · 2018 [cited by applicant]
US 10582974B2 · Zhao et al. · 2020 [cited by applicant]
US 11284952B2 · Zhao et al. · 2022 [cited by applicant]
US 20030004610A1 · Niemeyer · 2003 [cited by examiner]
US 20050027397A1 · Niemeyer · 2005 [cited by applicant]
US 20050107808A1 · Evans · 2005 [cited by examiner]
US 20060258938A1 · Hoffman et al. · 2006 [cited by applicant]
US 20090033655A1 · Boca et al. · 2009 [cited by applicant]
US 20090088897A1 · Zhao et al. · 2009 [cited by applicant]
US 20090326556A1 · Diolaiti et al. · 2009 [cited by applicant]
US 20100168562A1 · Zhao et al. · 2010 [cited by applicant]
US 20100168763A1 · Zhao et al. · 2010 [cited by applicant]
US 20110071543A1 · Prisco et al. · 2011 [cited by applicant]
US 20110113852A1 · Prisco · 2011 [cited by applicant]
US 20110201885A1 · Okamura et al. · 2011 [cited by applicant]
US 20130063580A1 · Ogawa et al. · 2013 [cited by applicant]
US 20130226197A1 · Diolaiti et al. · 2013 [cited by applicant]
US 20210045839A1 · Kralicky · 2021 [cited by applicant]
US 20220175475A1 · Zhao et al. · 2022 [cited by applicant]
EP 2277441A1 · 2011 [cited by applicant]
JP H07504363A · 1995 [cited by applicant]
JP H07311610A · 1995 [cited by applicant]
JP H09128549A · 1997 [cited by applicant]
JP H1097311A · 1998 [cited by applicant]
JP H1190868A · 1999 [cited by applicant]
WO WO2006124388A1 · 2006 [cited by applicant]
WO WO2010048160A2 · 2010 [cited by applicant]
WO WO2010048164A2 · 2010 [cited by applicant]
WO WO2012158458A2 · 2012 [cited by applicant]
Advisory Action mailed May 26, 2015 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 3 pages. [cited by applicant]
Craig, John J., “Introduction to Robotics Mechanics and Control,” 2nd Edition, Addison-Wesley Publishing Company, Inc., 1986; Chap. 2, “Spatial Descriptions and Transformations”, 57 pages. [cited by applicant]
Extended European Search Report for Application No. 20120785315, mailed on Jan. 29, 2015, 6 pages. [cited by applicant]
Extended European Search Report for Application No. EP18179651.7, mailed on Sep. 25, 2018, 6 pages. [cited by applicant]
Final Office Action mailed Jun. 3, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 13 pages. [cited by applicant]
Final Office Action mailed Mar. 17, 2015 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 12 pages. [cited by applicant]
International Preliminary Report on Patentability for Application No. PCT/US2012/037310, mailed on Nov. 28, 2013, 6 pages. [cited by applicant]
International Search Report and Written Opinion for Application No. PCT/US2012/037310, mailed on Nov. 14, 2012, 10 pages. [cited by applicant]
Non-Final Office Action mailed May 1, 2019 for U.S. Appl. No. 15/719,275, filed Sep. 28, 2017, 13 pages. [cited by applicant]
Non-Final Office Action mailed Jul. 2, 2021 for U.S. Appl. No. 16/779,564, filed Jan. 31, 2020, 12 pages. [cited by applicant]
Non-Final Office Action mailed Feb. 11, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 12 pages. [cited by applicant]
Non-Final Office Action mailed Oct. 30, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 12 pages. [cited by applicant]
Notice of Allowance mailed Jul. 6, 2017 for U.S. Appl. No. 14/997,257, filed Jan. 15, 2016, 5 pages. [cited by applicant]
Notice of Allowance mailed Oct. 6, 2015 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 5 pages. [cited by applicant]
Office Action mailed Jul. 2, 2015 for Chinese Application No. 201280023715.8 filed May 10, 2012, 32 pages. [cited by applicant]
Office Action mailed Jan. 5, 2016 for Japanese Application No. 20140510464 filed May 10, 2012, 8 pages. [cited by applicant]
Office Action mailed Jan. 7, 2014 for European Application No. 12785315.8 filed May 10, 2012, 3 pages. [cited by applicant]
Office Action mailed Feb. 17, 2015 for European Application No. 12785315.8 filed May 10, 2012, 1 page. [cited by applicant]
Response filed May 9, 2014 to Non-Final Office Action mailed Feb. 11, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 14 pages. [cited by applicant]
Response filed Jul. 17, 2015 to Final Office Action mailed Mar. 17, 2015 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 13 pages. [cited by applicant]
Response filed May 18, 2015 to Final Office Action mailed Mar. 17, 2015 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 20 pages. [cited by applicant]
Response filed Aug. 22, 2014 to Final Office Action mailed Jun. 3, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012, 13 pages. [cited by applicant]
Response filed Jan. 30, 2015 to Non-Final Office Action mailed Oct. 30, 2014 for U.S. Appl. No. 13/360,380, filed Jan. 27, 2012. 17 pages. [cited by applicant]
Shiu Y. C., et al., “Pose Determination of Cylinders, Cones, and Spheres from Perspective Projections,” Applications of Artificial Intelligence X: Machine Vision and Robotics, 1992, SPIE, vol. 1708, pp. 771-782. [cited by applicant]
Vertut, J., and Coiffet, P., “Robot Technology: Teleoperation and Robotics Evolution and Development,” English translation, Prentice-Hall, Inc., Inglewood Cliffs, NJ, USA 1986, vol. 3A, 332 pages. [cited by applicant]