Ratcheting for master alignment of a teleoperated minimally-invasive surgical instrument
A teleoperated system includes a master grip and a ratcheting system coupled to the master grip. The ratcheting system is configured to align the master grip with a slave instrument commanded by the master grip by determining grip rotation values describing an orientation of the master grip, determining instrument rotation values describing an orientation of the instrument, determining an orientation error between an orientation of the master grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values, and reducing the orientation error by low pass filtering the grip rotation values or the instrument rotation values.
1. A teleoperated system comprising:
a master grip; and
a ratcheting system coupled to the master grip, the ratcheting system configured to align the master grip with an instrument commanded by the master grip by:
determining grip rotation values describing an orientation of the master grip;
determining instrument rotation values describing an orientation of the instrument;
determining an orientation error between the orientation of the master grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values; and
reducing the orientation error by low pass filtering the grip rotation values or the instrument rotation values, wherein a cutoff frequency for the low pass filtering is determined based on the orientation error.
2. The teleoperated system of claim 1 , wherein:
the grip rotation values comprise a grip rotation matrix; and
the instrument rotation values comprise an instrument rotation matrix.
3. The teleoperated system of claim 1 , wherein the orientation of the instrument is an orientation of a tip of the instrument.
4. The teleoperated system of claim 1 , wherein the ratcheting system determines the cutoff frequency for the low pass filtering according to a monotonic penalty profile and the orientation error.
5. The teleoperated system of claim 1 , wherein the cutoff frequency for the low pass filtering of the grip rotation values is a frequency lower than a frequency at which an operator can manipulate the master grip.
6. The teleoperated system of claim 1 , wherein the low pass filtering of the grip rotation values introduces a control system error in control of the instrument.
7. The teleoperated system of claim 1 wherein the ratcheting system bounds the orientation error to a value between zero degrees and 180 degrees inclusive.
8. The teleoperated system of claim 1 , wherein the ratcheting system further:
determines a grip orientation by which the master grip is gripped by an operator; and
determines the orientation error further based on the grip orientation;
wherein the grip orientation is a right-side-up grip orientation or an upside-down grip orientation.
9. The teleoperated system of claim 8 , wherein when the grip orientation is the upside-down grip orientation, the ratcheting system rotates a relative rotation matrix characterizing the orientation error before determining the orientation error.
10. A method of controlling a teleoperated system, the method comprising:
determining, by one or more processors of the teleoperated system, grip rotation values describing an orientation of a master grip;
determining, by the one or more processors, instrument rotation values describing an orientation of an instrument controlled by the master grip;
determining, by the one or more processors, an orientation error between the orientation of the master grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values; and
reducing, by the one or more processors, the orientation error by low pass filtering the grip rotation values or the instrument rotation values, wherein a cutoff frequency for the low pass filtering is determined based on the orientation error.
11. The method of claim 10 , wherein:
the grip rotation values comprise a grip rotation matrix; and
the instrument rotation values comprise an instrument rotation matrix.
12. The method of claim 10 , further comprising determining, by the one or more processors, the cutoff frequency for the low pass filtering according to a monotonic penalty profile and the orientation error.
13. The method of claim 10 , wherein the cutoff frequency for the low pass filtering of the grip rotation values is a frequency lower than a frequency at which an operator can manipulate the master grip.
14. The method of claim 10 , wherein the low pass filtering of the grip rotation values introduces a control system error in control of the instrument.
15. A non-transitory computer-readable medium comprising computer-readable code which when executed by one or more processors associated with a teleoperated system are adapted to cause the one or more processors to perform a method comprising:
determining grip rotation values describing an orientation of a master grip;
determining instrument rotation values describing an orientation of an instrument controlled by the master grip;
determining an orientation error between the orientation of the master grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values; and
reducing the orientation error by low pass filtering the grip rotation values or the instrument rotation values, wherein a cutoff frequency for the low pass filtering is determined based on the orientation error.
16. The non-transitory computer-readable medium of claim 15 , wherein:
the grip rotation values comprise a grip rotation matrix; and
the instrument rotation values comprise an instrument rotation matrix.
17. The non-transitory computer-readable medium of claim 15 , wherein:
the method further comprises determining the cutoff frequency for the low pass filtering of the grip rotation values according to a monotonic penalty profile and the orientation error; or
the cutoff frequency for the low pass filtering of the grip rotation values is a frequency lower than a frequency at which an operator may manipulate the master grip.