Robotic manipulator force determination
Certain aspects relate to systems and techniques for detection of undesirable forces on one or more surgical robotic arms. In one aspect, there is provided a system including a robotic arm, including: two linkages, a joint, a torque sensor, and an instrument device manipulator (IDM). The system may further include a processor configured to measure a first torque value at the joint based on an output of the torque sensor and determine a second torque value at the joint based on a position of the robotic arm. The second torque value may be indicative of a gravitational component of the torque between the two linkages. The processor may be further configured to determine a force at the IDM based a difference between the first and second torque values and determine whether the robotic arm has collided with an object or misaligned based on the force at the IDM.
1. A robotic system, comprising:
a first robotic manipulator comprising:
at least one joint; and
an instrument driver configured to drive a first medical instrument within a patient;
one or more processors; and
data storage storing computer-executable instructions configured to cause the one or more processors to:
determine a first force experienced by the first robotic manipulator while the first robotic manipulator is advanced along a first axis;
determine that a component of the first force is in a plane perpendicular to the first axis;
determine that the component of the first force in the plane perpendicular to the first axis is greater than a threshold; and
determine that the first robotic manipulator has collided with an object based at least in part on said determination that the component of the first force is greater than the threshold.
2. The robotic system of claim 1 , wherein:
the instructions are further configured to cause the one or more processors to determine position data that indicates positions of each of a plurality of linkages coupled to one or more of the at least one joint; and
said determining that the first robotic manipulator has collided with the object is based at least in part on the position data.
3. The robotic system of claim 2 , further comprising an encoder formed on one of the at least one joint, wherein the instructions are further configured to cause the one or more processors to determine the position data based at least in part on feedback from the encoder.
4. The robotic system of claim 2 , wherein the instructions are further configured to cause the one or more processors to cause a user notification of collision to be provided in response to said determining that the first robotic manipulator has collided with the object.
5. The robotic system of claim 1 , further comprising a second robotic manipulator comprising:
at least one second joint; and
a second instrument driver configured to drive a second medical instrument.
6. The robotic system of claim 5 , wherein:
the instructions are further configured to cause the one or more processors to:
determine a second force associated with the second robotic manipulator; and
determine that the second force is greater than the threshold; and
said determining that the first robotic manipulator has collided with the object is based at least in part on said determination that the second force is greater than the threshold.
7. A robotic system, comprising:
a first robotic manipulator comprising:
at least one joint;
an instrument driver configured to drive a first medical instrument within a patient; and
first torque sensing means configured to generate signals indicative of a first force experienced by the at least one joint of the first robotic manipulator when the instrument driver of the first robotic manipulator is advanced along a first axis, the first force being in a direction of misalignment that is perpendicular to the first axis;
a second robotic manipulator comprising second torque sensing means configured to generate signals indicative of a second force experienced by the second robotic manipulator, the second force being perpendicular to the first axis;
one or more processors; and
data storage storing computer-executable instructions configured to cause the one or more processors to:
determine that the first force and the second force are both greater than a predetermined threshold; and
determine that the first medical instrument is misaligned with a second medical instrument based at least in part on the determination that the first force and the second force are greater than the predetermined threshold.
8. The robotic system of claim 7 , wherein the first torque sensing means comprises one or more torque sensors associated with one or more of the at least one joint of the first robotic manipulator.
9. The robotic system of claim 7 , wherein the instructions are further configured to cause the one or more processors to:
determine that the first medical instrument is being driven through the second medical instrument;
wherein said determination that the first medical instrument is misaligned with the second medical instrument is based at least in part on the determination that the first medical instrument is being driven through the second medical instrument.
10. The robotic system of claim 7 , wherein the instructions are further configured to cause the one or more processors to:
determine an adjusted first force by removing a first component of the first force that is due to gravity; and
determine an adjusted second force by removing a second component of the second force that is due to gravity;
wherein said determination that the first medical instrument is misaligned with the second medical instrument is based at least in part on the adjusted first force and the adjusted second force.
11. The robotic system of claim 7 , wherein the instructions are further configured to cause the one or more processors to:
determine that the first and second forces are not indicative of a collision;
wherein said determining that the first medical instrument is misaligned with the second medical instrument is at least partially in response to said determining that the first and second forces are not indicative of a collision.
12. The robotic system of claim 11 , wherein said determining that the first and second forces are not indicative of a collision involves determining that at least one of the first force or the second force is less than a second threshold.
13. The robotic system of claim 7 , wherein:
the instructions are further configured to determine that the first force and the second force are in opposing directions; and
said determination that the first medical instrument is misaligned with a second medical instrument is based at least in part on the determination that the first force and the second force are in opposing directions.
14. The robotic system of claim 13 , wherein the second medical instrument is a patient introducer.
15. A robotic system, comprising:
a first robotic manipulator, comprising:
at least one joint;
one or more torque sensors; and
an instrument driver configured to drive a first medical instrument within a patient;
one or more processors; and
data storage storing computer-executable instructions configured to cause the one or more processors to:
while the first medical instrument is being driven along a first axis, measure a first torque value at the at least one joint based at least in part on output from the one or more torque sensors;
determine a second torque value indicative of a gravitational component of the first torque value;
determine a gravity-compensated torque value based at least in part on the first torque value and the second torque value;
determine that at least a portion of the gravity-compensated torque value is in a direction perpendicular to the first axis; and
determine that the first medical instrument is misaligned with a second medical instrument based at least in part on said determination that the at least a portion of the gravity-compensated torque value is in the direction perpendicular to the first axis.
16. The robotic system of claim 15 , wherein the gravity-compensated torque value is based on a difference between the first torque value and the second torque value.
17. The robotic system of claim 15 , wherein said determining the second torque value is based at least in part on a position of the first robotic manipulator.
18. The robotic system of claim 17 , wherein said determining the second torque value involves determining at least one of:
a position of two linkages connected by the at least one joint; or
an angle formed between the two linkages.
19. The robotic system of claim 15 , wherein the second medical instrument is a patient introducer.