System and apparatus for external torque observation and compensation for surgical robotic arm
A surgical robotic arm includes a first link; a second link coupled to the first link at a first joint such that at least one of the first link or the second link is movable relative to each other; and a first actuator configured to move at least one of the first link or the second link. The surgical robotic arm also includes a joint torque sensor disposed within the first joint and configured to measure torque imparted on at least one of the first link or the second link to obtain a measured torque value. The surgical robotic arm further includes a controller configured to: determine an estimated joint torque value; compare the estimated joint torque value to the measured torque value; and determine an environmental torque value based on a comparison of the estimated joint torque value and the measured torque value.
1 . A surgical robotic arm comprising:
a link;
an actuator configured to move the link;
a torque sensor configured to measure torque imparted on the link to obtain a measured torque value; and
a controller configured to:
determine an environmental torque value based on the measured torque value;
detect a collision based on the environmental torque value being above a first threshold; and
enter a collision state in response to the environmental torque value being above the first threshold, wherein while in the collision state, the controller is further configured to determine the collision state is terminated based on the environmental torque value being below a second threshold.
2 . The surgical robotic arm according to claim 1 , wherein the controller is further configured to receive a movement command to move the link.
3 . The surgical robotic arm according to claim 2 , wherein the controller is further configured to calculate an input motor torque command in response to the movement command, the input motor torque command configured to activate the actuator to move the link in response to the movement command.
4 . The surgical robotic arm according to claim 3 , wherein while in the collision state, the controller is further configured to adjust the input motor torque command to prevent oversaturating output torque of the actuator.
5 . The surgical robotic arm according to claim 1 , wherein the controller is further configured to:
determine an estimated joint torque value; and
determine the environmental torque value based on a difference between the estimated joint torque value and the measured torque value.
6 . The surgical robotic arm according to claim 1 , wherein the second threshold is smaller than the first threshold.
7 . The surgical robotic arm according to claim 1 , wherein the controller is further configured to:
compare a position error to a position error threshold; and
determine the collision state is terminated based on the environmental torque value being below the second threshold and the position error being below the position error threshold.
8 . A surgical robotic arm comprising:
a link;
an actuator configured to move the link;
a torque sensor configured to measure torque imparted on the link to obtain a measured torque value; and
a controller configured to:
determine an environmental torque value based on the measured torque value;
detect a collision based on the environmental torque value being above a first threshold;
enter a collision state in response to the environmental torque value being above the first threshold; and
exit the collision state in response to the environmental torque value being below a second threshold.
9 . The surgical robotic arm according to claim 8 , wherein the controller is further configured to receive a movement command to move the link.
10 . The surgical robotic arm according to claim 9 , wherein the controller is further configured to calculate an input motor torque command in response to the movement command, the input motor torque command configured to activate the actuator to move the link in response to the movement command.
11 . The surgical robotic arm according to claim 10 , wherein while in the collision state, the controller is further configured to adjust the input motor torque command to prevent oversaturating output torque of the actuator.
12 . The surgical robotic arm according to claim 8 , wherein the controller is further configured to:
determine an estimated joint torque value; and
determine the environmental torque value based on a difference between the estimated joint torque value and the measured torque value.
13 . The surgical robotic arm according to claim 8 , wherein the second threshold is smaller than the first threshold.
14 . The surgical robotic arm according to claim 8 , wherein the controller is further configured to:
compare a position error to a position error threshold; and
determine the collision state is terminated based on the environmental torque value being below the second threshold and the position error being below the position error threshold.
15 . A method for detecting collision of a surgical robotic arm, the method comprising:
measuring torque imparted on at least one movable link of the surgical robotic arm to obtain a measured torque value;
determining an environmental torque value based on the measured torque value;
detecting a collision based on the environmental torque value being above a first threshold;
entering the surgical robotic arm into a collision state in response to the environmental torque value being above the first threshold; and
while in the collision state, determining the collision state is terminated based on the environmental torque value being below a second threshold.
16 . The method according to claim 15 , wherein the surgical robotic arm includes an actuator configured to move the at least one movable link relative to a joint and the method further comprises transmitting a movement command to the surgical robotic arm.
17 . The method according to claim 16 , further comprising:
calculating an input motor torque command in response to the movement command, the input motor torque command configured to activate the actuator to move the at least one movable link according to the movement command.
18 . The method according to claim 17 , wherein while in the collision state, the method further comprises adjusting the input motor torque command to prevent oversaturating output torque of the actuator.
19 . The method according to claim 15 , further comprising:
determining an estimated joint torque value; and
determining the environmental torque value based on a difference between the estimated joint torque value and the measured torque value.
20 . The method according to claim 15 , wherein the second threshold is smaller than the first threshold.
21 . The method according to claim 15 , further comprising:
comparing a position error to a position error threshold; and
determining the collision state is terminated based on the environmental torque value being below the second threshold and the position error being below the position error threshold.