Control of a surgical instrument having backlash, friction, and compliance under external load in a surgical robotic system
For control of a surgical instrument in a surgical robotic system, multiple actuators establish a static pretension by actuating in opposition to each other in torque control. The static pretension reduces or removes the compliance and elasticity, reducing the backlash width. To drive the tool, the actuators are then moved in cooperation with each other in position mode control so that the movement maintains the static pretension while providing precise control.
1. A method for control of a surgical instrument in a surgical robotic system, the method comprising:
actuating a first linkage engaged with a first motor and a second linkage engaged with a second motor, the first and second linkages mechanically coupled to an end effector of the surgical instrument, the first and second motors operating under torque control in opposition to each other, the torque control using control inputs for torque for input drive terminals of the first and second motors;
transitioning to position control from the torque control of the first and second motors when a threshold torque is reached; and
driving the end effector in position control of the first and second motors, the first and second motors operating in coordination with each other.
2. The method of claim 1 wherein actuating comprises consuming backlash from the first and second motors through the first and second linkages to the end effector.
3. The method of claim 1 wherein the surgical instrument has a one-dimensional motion for the end effector controlled by the first and second motors, and wherein actuating comprises actuating the first motor to drive the end effector in a first direction with the first linkage and actuating the second motor to drive the end effector in a second direction opposite to the first direction with the second linkage.
4. The method of claim 1 wherein actuating comprises homing the first and second motors with the end effector, and wherein driving comprises driving the end effector in surgery after the homing.
5. The method of claim 4 wherein actuating comprises applying a static pretension during the homing, the static pretension corresponding to the threshold torque and wherein driving comprises driving with the static pretension maintained.
6. The method of claim 1 wherein transitioning comprises changing a control mode from the torque control to the position control.
7. The method of claim 1 wherein transitioning comprises sensing current draw by the first and/or second motors for the torque control and relating the current draw to torque.
8. The method of claim 1 wherein driving comprises moving the first and second linkages by the first and second motors with a relative position of drive shafts of the first and second motors maintained under an external load on the end effector.
9. The method of claim 1 wherein transitioning comprises marking positions of drive shafts of the first and second motors, and wherein driving in the position control comprises controlling positions of the drive shafts from the marked positions.
10. The method of claim 1 wherein driving comprises controlling the first and second motors with a same position command so that a same relative position of drive shafts of the first and second motors is maintained as the end effector moves under control of the first and second motors.
11. A surgical robotic system for control of a surgical instrument, the surgical robotic system comprising:
a surgical end effector actuated by first and second actuators through a transmission; and
a controller configured to drive the first and second actuators in opposition to create a static pretension as part of homing of the first and second actuators and to drive the first and second actuators in coordination to move the surgical end effector while maintaining the static pretension.
12. The surgical robotic system of claim 11 wherein the surgical end effector comprises a stapler connected with a robotic arm, wherein the static pretension fixes backlash of the transmission, and wherein the controller is configured to drive the first and second actuators to staple while maintaining the backlash.
13. The surgical robotic system of claim 11 wherein the controller is configured to drive to apply the static pretension in a torque control mode and is configured to drive to move the surgical end effector in a position control mode.
14. The surgical robotic system of claim 11 wherein the controller is configured to drive to apply the static pretension by operating the first actuator in opposition to the second actuator and to drive to move the surgical end effector by operating the first and second actuators in cooperation with each other.
15. The surgical robotic system of claim 11 wherein the controller is configured to move the surgical end effector while under external load on the surgical end effector, the surgical end effector moved by a same position command sent to both the first and second actuators.
16. A method for control of a surgical tool in a surgical robotic system, the method comprising:
overcoming variable backlash due to compliance of engaged couplings between actuators and the surgical tool with the actuators driven in opposition to each other relative to actuation of the surgical tool; and
actuating the surgical tool through the engaged couplings by driving the actuators, wherein actuating comprises controlling the actuators with a same position command so that a same relative position of drive shafts of the actuators is maintained as the surgical tool moves under control of the actuators.
17. The method of claim 16 wherein overcoming comprises controlling in a torque control mode, and wherein actuating comprises controlling in a position control mode.
18. The method of claim 16 wherein actuating comprises driving the actuators in cooperation to each other.
19. The method of claim 16 wherein actuating comprises driving under external load on the surgical tool.
20. The method of claim 16 wherein overcoming comprises overcoming as part of homing of the actuators relative to the surgical tool.