NULL SPACE CONTROL FOR END EFFECTOR JOINTS OF A ROBOTIC INSTRUMENT
The disclosed embodiments relate to systems and methods for a surgical tool or a surgical robotic system. One example method includes providing a redundant degree of freedom (DoF) for an end effector joint of one DoF by driving the joint with two actuators, calculating a position displacement of the joint to effect a desired end effector movement in response to an input command, calculating a first movement of the two actuators based on the position displacement of the joint and a second movement of the two actuators based on a second control objective in a null space corresponding to the redundant DoF, and driving the joint according to the first movement and the second movement to effect the desired end effector movement while accomplishing the second control objective in the null space.
1 . A method comprising:
providing a redundant degree of freedom (DoF) for a tool by driving a movable part with at least two actuators;
calculating a position displacement of the movable part to effect a desired movement in response to an input command;
calculating a first movement of the two actuators based on the position displacement of the movable part and a second movement of the two actuators based on a second control objective in a null space corresponding to the redundant DoF; and
driving the movable part according to the first movement and the second movement while accomplishing the second control objective in the null space.
2 . The method of claim 1 , wherein the movable part is a joint.
3 . The method of claim 1 , wherein the movable part includes an articulation wrist.
4 . The method of claim 1 , further comprising:
determining a projection of a control signal for the position displacement of the movable part to a vector for the null space, wherein the projection represents the second control objective.
5 . The method of claim 1 , wherein the null space corresponding to the redundant DoF for the movable part is described as a vector.
6 . The method of claim 1 , wherein the null space corresponding to the redundant DoF for the movable part provides a relationship between the first movement of the two actuators and the second movement of the two actuators.
7 . The method of claim 1 , wherein the movable part is coupled to the at least two actuators using a plurality of cables.
8 . The method of claim 7 , wherein the second control objective sets tension on the plurality of cables.
9 . The method of claim 1 , wherein the movable part is a closure jaw.
10 . An apparatus to provide a control objective using a null space of a redundant degree of freedom of a surgical tool, the apparatus comprising:
a tool driver including a plurality of actuators providing a redundant degree of freedom (DoF); and
one or more processors configured to:
calculate a position displacement of a movable part to effect a desired movement in response to an input command;
calculate a first movement of two actuators based on the position displacement of the movable part and a second movement of the two actuators based on a second control objective in a null space corresponding to the redundant DoF; and
drive the movable part according to the first movement and the second movement while accomplishing the second control objective in the null space.
11 . The apparatus of claim 10 , wherein the movable part is a joint.
12 . The apparatus of claim 10 , wherein the movable part includes an articulation wrist.
13 . The apparatus of claim 10 , further comprising:
determining a projection of a control signal for the position displacement of the movable part to a vector for the null space, wherein the projection represents the second control objective.
14 . The apparatus of claim 10 , wherein the null space corresponding to the redundant DoF for the movable part is described as a vector.
15 . The apparatus of claim 10 , wherein the null space corresponding to the redundant DoF for the movable part provides a relationship between the first movement of the two actuators and the second movement of the two actuators.
16 . The apparatus of claim 10 , wherein the movable part is coupled to the two actuators using a plurality of cables.
17 . The apparatus of claim 16 , wherein the second control objective sets tension on the plurality of cables.
18 . The apparatus of claim 10 , wherein the movable part is a closure jaw.
19 . A non-transitory computer readable medium including instructions to cause one or more processors to perform:
calculating a position displacement of a tool to set a desired movement in response to an input command;
calculating a first movement of two actuators based on the position displacement and a second movement of the two actuators based on a second control objective in a null space corresponding to a redundant DoF; and
driving the tool according to the first movement and the second movement while accomplishing the second control objective in the null space.
20 . The non-transitory computer readable medium of claim 19 , wherein the redundant DOF is a wrist or a jaw.