Systems and methods for constrained motion control of medical instruments
Systems and methods for constrained motion control of medical instruments are provided. In one aspect, a robotic system includes an instrument having an end effector, a robotic arm configured to control movement of the instrument and the end effector, and an input device configured to receive an input for controlling movement of the instrument and end effector. The instrument is capable of moving in a different number of degrees-of-freedom (DOFs) than the input device. The system is configured to determine a Jacobian matrix relating the input to the input device to robotic arm commands for achieving a motion of the end effector indicated by the input, modify the Jacobian matrix via discarding at least one row of the Jacobian matrix, and determine a robotic arm command for achieving the motion of the instrument indicated by the input based on the modified Jacobian matrix.
1. A robotic system, comprising:
an instrument having an end effector;
a robotic arm configured to control movement of the instrument and the end effector;
an input device configured to receive an input for controlling movement of the instrument and the end effector, wherein the instrument is capable of moving in a fewer number of degrees-of-freedom (DOFs) than the input device, wherein the input device comprises a gimbal configured to receive force feedback that constrains a clinician's hand to move the gimbal in a constrained motion that is constrained to the fewer number of DOFs;
at least one processor; and
at least one computer-readable memory in communication with the at least one processor and having stored thereon computer-executable instructions to cause the at least one processor to:
determine a Jacobian matrix relating the input to robotic arm commands for achieving a motion of the end effector indicated by the input,
modify the Jacobian matrix by discarding at least one row of the Jacobian matrix corresponding to a DOF in which the instrument is incapable of movement, and
determine a robotic arm command for achieving the motion of the end effector indicated by the input based on the modified Jacobian matrix.
2. The robotic system of claim 1 , wherein the input device has 6 DOFs and the instrument has 5 DOFs.
3. The robotic system of claim 1 , wherein:
the input device has n more DOFs than the instrument; and
the modifying of the Jacobian matrix comprises discarding n rows of the Jacobian matrix corresponding to one or more types of movement of which the instrument is incapable of moving.
4. The robotic system of claim 1 , wherein the instrument is a surgical stapler, suction irrigator, straight harmonic tool, or articulating harmonic tool.
5. The robotic system of claim 1 , wherein the instrument comprises a surgical stapler having 5 DOFs.
6. The robotic system of claim 1 , wherein the instrument comprises a suction irrigator having at least 4 DOFs.
7. The robotic system of claim 1 , wherein:
the DOF in which the instrument is incapable of movement is a yaw DOF of the end effector, and
the modifying of the Jacobian matrix comprises discarding a row of the Jacobian matrix corresponding to yaw movement.
8. The robotic system of claim 1 , wherein the input device is capable of movement in the DOF in which the instrument is incapable of movement, and wherein the constrained motion of the gimbal restricts motion of the gimbal in the DOF in which the instrument is incapable of movement.
9. The robotic system of claim 1 , wherein:
the instrument is constrained in movement at a remote center of motion (RCM);
the Jacobian matrix comprises an end effector Jacobian matrix that relates the input to the input device to the robotic arm commands for achieving the motion of the end effector indicated by the input; and
the computer-executable instructions further cause the at least one processor to:
modify the end effector Jacobian matrix based on discarding the at least one row from the end effector Jacobian matrix;
determine an RCM Jacobian matrix relating the input to the input device to the robotic arm commands for maintaining the RCM; and
determine the robotic arm command based on the modified end effector Jacobian matrix and the RCM Jacobian matrix.
10. The robotic system of claim 1 , wherein the Jacobian matrix relates a frame of reference of the end effector to a world frame of reference of the robotic system.
11. A method for controlling movement of an end effector of a medical instrument, the method comprising:
receiving, via an input device, an input for controlling movement of the instrument, wherein the instrument has a fewer number of degrees-of-freedom (DOFs) than the input device, wherein the input device comprises a gimbal configured to receive force feedback;
determining a Jacobian matrix relating the input received via the input device to robotic arm commands for achieving a motion of the end effector indicated by the input;
modifying the Jacobian matrix by discarding at least one row of the Jacobian matrix, wherein the row corresponds to a DOF in which the instrument is incapable of movement;
determining a robotic arm command for achieving the motion of the end effector indicated by the input based on the modified Jacobian matrix; and
providing force feedback to the gimbal that constrains a motion of the gimbal to the fewer number of degrees of freedom.
12. The method of claim 11 , wherein the input device has 6 DOFs and the end effector has 5 DOFs.
13. The method of claim 11 , wherein:
the input device has n more DOFs than the instrument; and
the modifying of the Jacobian matrix comprises discarding n rows of the Jacobian matrix corresponding to types of movement of which the instrument is incapable of moving.
14. The method of claim 11 , wherein:
the DOF in which the instrument is incapable of movement is a yaw DOF of the end effector, and
the modifying of the Jacobian matrix comprises discarding a row of the Jacobian matrix corresponding to the yaw DOF.
15. The method of claim 11 , wherein the input device is capable of movement in the DOF in which the instrument is incapable of movement, and wherein the constrained motion of the gimbal restricts motion of the gimbal in the DOF in which the instrument is incapable of movement.
16. A robotic system, comprising:
an instrument having an end effector;
a robotic arm configured to control movement of the end effector;
a gimbal configured to receive an input for controlling movement of the end effector, wherein the end effector has fewer degrees-of-freedom (DOFs) than the gimbal;
at least one processor; and
at least one computer-readable memory in communication with the at least one processor and having stored thereon computer-executable instructions to cause the at least one processor to:
determine a Jacobian matrix relating the input to robotic arm commands for achieving a motion of the end effector indicated by the input,
discard at least one row of the Jacobian matrix based on a DOF in which the gimbal is capable of movement and the end effector is incapable of movement,
determine a robotic arm command for achieving the motion of the instrument indicated by the input based on the Jacobian matrix after the at least one row is discarded, and
provide force feedback to the gimbal that constrains motion of the gimbal to the fewer DOFs of the end effector.
17. The robotic system of claim 16 , wherein the gimbal is capable of movement in the DOF in which the end effector is incapable of movement, and wherein the force feedback restricts motion of the gimbal in the DOF in which the instrument is incapable of movement.
18. The robotic system of claim 16 , wherein the end effector is incapable of yaw movement, and the force feedback restricts yaw movement of the gimbal.