System and method for rapid halt and recovery of motion deviations in repositionable arms
A computer-assisted device includes a first repositionable arm configured to support a first end effector, a second repositionable arm configured to support a second end effector, and a control unit. The control unit configured to monitor an actual motion of at least one structure selected from the group consisting of the first repositionable arm and the first end effector; determine a deviation between the actual motion and a desired motion of the at least one structure; and in response to determining that the deviation is greater than a deviation threshold, select whether to halt motion of the first repositionable arm and the first end effector or the second repositionable arm and the second end effector based on a mode of operation of the first repositionable arm the first end effector, the second repositionable arm, or a mode of operation of the second end effector.
1. A computer-assisted device comprising:
a first repositionable arm, the first repositionable arm configured to support a first end effector;
a second repositionable arm, the second repositionable arm configured to support a second end effector; and
a control unit communicably coupled to the first repositionable arm and the second repositionable arm, wherein the control unit is configured to:
monitor an actual motion of at least one structure selected from the group consisting of the first repositionable arm and the first end effector;
determine a deviation between the actual motion of the at least one structure and a desired motion of the at least one structure; and
in response to determining that the deviation is greater than a deviation threshold:
select whether to halt motion of the first repositionable arm and the first end effector or to halt motion of the second repositionable arm and the second end effector based on at least one mode of operation selected from the group consisting of: a mode of operation of the first repositionable arm, a mode of operation of the first end effector, a mode of operation of the second repositionable arm, and a mode of operation of the second end effector; and
halt, based on the selection, motion of the first repositionable arm and the first end effector or motion of the second repositionable arm and the second end effector.
2. The computer-assisted device of claim 1 , wherein the mode of operation of the first end effector or the first repositionable arm is selected from the group consisting of: an autonomous motion mode, a semi-autonomous motion mode, a null space motion mode, an instrument removal mode, and a fixed pose mode including holding the first end effector at a fixed pose.
3. The computer-assisted device of claim 1 , wherein the mode of operation of the computer-assisted device comprises a teleoperated mode.
4. The computer-assisted device of claim 1 , wherein to monitor the actual motion of the at least one structure, the control unit is configured to determine a position of a point of interest associated with the at least one structure.
5. The computer-assisted device of claim 1 , wherein to determine the deviation, the control unit is configured to:
determine, for each kinematic or dynamic value in a plurality of kinematic or dynamic values associated with the at least one structure, a difference between an actual value and a corresponding desired value to generate a combined set of variation values; and
determine, from the combined set of variation values, the deviation.
6. The computer-assisted device of claim 1 , wherein:
the deviation comprises a deviation in a plurality of kinematic or dynamic values associated with the at least one structure;
the deviation threshold comprises a vector or matrix of threshold elements; and
to determine that the deviation is greater than the deviation threshold, the control unit is configured to determine that:
a first value of the plurality of kinematic or dynamic values is greater than a corresponding threshold element in the vector or matrix of threshold elements; or
a weighted combination of the plurality of kinematic or dynamic values is greater than a weighted combination of the threshold elements in the vector or matrix of threshold elements.
7. The computer-assisted device of claim 6 , wherein first weights for position and rotation values in the plurality of kinematic or dynamic values is higher than second weights for velocity, force, or torque values in the plurality of kinematic or dynamic values.
8. The computer-assisted device of claim 1 , further comprising:
an input device;
wherein the control unit is further configured to receive a command from the input device indicating the desired motion of the at least one structure.
9. The computer-assisted device of claim 1 , wherein the control unit is further configured to determine the deviation threshold based on a type of the desired motion or at least one mode of operation selected from the group consisting of: a mode of operation of the first end effector and a mode of operation of the computer-assisted device.
10. The computer-assisted device of claim 1 , wherein the control unit is further configured to determine the deviation threshold so that the deviation threshold is larger than deviations between the actual motion of the at least one structure and the desired motion of the at least one structure due to one or more of calibration errors, manufacturing variations in the at least one structure, vibrations in the at least one structure, or motions of a patient on which a procedure is being performed using the computer-assisted device.
11. The computer-assisted device of claim 1 , wherein the desired motion of the at least one structure is no motion of the at least one structure.
12. The computer-assisted device of claim 1 , wherein the control unit is further configured to clear a condition that caused the deviation to be greater than the deviation threshold.
13. A method comprising:
monitoring, by a control unit of a computer-assisted device, an actual motion of at least one structure, the at least one structure selected from the group consisting of: a first repositionable arm of the computer-assisted device and a first end effector configured to be supported by the first repositionable arm;
determining, by the control unit, a deviation between the actual motion of the at least one structure and a desired motion of the at least one structure; and
in response to determining that the deviation is greater than a deviation threshold:
selecting whether to halt motion of the first repositionable arm and the first end effector or to halt motion of a second repositionable arm of the computer-assisted device and a second end effector configured to be supported by the second repositionable arm based on at least one mode of operation selected from the group consisting of: a mode of operation of the first repositionable arm, a mode of operation of the first end effector, a mode of operation of the second repositionable arm, and a mode of operation of the second end effector; and
halting, based on the selecting, motion of the first repositionable arm and the first end effector or motion of the second repositionable arm and the second end effector.
14. The method of claim 13 , wherein the mode of operation of the first end effector or the first repositionable arm is selected from the group consisting of: an autonomous motion mode, a semi-autonomous motion mode, a null space motion mode, an instrument removal mode, and a fixed pose mode including holding the first end effector at a fixed pose.
15. The method of claim 13 , wherein monitoring the actual motion of the at least one structure comprises determining a position of a point of interest associated with the at least one structure.
16. The method of claim 13 , wherein determining the deviation comprises:
determining, for each kinematic or dynamic value in a plurality of kinematic or dynamic values associated with the at least one structure, a difference between an actual value and a corresponding desired value to generate a combined set of variation values; and
determining, from the combined set of variation values, the deviation.
17. The method of claim 13 , further comprising receiving a command from an input device, the command indicating the desired motion of the at least one structure.
18. The method of claim 13 , further comprising determining the deviation threshold based on a type of the desired motion or at least one mode of operation selected from the group consisting of: a mode of operation of the first end effector and a mode of operation of the computer-assisted device.
19. The method of claim 13 , further comprising providing an alert to an operator indicating which of the first repositionable arm and the first end effector or the second repositionable arm and the second end effector has been halted to the deviation being greater than the deviation threshold.
20. A non-transitory machine-readable medium comprising a plurality of machine-readable instructions which when executed by one or more processors associated with a computer-assisted device are adapted to cause the one or more processors to perform a method comprising:
monitoring an actual motion of at least one structure, the at least one structure selected from the group consisting of: a first repositionable arm of the computer-assisted device and a first end effector configured to be supported by the first repositionable arm;
determining a deviation between the actual motion of the at least one structure and a desired motion of the at least one structure; and
in response to determining that the deviation is greater than a deviation threshold:
selecting whether to halt motion of the first repositionable arm and the first end effector or to halt motion of a second repositionable arm of the computer-assisted device and a second end effector configured to be supported by the second repositionable arm based on at least one mode of operation selected from the group consisting of: a mode of operation of the first repositionable arm, a mode of operation of the first end effector, a mode of operation of the second repositionable arm, and a mode of operation of the second end effector; and
halting, based on the selecting, motion of the first repositionable arm and the first end effector or motion of the second repositionable arm and the second end effector.