Clamping force control in surgical robotic system
By designing a clamping force controller in the surgical robot system, the clamping movement is controlled by using the opening between clamps and clamping events, the problem of inconsistent clamping force of the clamping instrument is solved, and the consistency of clamping force is achieved and stability improves the accuracy and safety of the surgery.
Patent Information
- Application Number
- CN202380027917.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-03-21
- Filing Date
- 2023-03-20
- Publication Date
- 2024-11-05
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The clamping force of the clamping device in the surgical robot system is inconsistent, resulting in changes in clamping force, affecting the stability and accuracy of the surgery.
A clamping force controller is designed to control the movement of the clamp through the required opening and clamping events between the clamps, determine the clamping force threshold and limit, ensuring that the clamping is uniformly driven in the closed and open directions. , achieve consistency of clamping force.
It effectively solves the problem of inconsistent clamping force of clamping instruments, improves the consistency and stability of clamping force output of surgical robot systems, reduces clamping force changes, and improves the accuracy and safety of the surgery.
Smart Images

Figure CN118900668A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to controlling the clamping of a jaw instrument of a surgical robotic system to achieve a more consistent clamping force of the jaws. Background Art
[0002] The use of robots to assist and perform surgery is known. Figure 1 A typical surgical robot 100 is shown, which consists of a base 108 and an arm 102. An instrument 105 is coupled to the arm. The base supports the robot and is itself rigidly attached to, for example, an operating room floor, an operating room ceiling, or a cart. The arm extends between the base and the instrument. The arm is articulated by means of a plurality of flexible joints 103 along its length, which are used to position the surgical instrument in a desired position relative to the patient. The surgical instrument is attached to the distal end 104 of the robot arm. The surgical instrument passes through the body of the patient 101 at a port 107 in order to access the surgical site. The instrument includes an end effector 106 at its distal end for performing a medical procedure.
[0003] Figure 2 A typical surgical instrument 200 for performing robotic laparoscopic surgery is shown. The surgical instrument includes an instrument interface 201 by which the surgical instrument is connected to the robotic arm. A shaft 202 extends between the interface 201 and an articulation 203. The articulation 203 terminates in an end effector 204. Figure 2 , a pair of serrated jaws are shown as end effector 204. A hinge 203 allows end effector 204 to move relative to axis 202. It is desirable to provide at least two degrees of freedom to the movement of end effector 204 via the hinge. The hinge allows the end effector to move in a yaw direction 205. The instrument jaws may move together and / or separately in the yaw direction 205. The instrument interface is configured to couple to an arm drive assembly of a robotic arm with which the instrument may engage. When the instrument engages with the arm, the instrument interface engages with the drive assembly, thereby transmitting a drive force to the instrument.
[0004] Figure 3A surgical robot is shown having an arm 300 extending from a base 301. The arm comprises a plurality of rigid limbs 302. The limbs are connected by revolute joints 303. The most proximal limb 302a is connected to the base by a proximal joint 303a. It is connected in series with the other limbs by further joints 303. Suitably, a wrist 304 consists of four separate revolute joints. The wrist 304 connects one limb (302b) of the arm to the most distal limb (302c). The most distal limb 302c carries an attachment 305 for a surgical instrument 306. Each joint 303 of the arm has one or more motors 307 which can be operated to cause rotational movement at the respective joint, and one or more position and / or torque sensors 308 which provide information about the current configuration and / or load at the joint. Suitably, the motors are arranged proximal to the joints whose movement they drive in order to improve weight distribution. For clarity, the motors are not shown in the figure. Figure 3 Only some of the motors and sensors are shown. The arm may generally be as described in patent application PCT / GB2014 / 053523 (WO 2015 / 132549).
[0005] The arm terminates in an attachment 305 for connection with an instrument 306. Suitably, the instrument 306 is of a Figure 2 The form described. The diameter of the instrument is less than 8mm. Suitably, the diameter of the instrument is 5mm. The instrument can have a diameter less than 5mm. The instrument diameter can be the diameter of the shaft. The instrument diameter can be the diameter of the profile of the hinge. Suitably, the diameter of the profile of the hinge matches the diameter of the shaft or is narrower than the diameter of the shaft. The attachment 305 includes a drive assembly for driving the hinge of the instrument. The movable interface element of the drive assembly mechanically engages the corresponding movable interface element of the instrument interface so as to transfer the driving force from the robot arm to the instrument. During a typical operation, one instrument is replaced with another instrument several times. Therefore, during the operation, the instrument can be attached to the robot arm and can be removed from the robot arm. The features of the drive assembly interface and the instrument interface facilitate their alignment when they are engaged with each other, thereby reducing the accuracy with which they need to be aligned by the user.
[0006] Instrument 306 includes an end effector for performing the procedure. The end effector may take any suitable form. For example, the end effector may be a smooth jaw, a serrated jaw, a clamp, a pair of shears, a needle for suturing, a camera, a laser, a knife, a stapler, a cauterizer, or an aspirator. Figure 2The instrument comprises an articulated portion between the instrument axis and the end effector. The articulated portion comprises a number of joints that allow the end effector to move relative to the axis of the instrument. The joints in the articulated portion are actuated by drive elements, such as cables. These drive elements are fixed to interface elements of the instrument interface at the other end of the instrument axis. Therefore, the robot arm transmits the driving force to the end effector in the following manner: the movement of the drive assembly interface element causes the instrument interface element to move, the movement of the instrument interface element causes the drive element to move, the movement of the drive element causes the joints of the articulated portion to move, and the movement of the joints causes the end effector to move.
[0007] Controllers for motors, torque sensors, and encoders are distributed within the robot arm. The controllers are connected to a control unit 309 via a communication bus. The control unit 309 includes a processor 310 and a memory 311. The memory 311 stores software in a non-transient manner, which can be executed by the processor to control the operation of the motor 307 so that the arm 300 operates in the manner described herein. Specifically, the software can control the processor 310 to drive the motor (e.g., via a distributed controller) according to inputs from the sensor 308 and inputs from the surgeon command interface 312. The control unit 309 is connected to the motor 307 to drive them according to the outputs generated by the execution of the software. The control unit 309 is connected to the sensor 308 to receive sensing inputs from the sensor, and is connected to the command interface 312 to receive inputs from it. For example, the corresponding connections can each be a cable or an optical cable, and / or can be provided by a wireless connection. The command interface 312 includes one or more input devices, whereby the user can request the movement of the end effector in a desired manner. The input device can be, for example, a manually operable mechanical input device, such as a control handle or joystick, or a contactless input device, such as an optical gesture sensor. The software stored in the memory 311 is configured to respond to these inputs according to a predetermined control strategy and cause the joints of the arm and the instruments to move accordingly. The control strategy can include safety features that regulate the movement of the arm and the instruments in response to the command inputs. Thus, in general, the surgeon at the command interface 312 can control the movement of the instrument 306 to perform the desired surgical procedure. The control unit 309 and / or the command interface 312 can be remote from the arm 300.
[0008] The illustrated surgical robot includes a single robotic arm. Other surgical robotic systems may include multiple surgical robots and / or multiple robotic arms. For example, other example surgical robotic systems may include a surgical robot with multiple robotic arms, each of which may receive and manipulate surgical instruments, or they may include multiple surgical robots, each of which has a robotic arm that may receive and manipulate surgical instruments.
[0009] The arm 102 terminates in an attachment for connecting to an instrument, examples of which may be found at Figure 4 The attachment includes a drive assembly for driving the articulated portion of the instrument 105. The drive assembly interface 400 interfaces with the instrument interface, an example of which is shown in FIG. Figure 5 The movable interface elements 401, 402, 403 of the drive assembly engage the corresponding movable interface element 502 of the instrument interface to transfer the drive force from the robotic arm 102 to the instrument 105. Figure 4 and Figure 5 In the example shown, the drive assembly interface element includes protruding fins 401, 402, 403, and the interface element of the instrument interface includes a cup 502 for receiving the fins. Both the fins and the cup can be provided in a circular shape in any way. In some embodiments, the drive assembly interface element includes a cup, and the interface element of the instrument interface includes a fin that can be received in the cup. Other ways in which the corresponding drive assembly interface element and the corresponding instrument interface element engage with each other can be provided. The linear movement of the drive assembly interface element causes the corresponding linear movement of the interface element of the instrument interface.
[0010] The surgical robot 100 is operated by an operator (eg, a surgeon) through Figure 6 600 is remotely controlled by the operator console 600 shown in . The operator console 600 can be located in the same room as the surgical robot 100 (e.g., an operating room) or away from the surgical robot. The operator console 600 includes input devices 602, 604 for controlling the state of the arm 102 and / or the instrument 105 attached thereto. The input devices 602, 604 can be handles or manual controllers mounted on a parallelogram linkage. The control system converts the movement of the manual controller into control signals to move the arms, joints, and / or instrument end effectors of the surgical robot. The operator console 600 also includes a display 606. The display 606 is arranged to be visible to the user operating the input devices 602, 604. The display is used to display a video stream (e.g., endoscopic video) of the surgical site.
[0011] In some robotic control systems, including surgical robotic control systems, there may be variability in the clamping force applied when a user controls the jaw end effector to close. A clamping force may be applied when the jaws contact each other, or when they contact an object located between the jaws. An example of a clamping instrument is a needle holder. The needle holder will apply a clamping force when a needle is clamped between the jaws. The clamping may be different depending on where along the jaws the needle is clamped and depending on the thickness of the needle itself.
[0012] The user can give a command to close the jaws by operating the user input device. In response, the control system can, for example, output a required closing force between the jaws, or specify a desired closed state of the jaws, such as an opening of the jaws. The opening can be defined by the angular spacing of the jaws or in any other convenient manner. For a given required closing force and / or a given desired closed state of the jaws, the actual force applied may depend on the specific instrument used and / or the specific drive assembly used to drive that instrument. For example, manufacturing tolerances mean that each instrument and drive assembly may be slightly different, which may result in force variations. It is desirable to reduce the variation in the applied force while maintaining the commanded state consistent. Summary of the invention
[0013] This Summary is provided to introduce a selection of concepts that are further described below in the Detailed Description. This Summary is not intended to identify key features or essential features of the claimed subject matter, nor is it intended to be used to limit the scope of the claimed subject matter.
[0014] According to one aspect of the present invention, there is provided a clamping force controller for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly being used to transmit a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the clamping force controller being configured to:
[0015] Controlling the movement of the jaws according to the desired opening between the jaws;
[0016] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0017] determining a desired opening between the jaws upon determining the occurrence of a clamping event;
[0018] setting the determined desired opening as a minimum opening limit of the jaws; and
[0019] The minimum opening limit is used to control the movement of the jaws in order to control the clamping force applied by the jaws.
[0020] The clamping force controller can be configured to determine the occurrence of a clamping event when any one or more of the following occurs: the clamping force between the jaws exceeds a clamping force threshold; the required motor force of a motor of a drive assembly for transmitting the driving force to one of the jaws exceeds a motor force threshold; the average required motor force of multiple motors of a drive assembly for transmitting the driving force to the corresponding jaws in the jaws exceeds an average motor force threshold; the motor of a drive assembly for transmitting the driving force to one of the jaws approaches or reaches a saturation point; the current through the motor of the drive assembly for transmitting the driving force to one of the jaws exceeds a current threshold; the drive element of the instrument, through which the driving force is transmitted to one of the jaws, approaches or reaches a physical limit of the drive element; and the physical limit of a component of the instrument is reached.
[0021] The clamping force controller may be configured to determine the occurrence of a clamping event based on a signal indicating one or more of: a clamping force between the jaws; a required motor force of a motor; an average required motor force of a plurality of motors; a motor saturation of a motor of a drive assembly for transmitting the drive force to one of the jaws; a current through a motor of a drive assembly for transmitting the drive force to one of the jaws; and a tension in a drive element of the instrument through which the drive force is transmitted to one of the jaws. The signal may include or be derived from visual servoing based on an image of the instrument. The clamping force controller may be configured to filter the signal and determine the occurrence of a clamping event based on the filtered signal.
[0022] The minimum opening limit may be a negative opening. The clamping force controller may be configured to reset the minimum opening limit upon determining that any one or more of the following occurs: the jaws are opened beyond an opening opening threshold; the desired opening exceeds a desired opening threshold; the desired opening becomes positive; the measured opening becomes positive; the clamping force applied between the jaws decreases beyond another clamping force threshold; the tension of a drive element or other component of the instrument decreases beyond a reset threshold tension; the torsion of a drive element or other component of the instrument decreases beyond a reset threshold torsion; the deflection of a drive element or other component of the instrument decreases beyond a reset threshold deflection; the jaws move relative to each other in an opening direction at a speed greater than an opening speed threshold; the commanded jaw movement in the opening direction exceeds a threshold commanded jaw movement; the change in force per unit displacement exceeds a predetermined value; the clamping force commanded by the surgeon decreases; a predetermined time t elapses reset ; and receiving an indication of the end of the clamping operation.
[0023] The clamping force controller can be configured to determine that the instrument end effector is in a static condition in which the average required motor force exceeds the static condition motor force. The instrument end effector can be determined to be in a static condition when a clamping event is determined to have occurred. The static condition motor force can be -180 effective force units, and the average required motor force can exceed this value when the average required motor force becomes more negative than this value.
[0024] The clamping force controller can be configured to: determine a yaw difference value based on a difference between a desired yaw angle of the end effector of the instrument and a measured yaw angle of the end effector of the instrument; and determine that the instrument end effector is in a dynamic condition in which the yaw difference value is determined to be greater than a dynamic yaw value.
[0025] The clamping force controller may be configured to determine that the instrument end effector is in a dynamic condition in which a yaw velocity is determined to be greater than a dynamic yaw velocity value. The clamping force controller may be configured to determine that the instrument end effector is in a dynamic condition in which a required motor force of one of the plurality of motors is greater than a motor force threshold and a required motor force of another of the plurality of motors is less than the motor force threshold.
[0026] In the event that the instrument end effector is determined to be in a dynamic state, the minimum opening limit of the jaws may be corrected. The minimum opening limit may not increase beyond the opening value corresponding to the minimum clamping force threshold, thereby maintaining the minimum clamping force between the jaws. A gain dependent on the opening may be applied to the desired yaw angle.
[0027] The clamping force controller may be configured to: determine a resultant force F on a drive element for driving each jaw; determine a rate of change of the resultant force F with the opening S of the jaws; determine a rate of change of the opening S of the jaws with time t; determine a rate of change of the resultant force F with time t based on the determined rate of change exceeding a predetermined constant k S and the determined rate of change of the opening of the jaws exceeds another predetermined constant V S , setting the instantaneous resultant force to the baseline force, and setting the instantaneous opening to the baseline opening. The clamping force controller may be configured to determine a change in the resultant force relative to the baseline force, and determine the occurrence of a clamping event when the change in the determined resultant force exceeds a threshold force value. The clamping force controller may be configured to reset the baseline force when it is determined that the opening of the jaws has increased beyond the baseline opening and / or increased to positive opening.
[0028] According to another aspect of the present invention, there is provided a method for controlling the gripping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly for transmitting a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the method comprising:
[0029] Controlling the movement of the jaws according to the desired opening between the jaws;
[0030] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0031] determining a desired opening between the jaws upon determining the occurrence of a clamping event;
[0032] setting the determined desired opening as a minimum opening limit of the jaws; and
[0033] The minimum opening limit is used to control the movement of the jaws in order to control the clamping force applied by the jaws.
[0034] According to another aspect of the present invention, there is provided a clamping force controller for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly being used to transmit a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the clamping force controller being configured to:
[0035] Controlling the force applied between the jaws according to the required force;
[0036] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0037] determining an indication of a required force between the jaws upon determining the occurrence of a clamping event;
[0038] setting the determined required force as a maximum required force limit for the jaws; and
[0039] The maximum desired force limit is used to control the force applied between the jaws in order to control the clamping force applied by the jaws.
[0040] According to another aspect of the present invention, there is provided a method for controlling the gripping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly for transmitting a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the method comprising:
[0041] Controlling the force applied between the jaws according to the required force;
[0042] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0043] determining an indication of a required force between the jaws upon determining the occurrence of a clamping event;
[0044] setting the determined required force as a maximum required force limit for the jaws; and
[0045] The maximum desired force limit is used to control the force applied between the jaws in order to control the clamping force applied by the jaws.
[0046] According to another aspect of the present invention, there is provided a clamping force controller for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly being used to transmit a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the clamping force controller being configured to:
[0047] controlling the force applied between the jaws according to a desired force, and / or controlling the movement of the jaws according to a desired opening between the jaws;
[0048] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0049] determining an indication of a desired force between the jaws and / or determining a desired opening between the jaws upon determining an occurrence of a clamping event;
[0050] If a required force is determined, setting the determined required force as a maximum required force limit for the jaws, and if a required opening is determined, setting the determined required opening as a minimum opening limit for the jaws; and
[0051] A maximum desired force limit is used to control the force applied between the jaws and / or a minimum opening limit is used to control movement of the jaws in order to control the clamping force applied by the jaws.
[0052] According to another aspect of the present invention, there is provided a method for controlling the gripping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly for transmitting a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the method comprising:
[0053] controlling the force applied between the jaws according to a desired force, and / or controlling the movement of the jaws according to a desired opening between the jaws;
[0054] determining an occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws;
[0055] determining an indication of a desired force between the jaws and / or determining a desired opening between the jaws upon determining an occurrence of a clamping event;
[0056] If a required force is determined, setting the determined required force as a maximum required force limit for the jaws, and if a required opening is determined, setting the determined required opening as a minimum opening limit for the jaws; and
[0057] A maximum desired force limit is used to control the force applied between the jaws and / or a minimum opening limit is used to control movement of the jaws in order to control the clamping force applied by the jaws.
[0058] According to another aspect of the present invention, there is provided a clamping force controller for a surgical robot system, the clamping force controller being configured to perform the method defined herein.
[0059] According to another aspect of the present invention, a surgical robot system is provided, which includes: a robot having a base and an arm extending from the base to a drive assembly for engaging with an instrument, the arm including multiple joints, through which the configuration of the arm can be changed, the instrument having an end effector, the end effector including multiple jaws, and the drive assembly is used to transmit a driving force to the multiple jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and drive the jaws relative to each other in an opening direction so as to release the clamped object; and a clamping force controller, which is configured to perform the method defined herein.
[0060] According to another aspect of the present invention, there is provided a non-transitory computer-readable storage medium having computer-readable instructions stored thereon, which, when executed on a computer system, cause the computer system to perform a method as defined herein.
[0061] Any feature of any of the above aspects may be combined with any one or more other features of any of the above aspects.Any method feature may be written as an apparatus feature and vice versa. BRIEF DESCRIPTION OF THE DRAWINGS
[0062] The present invention will now be described by way of example with reference to the accompanying drawings.
[0063] In the attached picture:
[0064] Figure 1 schematically illustrates an example surgical robot performing an example surgical procedure;
[0065] Figure 2 Surgical instruments are shown;
[0066] Figure 3 A surgical robot is shown;
[0067] Figure 4 The drive assembly interface of the surgical robot arm is shown;
[0068] Figure 5 An instrument interface of a surgical instrument is shown;
[0069] Figure 6 An example operator console is schematically shown;
[0070] Figure 7 An example of a rotatable jaw and associated drive element is shown;
[0071] Figure 8 An example of an end effector having a jaw and associated drive elements is shown;
[0072] Fig. 9An example surgical robotic system is schematically illustrated;
[0073] Fig.10 An example of a change in the over-closed state is shown;
[0074] Fig.11 The relationship between the driving force limit and the differential force limit is schematically shown;
[0075] Fig.12 The variation of the clamping force over time for different control schemes is shown;
[0076] Fig.13 is a block diagram of an example method of controlling movement of jaws of an instrument; and
[0077] Fig.14 Components of an exemplary computing-based device are shown. DETAILED DESCRIPTION
[0078] The following description is presented by way of example to enable those skilled in the art to make and use the invention. The invention is not limited to the embodiments described herein, and various modifications to the disclosed embodiments will be apparent to those skilled in the art. The embodiments are described only by way of example.
[0079] The following description describes the present technology in the context of a surgical robotic system, although the features described below are not limited to such systems, but can be applied to robotic systems more generally. In some examples, the present technology can be applied to a remotely operated robotic system. The robotic system can include manufacturing systems, such as vehicle manufacturing systems, parts handling systems, laboratory systems, and manipulators, such as manipulators for hazardous materials or surgical manipulators.
[0080] The inventors have found that there may be some differences in the force delivered by the instrument jaws, which differences are sometimes significant. The force delivered may depend on the instrument used and / or the drive assembly that actuates the instrument. This means that the same instrument used on two different arms with different drive assemblies may produce significantly different maximum clamping forces. Likewise, different instruments connected to the same drive assembly may also potentially deliver significantly different maximum clamping forces.
[0081] The effect of this is that some instruments and arms (or combinations of instruments and arms) are better able to grip objects such as needles than other instruments and arms. From a user's perspective, differences in gripping ability are undesirable and may look like a system malfunction.
[0082] The inventors have also appreciated that further problems are caused by saturation of one or more motors in the drive assembly (i.e., reaching the maximum force that this motor can deliver), regardless of the required force. At this point (once motor saturation has occurred), no additional force can be provided by the instrument. This can result in degradation in grip performance. The grip may become unstable. In these cases, "jerkiness" of motion and grip force may be observed.
[0083] At least some of these problems may stem from tolerances in the drive assembly, the arm / instrument interface, and the instrument itself that interact with the position control of the instrument. Minor variations in the manufacturing of some or all of these subsystems may accumulate into an overall variability that has a significant impact on the force delivered. For example, in some cases, component variability may cause the peak clamping force delivered at the tip of the jaws to vary from 10N to 18N when the surgeon commands the jaws to clamp at maximum force.
[0084] The inventors have also recognized that this clamping force variability is further complicated by the opening angle of the jaws of the instrument when maximum clamping force is required. Since the objects being clamped may vary in size (e.g., suture needles of different sizes) and the objects may be held in different positions between the jaws (i.e., closer to the pivot or closer to the tip), it is not known in advance whether the maximum clamping force is the same as the object being clamped.
[0085] At what angle will the jaws be when they need maximum grip on an object. Additionally, variability in the stiffness of the instrument will affect the required drive assembly travel (i.e., movement of a drive mechanism, such as a linear drive mechanism) to achieve a given gripping force.
[0086] Therefore, due to all the variables that affect the clamping force output,
[0087] Using a fixed relationship between an input control (such as a manual control jaw mechanism) and jaw opening on the entire instrument and drive assembly may not result in optimal control of clamping force.
[0088] Therefore, it is desirable to consider new control schemes that can compensate for these inconsistencies. In the following, an adaptive clamping control scheme is described. This control scheme provides a reactive control relationship between the manual controller and the drive interface. Therefore, this control scheme achieves improved clamping force output and consistency in force output. Advantageously, individual calibration of each instrument and drive assembly is not required.
[0089] In an exemplary control scheme, a two-stage mapping may be used between the commanded jaw position and the actual jaw aperture angle (opening of the jaws). Suitably, the mapping is linear. The threshold separating the two stages is preferably selected as the manual controller jaw angle, which should correspond to a 0 degree opening angle. As the jaw angle continues to decrease, the jaws attempt to "over-close", thereby increasing the force being delivered. The increase in force being delivered is suitably linear. The first stage may have a lower gradient than the second stage, so that the clamping force increases when the jaws are over-closed.
[0090] Yaw tracking may also cause problems in delivering and maintaining clamping force. When the control system requires maximum clamping, the drive assembly may respond by actuating the drive motor or actuator to force the two jaws together. The jaws may be driven by drive elements that are coupled to the drive assembly and to the jaws via the instrument interface. Suitably, the drive element is a cable, such as a metal cable. This is particularly useful in Figure 7 Shown in. Figure 7 A single jaw 702 is shown that can rotate around a pulley 704 (for clarity). The jaw 702 can be integral with the pulley 704. For example, a pulley channel can be formed in the proximal portion of the jaw 702. A drive element 706 can travel on the pulley 704 to control the rotational movement of the jaw 702 around the pulley axis. A single drive element can surround the pulley 704, or multiple drive elements can be provided. Where multiple drive elements are provided, a first drive element can travel on a portion of the pulley 704 in a first direction around the rotational axis of the pulley and can be attached to the proximal portion of the jaw 702. A second drive element can travel on another portion of the pulley 704 in a second direction around the rotational axis of the pulley and can be attached to the proximal portion of the jaw 702 (which can, but need not necessarily, be in the same position as the attachment of the first drive element). Pulling the single drive element 706 (or pulling, for example, the first drive element) in one direction 708 can cause the jaw to rotate in an opening direction. Pulling the single drive element 706 (or pulling, for example, a second drive element) in the other direction 710 may cause the jaws to rotate in a closing direction.
[0091] Reference now Figure 8 , shows an object clamped between two jaws. Figure 8806. In the embodiment of the present invention, a first right-hand jaw 802 and a second left-hand jaw 804 are rotatably coupled to a pulley 806. A first opening drive element 808 is coupled to the right-hand jaw 802. A first closing drive element 810 is coupled to the right-hand jaw 802. Pulling the first opening drive element 808 will cause the right-hand jaw 802 to move in an opening direction (i.e., away from the left-hand jaw 804). Pulling the first closing drive element 810 will cause the right-hand jaw 802 to move in a closing direction (i.e., toward the left-hand jaw 804). A second opening drive element 812 is coupled to the left-hand jaw 804. A second closing drive element 814 is coupled to the left-hand jaw 804. Pulling the second opening drive element 812 will cause the left-hand jaw 804 to move in an opening direction (i.e., away from the right-hand jaw 802). Pulling the second closing drive element 814 will cause the left-hand jaw 804 to move in a closing direction (i.e., toward the right-hand jaw 802). The object 816 is partially clamped along the jaws 802, 804. The first opening drive element and the first closing drive element are shown in dashed lines to help distinguish them from the second opening drive element and the second closing drive element. The dashed lines are shown as being laterally offset from the solid lines for clarity only. The pulleys around which the drive elements pass are suitably of the same size, although they can be different.
[0092] Pulling the jaws together with force can stretch the drive elements on the tensioning side of the two jaws (e.g., see Figure 8 , first closing drive element 810 and second closing drive element 814). However, if the end effector moves and the gripper - in particular moves in yaw (see Figure 8 ), then one drive element is pulled hard and the other is pulled less hard. In fact, the jaw coupled to the drive element that is pulled less hard is (or at least may be) driven in the opposite direction by the other jaw coupled to the drive element that is pulled hard. For example, when Figure 8 When the end effector shown in FIG. 1 moves to the left in yaw, the first closing drive element 810 will be pulled harder than the second closing drive element 814 while clamping. This causes the right-hand clamp 802 to move in the closing direction (i.e., Figure 8 The tension applied to the first closing drive element 810 (to the left in the middle) can also drive the left-hand clamp 804 to the left (which is the opening direction relative to this left-hand clamp 804).
[0093] Moving the end effector in the yaw direction while clamping may also result in inconsistent clamping performance. The reason for this is that in the non-moving case, both cables stretch the same amount. However, in the yaw case, one cable stretches more than the other. The case where the end effector does not move while clamping may be referred to as a "static" condition, and the case where the end effector is in motion while clamping may be referred to as a "dynamic" condition.
[0094] The control scheme discussed herein is capable of compensating for clamping variations under both static and dynamic conditions, as further explained elsewhere herein. Fig. 9 , which shows an example surgical robot system 900. In this example, the surgical robot system 900 includes two surgical robots 902 and 904 driven by a control unit 906. The control unit 906 receives information from an operator console 910 (such as, but not limited to, Figure 6 The control unit 906 receives inputs 908 from an operator console 600, including inputs from a first manual controller 912 and a second manual controller 914. The control unit 906 may receive other inputs from the operator console 910, such as foot pedal inputs, voice recognition inputs, gesture recognition inputs, eye recognition inputs, and the like. The control unit 906 also receives inputs 916 from the surgical robots 902, 904. These inputs include sensor data from position sensors and torque sensors located on the robot arm joints. The control unit 906 may receive other inputs 916 from each robot, such as force feedback, data from or about surgical instruments, and the like. The control unit 906 drives the robots 902, 904 in response to the inputs it receives from the robots 902, 904 and the operator console 910. The control unit 906 includes one or more processors 918 and a memory 920. The memory 920 stores software code in a non-transient manner, which software code may be executed by one or more processors 918 to control the drive. The control unit 906 may embody or include a clamping force controller. In Fig. 9 , the control unit 906 is shown to include a clamping force controller 922. In this example, the clamping force controller 922 includes a processor 918 and a memory 920.
[0095] Although Fig. 9 The exemplary surgical robot system 900 includes two surgical robots, but it will be apparent to those skilled in the art that the methods and techniques described herein are equally applicable to surgical robot systems having only one surgical robot and surgical robot systems having more than two surgical robots.
[0096] A possible solution to the above problem is to calibrate all the separate subsystems individually, and then modify the control parameters to compensate for the differences when these calibrated subsystems are brought together on the arm. However, this approach is undesirable because it not only means that calibration is required, but also means that these values need to be stored after calibration. These stored values then need to be communicated to the control system in some way and then used by the control system in the control of the subsystems. This approach is challenging because at the time of manufacturing, it is not known where each subsystem will end up or which other subsystem it will be used with. Moreover, this approach of carrying out the calibration process and then storing the calibration parameters may require additional setup steps for the surgical team, which is undesirable. Further, the differences in the clamping angles described above (for example, in the case of holding the needle at different positions along the length of the end effector) also make this approach more difficult. What may be needed is a comprehensive characterization of all components, rather than a (relatively simple) calibration. In addition, with this approach, the master-slave control relationship is fixed during the duration of the operation, and the system will not be able to properly address the problems caused by differences in the size of the objects being grasped.
[0097] The present inventors have realized that what is needed is an "on-the-fly" method for compensating for variability. Therefore, it is desirable to provide a control scheme that does not require:
[0098] Storing calibration parameters of each component at the time of manufacture;
[0099] Additional steps performed by the surgical team at setup or during the procedure; or
[0100] Understand the position of the jaws or the size of the object being grasped.
[0101] Logically, the point in time where these can be avoided is when grasping an object. Therefore, consider how to determine when it is appropriate for the instrument to grasp an object. There are several ways to achieve this. One method, which is currently the preferred method, is to use the required motor force (or torque). One of the following can also be used: clamping force, drive element tension, and visual servoing. More than one of these methods can be used together. For example, an exemplary method can use the required motor force and drive element tension to determine that an object is being grasped. Other combinations of two or more of these methods are also possible.
[0102] The control scheme presented herein is useful for any clamping instrument, such as a clamping instrument having multiple facing jaws that can be brought together to clamp an object and can be separated to release the clamp on the object. An example of such an instrument is a needle holder instrument. For the sake of completeness, it should be noted that the instrument can be in a clamping condition in which the jaws are in contact with each other. This may be because the instrument is clamping a very thin (and / or compressible) object, or because the jaws have been closed without an object between the jaws. The control scheme described herein is applicable regardless of whether the object is held between the jaws when the jaws are closed together. The control scheme is useful when the jaws encounter resistance when closing and a clamping force is applied between the jaws.
[0103] The preferred control scheme dynamically adjusts the required over-closure of the instrument when the instrument is clamped to account for changes in zeroing and / or stiffness of the mechanical system. The control scheme uses thresholds of required drive force units from the motor or actuator in the drive assembly that are controllable to achieve movement of the jaws of the instrument. The control scheme can "shear" the maximum over-closure or over-opening (e.g., a commanded negative jaw opening) value to correspond to the threshold force of the motor each time a jaw closing event / clamping event occurs. The control scheme is particularly useful in strong jaw closing or clamping events. For example, in this case, it is possible that the motor may reach saturation, or drive element stretching may occur.
[0104] The maximum over-opening is the maximum negative opening that can be requested. Physically, the jaws cannot open beyond 0 degrees, i.e., the jaws cannot physically have a negative opening. However, the desired opening (or simply "opening" as used herein) can be used as a measure of the required clamping force; that is, the opening of the jaws can be considered to correspond to a force on or between the jaws, such as a commanded force. A more negative desired opening can indicate a greater required clamping force. Note that in examples where an object such as a needle is clamped between the jaws, there will be some positive opening values below which the jaws cannot close. Thus, an over-close condition may be applied even in situations where the jaws have a positive opening.
[0105] When the jaws are estimated to be clamping something hard, the maximum over-opening may be limited to, for example, a minimum opening limit (which is a positive or negative opening as appropriate, which is the most negative opening that the control system may require). When the maximum required force threshold is met, the over-closing limit may be equal to the required opening of the jaws.
[0106] According to the technology discussed in this article, a clamping force controller for controlling the clamping force of an instrument in a surgical robot system can be provided. The clamping force controller can be located at Fig. 9. The clamping force controller 922 is suitably configured to control the movement of the jaws 802, 804 of the instrument 200 according to the desired opening between the jaws. The desired opening can be determined in response to input received at the manual controllers 912, 914. The desired opening can be determined at the control unit 906, for example, at the clamping force controller 922. The clamping force controller 922 is configured to determine the occurrence of a clamping event when the jaws 802, 804 are driven relative to each other in a closing direction. When the jaws are driven relative to each other in a closing direction, a clamping force can thereby be applied between the jaws. The clamping force controller 922 is configured to determine the desired opening between the jaws when it is determined that a clamping event has occurred. That is, when it is determined that a clamping event has occurred, the clamping force controller can determine the desired opening between the jaws when the clamping event occurs. The clamping force controller is configured to set the determined desired opening as the minimum opening limit of the jaws. This setting of the determined desired opening as the minimum opening limit for the jaws means that the jaws will not thereafter be controlled such that a more negative opening is required by the control system. The clamping force controller is configured to control the movement of the jaws using the minimum opening limit in order to control the clamping force applied by the jaws. In other words, controlling the movement of the jaws (or controlling the end effector) can be performed such that the control system does not require a clamping force greater than the clamping force at the time of the clamping event.
[0107] The clamping force controller 922 may be configured to determine the occurrence of a clamping event upon determining that any one or more of the following occurs:
[0108] • The clamping force between the jaws 802, 804 exceeds the clamping force threshold.
[0109] When the clamping force becomes greater than the clamping force threshold, the clamping force may be considered to exceed the clamping force threshold. The clamping force may be obtained based on measurements at the jaws, for example using one or more sensors arranged to sense the clamping force. The sensor may include a strain gauge. The sensor may be located at the jaws, or remote from the jaws, and configured to sense forces at the jaws, for example by sensing forces transmitted to the jaws. The sensor may sense deformation of components of the instrument, including, for example, deformation of components of the instrument other than the jaws.
[0110] • The required motor force (or torque) of a motor of a drive assembly for transmitting the drive force to one of the jaws exceeds a motor force threshold.
[0111] When the positive required motor force becomes greater than the motor force threshold (more positive), the required motor force can be considered to exceed the motor force threshold. Equivalently, the motor force in the closing direction can be defined as negative, in which case, when the negative required motor force becomes less than the motor force threshold (more negative), the required motor force can be considered to exceed the motor force threshold.
[0112] • An average required motor force (or torque) of a plurality of motors of a drive assembly for transmitting drive force to corresponding ones of the jaws exceeds an average motor force threshold.
[0113] The average required motor force may be calculated as the average of the individual required motor forces. The average required motor force may be considered to exceed the average motor force threshold when the positive average required motor force becomes greater than the average motor force threshold (more positive), or when the negative average required motor force becomes less than the average motor force threshold (more negative).
[0114] • The motor of a drive assembly used to transmit driving force to one of the jaws approaches or reaches saturation point.
[0115] The motor may reach a saturation point at which the motor can no longer increase force output. The motor may approach a saturation point at which the motor is within a predetermined proportion of the possible force output, such as at the saturation point where the motor supplies at least 95% of the possible motor output, or at least 90% of the possible motor output. Other set points for possible motor output may be selected as desired. In situations where force output may need to increase rapidly at relatively large forces, it may be appropriate to select a lower set point to avoid reaching a saturation point.
[0116] • The current through a motor of a drive assembly for transmitting a drive force to one of the jaws exceeds a current threshold.
[0117] The current through the motor can be considered to be indicative of the motor force output and / or representative of the motor saturation point.
[0118] • A drive element of the instrument, through which the drive force is transmitted to one of the jaws, approaches or reaches a physical limit of the drive element.
[0119] The drive element suitably comprises a flexible drive element, such as a cable. The drive element may comprise or be formed of metal or braided metal fibres. The drive element may comprise a rod. The physical limit of the drive element may be a tension in the drive element beyond which plastic deformation of the drive element occurs. The physical limit of the drive element may be a tension in the drive element beyond which the cable is susceptible to wear or breakage. The physical limit of the drive element may be a torsion in the drive element beyond which plastic deformation of the drive element occurs.
[0120] The tension in the drive element may be determined using one or more dynamometers. Suitably, a triple dynamometer is used. Dynamometer measurements may be susceptible to variation with environmental conditions such as temperature. In order to reduce environmental influences on the dynamometer measurements, suitable relative measurements of the dynamometer are used. Absolute measurements from the dynamometer may also be used, which may optionally be filtered, for example by a low pass filter.
[0121] • A physical limit of a component of the instrument (eg, an instrument end effector) is reached (or a threshold limit is reached or exceeded).
[0122] The component may include a clamp support component, such as a yoke and / or the end of a shaft in an end effector. The component may include an instrument shaft. In the event of a tension and / or torsion and / or deflection of the component exceeding a level that results in plastic deformation of the component, it may be considered that the physical limit of the component has been reached. A threshold limit may be set, such as for tension and / or torsion and / or deflection of the component, which is below the plastic deformation limit. When such a threshold limit is reached or exceeded, it may be determined that a clamping event has occurred. Setting the threshold limit to less than the plastic deformation limit enables undesired plastic deformation of the component to be avoided.
[0123] The clamping force controller may be configured to determine the occurrence of a clamping event based on a signal indicating one or more of the following:
[0124] ●The clamping force between the jaws.
[0125] When the signal indicates that the clamping force exceeds a clamping force threshold, a clamping event may be determined. The clamping force may be a commanded clamping force or a measured clamping force.
[0126] ●The required motor force of the motor.
[0127] A clamping event may be determined when the signal indicates that the required motor force exceeds a motor force threshold.
[0128] ●The average required motor force of multiple motors.
[0129] A clamping event may be determined when the signal indicates that the average required motor force exceeds an average motor force threshold.
[0130] • Motor saturation of a motor of a drive assembly for transmitting the driving force to one of the jaws.
[0131] A clamping event can be determined when the signal indicates that the motor is approaching or reaching the saturation point.
[0132] • Electric current through a motor of a drive assembly for transmitting a drive force to one of the jaws.
[0133] A clamping event may be determined when the signal indicates that the current through the motor exceeds a current threshold.
[0134] • Tension in the drive element of the instrument through which the drive force is transmitted to one of the jaws.
[0135] A clamping event may be determined when the signal indicates that the tension in the drive element approaches or reaches a physical limit of the drive element. For example, a clamping event may be determined when the signal indicates that the tension in the drive element exceeds a threshold tension.
[0136] The signal may include visual servoing based on an image of the instrument or derived from the visual servoing. Suitably, the image field of view includes the end effector of the instrument. This enables visual analysis of the jaws of the end effector, such as visual analysis of the position and movement of the jaws. In some embodiments, the signal may include visual servoing of an image of the manual controller 912 or derived from the visual servoing. In this case, the image field of view will appropriately include the manual controller forceps. This enables visual analysis of the forceps (e.g., position and movement) to be performed. Visual servoing may include analyzing visual feedback using, for example, visible light or infrared light. Visual servoing may include obtaining images using a thermal camera. Visual servoing appropriately includes applying image processing algorithms to images obtained of the instrument and / or the manual controller.
[0137] As the jaw closing movement is performed, resulting in a reduced opening between the jaws, the required motor force can be monitored. The required opening is also appropriately monitored. Optionally, the required motor force can be filtered, for example to remove noise. The filtering appropriately increases the signal-to-noise ratio of the signal indicating the required motor force. For example, the required motor force can be filtered using a low-pass filter. Once the threshold motor force or required motor force is reached, the required opening at this time is set to the maximum allowed over-closure (or maximum negative opening), such as a minimum opening limit. The minimum opening limit can be negative, for example, it can indicate an over-closure condition.
[0138] The clamping force controller is suitably configured to reset the minimum opening limit upon determining that any one or more of the following occurs:
[0139] The jaws are opened beyond the opening threshold.
[0140] The opening opening threshold is suitably an opening value indicating that the high force condition no longer exists. For example, the opening opening threshold can be defined based on a minimum opening limit. The opening opening threshold can be determined as the minimum opening limit plus a predetermined opening angle, such as 2 degrees, 5 degrees, or 10 degrees. The opening opening value can be a fixed value, such as a positive opening of 2 degrees, 5 degrees, 10 degrees, or 15 degrees. A higher opening angle can be selected. The opening opening angle can be selected based on the object that may be clamped by the instrument. For example, in the case of a needle of a given thickness to be clamped, the opening of the jaws when clamping the needle will depend on where the needle is clamped along the length of the jaws. The opening opening threshold can be set to be at an angle sufficient to release the needle, regardless of where the needle is held in the jaws.
[0141] ●The required opening exceeds the required opening threshold.
[0142] The desired opening threshold may take the values indicated above for the opening threshold.Other values may be selected for the desired opening threshold.
[0143] • The desired opening and / or the calculated or measured opening becomes positive.
[0144] • The clamping force applied between the jaws decreases beyond another clamping force threshold.
[0145] The clamping force may be a desired clamping force or a measured clamping force. In the event that the clamping force decreases beyond another clamping force threshold, this may indicate that the clamp is not clamping anything with sufficient force to cause the force changes discussed herein. Another clamping force threshold may be the same as the clamping force threshold at which a clamping event may be determined. Another clamping force threshold may be lower than the clamping force threshold. It may be considered that this method introduces hysteresis into the control system. The control system may thereby operate in a more stable manner.
[0146] ●The tension and / or torsion and / or deflection of a drive element or other component of the instrument is reduced beyond a reset threshold tension, a reset threshold torsion, or a reset threshold deflection, respectively.
[0147] In the case where the tension, torsion and / or deflection decreases beyond the corresponding threshold value, this can indicate that the clamp no longer applies a clamping force that is high enough to cause the change of force discussed herein. In the case where the tension, torsion and / or deflection decreases beyond the corresponding threshold value, this can indicate a reduction in stress / strain within the system. The reset threshold tension, reset threshold torsion and / or reset threshold deflection can be the same as the threshold limit of tension, torsion and / or deflection, respectively (a clamping event can be determined at this threshold limit). The reset threshold may be lower than the threshold limit. It can be considered that this method introduces hysteresis into the control system. The control system can thus operate in a more stable manner.
[0148] • The jaws move relative to each other in an opening direction at a speed above an opening speed threshold.
[0149] The movement of the jaws relative to each other in the opening direction can indicate a desired relaxation of the grip. The movement of the jaws can be determined, for example, by visual means and / or by tracking the position of the instrument drive mechanism. The opening speed threshold can include a speed and a time for which the speed is maintained. For example, the opening speed threshold can include a speed greater than 0 rad / s that is maintained for a period of time greater than t min Therefore, when the positive velocity appears to be greater than t min The opening speed threshold can be met when the time is up.
[0150] • The commanded jaw movement in the opening direction exceeds the threshold commanded jaw movement.
[0151] Even if the clamping is relaxed, the jaws may not move. It is possible that the jaws remain stationary, but the force between the jaws is reduced. Therefore, in the case where the drive mechanism of the drive assembly (and / or the instrument drive system to which the drive assembly is coupled) moves in the opening direction, for example in the case where the drive mechanism moves at least 0.5 mm in the opening direction, a reduction in the jaw clamping force can be determined.
[0152] • The change in force per unit displacement exceeds a predetermined value.
[0153] The force per unit displacement may provide a measure of the stiffness of the system. As the jaws begin to open, determining changes in the force per unit displacement may indicate, for example, the release of elastic energy in the drive assembly.
[0154] • Reduction of clamping force commanded by the surgeon.
[0155] It should be noted that the present technology is useful for providing a stable clamping force in a position control scheme, but it should also be noted that it would be possible to apply the present technology to a force control scheme. For example, for a force controller with a force sensor, such as at a jaw, it may be useful to determine high force events and clamping thresholds to compensate for build variations.
[0156] ●Scheduled time t reset It's over.
[0157] • An indication of the end of the clamping operation is received.
[0158] The instructions may be provided by the surgeon. The instructions may be determined based on the movement of an instrument of the robotic system, such as the approach of a second instrument to remove a needle from a first instrument.
[0159] The concepts of static clamping and dynamic clamping have been introduced elsewhere in this article. Static clamping involves conditions in which the end effector does not move (or does not move significantly) in the yaw direction while clamping. Dynamic clamping involves conditions in which the end effector moves in the yaw direction while clamping. Under dynamic conditions, yaw tracking errors may occur. In order to achieve more accurate yaw tracking, the control conditions can be relaxed under dynamic conditions, such as allowing different minimum opening limits of the clamp. The minimum opening limit of the clamp can be increased (made more correct). This means that the clamp will clamp with slightly less force, but it also achieves more consistent clamping. This modification can help to address the stretching of the drive element and thereby improve accuracy. In some embodiments, the minimum opening limit in the dynamic case differs by approximately 25% compared to the minimum opening limit in the static case. The opening is appropriately indicated in radians and can be in a range extending to -2.5rad. For static conditions, the minimum opening limit of the clamp can be in the range of -2.5rad to -2rad. For dynamic cases, the minimum opening limit may be in the range of -2 rad to -1.5 rad. As will be understood from this specification, while the opening may imply the opening angle between the jaws, it also indicates the commanded force applied at the jaws. In some embodiments, the opening may therefore be specified in other units, such as in terms of force (N) or tension.
[0160] By detecting that the two motors of the drive assembly used to drive the jaws of the instrument require a greater force (i.e., when the required motor force exceeds a static condition motor force threshold, for example a certain proportion of the total possible clamping force, such as 85% of the total possible clamping force; this proportion can be selected as desired, but will appropriately take into account the motor ratings under specific higher temperature and humidity conditions expected during surgery; a safety factor can be applied to the proportion. This proportion can be determined based on the life conditions of the instrument (for example, a lower ratio will generally result in a lower clamping force output, but will ensure an extended service life of the instrument). The proportion can be determined empirically as a value at which the force delivered by the instrument begins to become unstable). In the event that both motors require a greater force, it is possible that the two jaws are pulled with force in the corresponding closing directions. The static condition motor force can be in the range of -150 effective force units to -200 effective force units, for example approximately -180 effective force units. An "effective force unit" can correspond to a Newton. The force measured in effective force units can be a force corresponding to a known current that produces a force (or torque) through the drive assembly motor. A negative force is used here because the jaws are closing. In determining the occurrence of a clamping event, static conditions may be identifiable.
[0161] The dynamic condition can be identified by detecting the yaw tracking error. The yaw difference can be calculated, for example, at or by the clamping force controller 922 as the difference between the desired yaw angle of the instrument end effector and the measured yaw angle of the end effector. It can be determined that the instrument is in a dynamic condition in which the yaw difference is greater than a dynamic yaw threshold. The dynamic yaw threshold can be set to any desired value, for example in the range of 0.01 rad to 0.1 rad, such as 0.05 rad. In the event that the yaw difference exceeds the dynamic yaw threshold, it is possible that the end effector moves (or is commanded to move) in the yaw direction while clamping.
[0162] A dynamic condition may also be identified by determining (e.g., at or using a clamping force controller) that the yaw velocity (or commanded yaw velocity) of the end effector is greater than a dynamic yaw velocity threshold. The dynamic yaw velocity threshold is suitably in the range of 0.3 rad / sec to 1.7 rad / sec, or in the range of 0.5 rad / sec to 1.5 rad / sec, such as approximately 1 rad / sec.
[0163] A dynamic condition can also be identified by determining (e.g., at or using a clamping force controller) that the required motor force of one of the plurality of motors is greater than a motor force threshold, and the required motor force of another of the plurality of motors is less than a motor force threshold, and the difference between the two required motor forces is greater than a predetermined proportional difference. In an example, a static condition can be determined when the average required motor force exceeds -180 effective force units. In a stationary state, the two jaws are pulled hard. In a dynamic condition, one jaw is pulled harder than the other jaw. This can be identified by determining that the required motor force to drive one jaw is, for example, more than 1.5 times, more than 2 times, or more than 3 times the required motor force to drive the other jaw.
[0164] The dynamic condition can be identified by determining (e.g., at or using a clamping force controller) that the required motor force of one of the plurality of motors acts in the same direction as the required motor force of another of the plurality of motors. For example, it can be determined that the right-hand jaw is moving to the left in the yaw direction (in the closing direction of this jaw) and the left-hand jaw is also moving to the left in the yaw direction (in the opening direction of this jaw). Whether the jaws are open or closed relative to each other will depend on the relative motor forces driving each jaw, or on the relative jaw speeds. In this example, where the right-hand jaw is driven by a greater motor force (or at a greater speed) than the left-hand jaw, the jaw will close. Where the right-hand jaw is driven by a lesser motor force (or at a slower speed) than the left-hand jaw, the jaw will open.
[0165] In some embodiments, the minimum open limit may be increased (corrected) in the event that conditions indicating a yaw tracking error are met. Correcting the minimum open limit in this manner may have the effect of relaxing the clamping force applied by the end effector. Correcting the minimum open limit may enable a greater yaw movement of the end effector. This greater yaw movement may be achieved by relaxing the restrictions caused by the minimum open limit in the control of the end effector. The minimum open limit may be increased by a predetermined amount (e.g., by 25%, or another suitable amount, which may depend on the characteristics of the system and / or on the yaw tracking error), or may be gradually increased until a new clamping event is determined.
[0166] Suitably, the minimum opening limit does not increase beyond the opening value corresponding to the minimum clamping force threshold, thereby maintaining the minimum clamping force between the jaws. This means that the clamping can be maintained and an object (such as a needle) held between the jaws will not accidentally fall or release.
[0167] If certain conditions are met, for example indicating a yaw tracking error, the minimum opening limit can be corrected (i.e., the clamping force can be relaxed). These conditions include:
[0168] • Establish a yaw tracking error (e.g., a yaw tracking error of at least 0.05 rad).
[0169] The absolute value of the commanded yaw rate is higher than a given value, for example 1 rad / sec.
[0170] The minimum required (negative) motor force (or filtered required motor force) of a motor or actuator in the drive assembly is less than the required motor force (or filtered required motor force) indicating a clamping event. This may mean that one of the drive force or motor is approaching saturation.
[0171] Fig.10 An example of a change in the over-closed state (e.g., a change in the minimum open limit) is shown when the control system transitions from static control to dynamic control, i.e., when the end effector transitions to move in the yaw direction. Curve 1002 represents the initial minimum open limit (under static conditions). With dynamic conditions taken into account, the minimum open limit may change to become more positive. This is indicated in the upper curve 1004, which shows a change to a more positive minimum open limit (or target over-closed value) after the transition to dynamic control (in this example, this occurs just before 2 seconds as indicated on the x-axis).
[0172] In some embodiments, two motors or actuators of the drive assembly control the movement of the jaws to control both opening and yaw. In some cases, when the instrument is at the yaw limit and further opening is required, opening can take precedence over yaw. That is, in order to achieve the desired opening, the control system can accept an error (or a larger error) in yaw. Since the desired position of the motor or actuator driving the jaws is affected by the desired yaw and the desired opening, the more clamping is required, the greater the yaw error that may result.
[0173] In one approach, to minimize yaw tracking error, a gain that depends on the opening may be applied to a desired yaw angle (θy). This has the effect of increasing the desired yaw angle with increasing opening. Thus, a larger yaw angle is desired, which may more closely match the yaw angle determined based on the position of the motor when the motor is controlling the desired opening. For relatively large (and negative) desired openings, a gain (β) greater than 1 may be used, which may result in an increased yaw angle (θ′y). By increasing the yaw angle in proportion to the desired opening, the effect of requiring a larger negative opening on the yaw tracking error may be at least partially offset. At least partially offsetting this effect helps avoid unwanted and / or unexpected motion in which the control system must catch up to the commanded motion. In an example application of this approach, the calculations performed are as follows:
[0174] θ′ y =βθ y
[0175]
[0176] For γ=0.055rad -1 .
[0177] θ S Indicates the required opening angle.
[0178] Each joint clamp angle (θ y1 and θ y2 ) can then be calculated as:
[0179]
[0180] As discussed herein, force variability may be due to manufacturing differences in one or more subsystems. Force variability may also result from assumptions about interface calibration (e.g., interface calibration of the interface between a drive assembly and the instrument). Variability in force may result in poor clamping force repeatability from a single drive assembly (e.g., from one or two motors of a drive assembly configured to actuate the jaws), and / or poor clamping force repeatability across multiple drive assemblies, and / or greater than expected forces applied to an instrument such as a needle holder that may result in premature failure in the instrument. It is important in instrument control to carefully control drive assembly motor current saturation and peak output force to improve dynamic performance and instrument life.
[0181] As will now be described, further optional modifications to the control scheme implemented by the gripping force controller (or elsewhere in the control system) can compensate for differences in calibration between different robot interfaces. The interfaces may be calibrated slightly differently, or their calibration may differ from their actual performance. Therefore, in specific use cases, it may be important to tune the relationship between the force delivered by the motor and the desired force.
[0182] A dynamometer force reading, such as a triple dynamometer force reading, can be used, which enables the tension in a drive element (such as a cable) to be measured. Such force readings may have thermal drift issues. Therefore, it is useful if a differential reading is considered rather than an absolute pressure reading. However, an absolute pressure reading can still be used. In the case of using an absolute force reading, the absolute force reading can be filtered. The absolute force reading can be filtered by a low pass filter. It is preferred to use a differential force reading to improve accuracy. The differential force reading can also be filtered, for example using a low pass filter.
[0183] The term "motor force" is used herein. In the examples discussed herein, the instrument drive force is linear. In general, the output from the motor can be described as torque. It should be understood that references to motor force herein also apply to motor torque.
[0184] As described herein, the transition to a state in which a minimum opening limit is set (i.e., upon detection of a clamping event) may be controlled based on minimum required drive forces, which may be referred to as m1 and m2, on a drive assembly motor or actuator configured to drive the jaws in the yaw direction (which may optionally be low pass filtered). The minimum required drive force may be expressed as (min(τ m1 ,τ m2 )). In determining (min(τ m1 ,τ m2 ))A transition to this state can occur when the effective force is below a threshold (e.g., -180 effective force units) (e.g., more negative than the threshold).
[0185] In some embodiments, there may be a second condition which, if met, will also result in entering this state in which the minimum opening limit is set. The second condition is as follows. During the closing movement of the jaws:
[0186] 1. The input force F (e.g., triple dynamometer force reading) (F = f m1 +f m2 ) and the measured device opening (S) are set as the baseline (e.g., to baseline force and baseline opening, respectively):
[0187] a. Use input force (F = f m1 +f m2 ) first exceeds the threshold. This provides a measure of the resistance to closing the jaws. A greater stiffness would indicate that the jaws are closed and the cable is being stretched. This condition can be expressed as:
[0188] dF / dS>k S
[0189] where k S is a predefined value.
[0190] b. The jaws of the instrument are moving at a rate greater than the threshold rate (V S ) A faster rate of closing, where both the opening and the threshold are negative. This indicates how much the surgeon is willing to clamp. When the surgeon wants to clamp harder, the forceps will close quickly, and the commanded opening will also decrease quickly. This condition can be expressed as:
[0191] dS / dt <V S
[0192] 2. If the change in input force relative to the baseline force exceeds the threshold f thresh ,
[0193] ΔF <f thresh
[0194] (In the event that the change in force is negative due to being in the closing direction), the system can be configured to enter a state in which a minimum opening limit is set. This can indicate that the tension in the drive element is at an expected value, such as a threshold indicating that clamping force control is desired, or that the tension matches the expected tension for the required clamping force.
[0195] When the jaws are opened beyond the baseline opening, the baseline force is suitably reset. When the jaws are opened beyond zero opening, the baseline force may be reset. Resetting the baseline force may include removing the baseline force (so that the baseline force value is no longer present in the system) or setting the baseline force to zero or another predetermined or user-selectable value.
[0196] Conceptually, the modified control scheme using this second condition can be thought of as having two competing terms to determine the overclosure limit of the instrument. Fig.11 This aspect is schematically represented. It is desirable to set the differential force limit 1102 (e.g., as determined using the second condition) so that it is triggered more frequently than the drive force limit 1104 (e.g., as determined using the required motor force or torque, as discussed elsewhere herein; measurement of drive element tension, such as using a triple dynamometer reading, may additionally or alternatively be used to determine the drive force limit). This is because the drive force limit may act as a stop to help ensure good dynamic performance by preventing motor saturation, while the differential force limit may more accurately control the differential force input to the instrument, and therefore control the tension and clamping force generated.
[0197] The control schemes discussed herein, particularly the modified control schemes, may provide the following benefits for controlling a clamping instrument such as a needle holder.
[0198] Drive element protection: A limit on the maximum change in force relative to the baseline force should help prevent excessive tension from being applied to the drive element. It can also offset any temporal or spatial variability in the interface calibration, such as drift in the motor output, which may result in a force being applied that is different from the required force.
[0199] • Repeatable and reproducible clamping force: Since clamping force is proportional to the change in force relative to a baseline force, the control scheme can help ensure that the drive assembly motor more consistently delivers a fixed drive force to the instrument, resulting in a more consistent clamping force.
[0200] = Equivalent dynamic performance: Because in the modified control scheme, the existing drive force entry condition is maintained, it will act as a stop to help ensure that motor saturation is avoided. Therefore, this helps to ensure that the "hold while yaw" performance is maintained.
[0201] The control schemes and clamping force controllers discussed herein help ensure that consistent clamping performance can be achieved using different instruments and / or using different drive assemblies. According to the present technology, such consistent performance can be achieved without having to perform additional calibration actions.
[0202] The benefits of the techniques discussed in this article are Fig.12 Shown in. Fig.12The clamping force variation 1202 of a conventional system in which the present control scheme is not implemented, the clamping force variation 1204 of a first system in which static control is implemented, and the clamping force variation 1206 of a second system in which dynamic control is implemented are shown. As can be seen, the use of the present control scheme results in an improvement in the applied clamping force by reducing the clamping force variation. Using a dynamic control scheme provides additional improvements over using a static control scheme.
[0203] Now refer to Fig.13 The method described herein is discussed. The method includes controlling movement of the jaws based on a desired opening between the jaws 1302. The method also includes determining the occurrence of a clamping event when the jaws are driven relative to each other in a closing direction so as to apply a clamping force between the jaws 1304. The method also includes determining a desired opening between the jaws when determining the occurrence of a clamping event 1306. The method also includes setting the determined desired opening as a minimum opening limit of the jaws 1308. The method includes controlling movement of the jaws using the minimum opening limit so as to control the clamping force applied by the jaws 1310.
[0204] Instead of or in addition to determining a desired opening between the jaws upon determining the occurrence of a clamping event, the method may include determining a motor position, such as a motor position of a drive motor that controls movement of the jaws.
[0205] It should be noted that the present technology can be applied to both position control and force control. In the context of a force controller, the method can include, for example, controlling the force applied by the jaws of the instrument; determining the occurrence of a clamping event; determining a desired and / or measured force between the jaws (and / or tension in one or more drive elements); setting the determined force as a maximum desired force limit; and using the determined maximum desired force limit to control the force applied by the jaws.
[0206] In some embodiments, a combination of position control and force control may be used. An example method of such an embodiment includes: controlling movement of the jaws 1302; determining the occurrence of a clamping event 1304; determining a desired and / or measured force between the jaws (and / or tension in one or more drive elements); setting the determined force as a maximum desired force limit; and controlling movement of the jaws using the maximum desired force limit to control the clamping force applied by the jaws.
[0207] Reference now Fig.14, which illustrates various components of an exemplary computing-based device 1400 that can be implemented as any form of computing and / or electronic device and in which embodiments of the methods and modification systems described herein can be implemented. The computing-based device 1400 includes one or more processors 1402, which can be microprocessors, controllers, or any other suitable type of processor for processing computer-executable instructions. In some examples, such as where a system-on-chip architecture is used, the processor 1402 may include one or more fixed function blocks (also referred to as accelerators) that implement a portion of the method of modifying a data stream in hardware (rather than software or firmware). Platform software including an operating system 1404 or any other suitable platform software may be provided at the computing-based device to implement application software to be executed on the device, such as implementing Fig.13 The method of software 1405 is software.
[0208] Computer executable instructions can be provided using any computer-readable medium accessible by the computing-based device 1400. Computer-readable media may include, for example, computer storage media, such as memory 1406 and communication media. Computer storage media such as memory 1406 (i.e., non-temporary machine-readable media) include volatile and non-volatile, removable and non-removable media implemented by any method or technology for storing information such as computer-readable instructions, data structures, program modules or other data. Computer storage media include, but are not limited to, RAM, ROM, EPROM, EEPROM, flash memory or other storage technology, CD-ROM, digital versatile disk (DVD) or other optical storage device, cassette, tape, disk storage device or other magnetic storage device, or any other non-transmission medium that can be used to store information for access by computing-based devices. In contrast, communication media can include computer-readable instructions, data structures, program modules or other data in a modulated data signal such as a carrier wave or other transmission mechanism. As defined herein, computer storage media does not include communication media. Although computer storage media (i.e., non-transitory machine-readable media, such as memory 1406) are shown within the computing-based device 1400, it will be understood that the storage may be distributed or remotely located and accessed via a network or other communications link (e.g., using communications interface 1408).
[0209] The computing-based device 1400 also includes an input / output controller 1410 arranged to output display information to a display device 1412, which can be separated from or integrated with the computing-based device 1400. The display information can provide a graphical user interface. The input / output controller 1410 is also arranged to receive and process input from one or more devices, such as a user input device 1414 (e.g., a mouse or keyboard). This user input can be used to initiate verification. In an embodiment, if the display device 1412 is a touch-sensitive display device, it can also serve as a user input device 1414. The input / output controller 1410 can also output data to a device other than the display device, such as a locally connected printing device (not shown).
[0210] In the above description, for ease of explanation, the actions taken by the system are divided into functional blocks or modules. In practice, two or more of these blocks can be combined in the architecture. Functions can also be divided into different functional blocks.
[0211] The present technology has been described in the context of surgical robotic systems, but at least some of the features described are not limited to such systems, but may be more generally applicable to robotic systems. In some examples, the present technology may be applied to remotely operated robotic systems. Some examples of situations in which the present technology may be useful include those in which a "snake-like" robot is utilized for exploration, investigation, or repair. In the case of a surgical robot, the end effector may be a surgical tool, such as a scissor, a surgical cutter, a surgical forceps, or a cauterizer.
[0212] Robotic systems can include manufacturing systems, such as vehicle manufacturing systems, parts handling systems, laboratory systems, and manipulators, such as manipulators for hazardous materials or surgical manipulators.
[0213] Applicants hereby independently disclose each individual feature described herein and any combination of two or more such features, as long as these features or combinations can be implemented based on the present specification as a whole according to the common knowledge of those skilled in the art, regardless of whether such features or feature combinations solve any problems disclosed herein, and do not limit the scope of the claims. Applicants point out that various aspects of the present invention may consist of any such single feature or feature combination. In view of the above description, it will be apparent to those skilled in the art that various modifications may be made within the scope of the present invention.
Claims
1. A clamping force controller for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly for transmitting a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the clamping force controller being configured to: controlling movement of the jaws according to a desired opening between the jaws; determining an occurrence of a clamping event when the jaws are driven relative to each other in the closing direction so as to apply a clamping force between the jaws; determining a desired opening between said jaws upon determining said occurrence of said clamping event; setting the determined desired opening as a minimum opening limit of the jaws; as well as Movement of the jaws is controlled using the minimum opening limit to control the clamping force applied by the jaws.
2. The clamping force controller according to claim 1, wherein the clamping force controller is configured to determine the occurrence of the clamping event when any one or more of the following occurs: The clamping force between the jaws exceeds a clamping force threshold; a required motor force of a motor of the drive assembly for transmitting a drive force to one of the jaws exceeds a motor force threshold; an average required motor force of a plurality of motors of the drive assembly for transmitting drive force to corresponding ones of the jaws exceeds an average motor force threshold; the motor of the drive assembly for transmitting driving force to one of the jaws approaches or reaches a saturation point; a current through the motor of the drive assembly for transmitting a drive force to one of the jaws exceeds a current threshold; a drive element of the instrument, through which a drive force is transmitted to one of the jaws, approaches or reaches a physical limit of the drive element; as well as The physical limits of the components of the device are reached.
3. The clamping force controller of claim 2, configured to determine the occurrence of the clamping event based on a signal indicating one or more of: said clamping force between said jaws; the required motor force of the motor; the average required motor force of the plurality of motors; motor saturation of the motor of the drive assembly for transmitting drive force to one of the jaws; an electric current through the motor of the drive assembly for transmitting a driving force to one of the jaws; and A tensioning force of the instrument, by which a driving force is transmitted to a drive element of one of the jaws.
4. The clamping force controller according to claim 3, in: The signal comprises or is derived from visual servoing based on an image of the instrument; and / or The clamping force controller is configured to filter the signal and determine the occurrence of the clamping event based on the filtered signal.
5. A clamping force controller according to any preceding claim, wherein the minimum opening limit is a negative opening.
6. A clamping force controller according to any preceding claim, configured to reset the minimum opening limit upon determining that any one or more of the following occurs: The jaws are opened beyond an opening threshold; The required opening exceeds a required opening threshold; The desired opening becomes positive; The measured opening becomes positive; the clamping force applied between the jaws is reduced beyond another clamping force threshold; the tension of a drive element or other component of the device decreases beyond a reset threshold tension; a reduction in torsion of a drive element or other component of the instrument beyond a reset threshold torsion; a reduction in deflection of a drive element or other component of the instrument beyond a reset threshold deflection; the jaws moving relative to each other in the opening direction at a speed above an opening speed threshold; the commanded jaw movement in the opening direction exceeds a threshold commanded jaw movement; a change in force per unit displacement exceeding a predetermined value; a reduction in clamping force commanded by said surgeon; After a predetermined time t reset ;as well as An indication of the end of the clamping operation is received.
7. A clamping force controller according to any one of claims 2 to 6, configured to determine that the instrument end effector is in a static condition in which the average required motor force exceeds the static condition motor force.
8. The clamping force controller according to claim 7, in: determining that the instrument end effector is in a static condition when determining the occurrence of the clamping event; and / or The static condition motor force is -180 effective force units, and the average required motor force exceeds the value when the average required motor force becomes more negative than the value.
9. A clamping force controller according to any preceding claim, configured to: determining a yaw difference value based on a difference between a desired yaw angle of an end effector of the instrument and a measured yaw angle of the end effector of the instrument; and It is determined that the instrument end effector is in a dynamic condition in which the yaw difference value is determined to be greater than a dynamic yaw value.
10. A clamping force controller according to any one of the preceding claims, configured to determine that the instrument end effector is in a dynamic condition in which a yaw velocity is determined to be greater than a dynamic yaw velocity value.
11. A clamping force controller according to any one of claims 2 to 10, wherein the clamping force controller is configured to determine that the instrument end effector is in a dynamic condition in which the required motor force of one of the multiple motors is greater than the motor force threshold and the required motor force of another motor of the multiple motors is less than the motor force threshold. 12 . The clamping force controller according to claim 9 , wherein when it is determined that the instrument end effector is in a dynamic state, the minimum opening limit of the jaw is corrected.
13. The clamping force controller of claim 12, wherein the minimum opening limit does not increase beyond an opening value corresponding to a minimum clamping force threshold value, thereby maintaining a minimum clamping force between the jaws.
14. A clamping force controller according to any one of claims 9 to 13, wherein a splay-dependent gain is applied to the desired yaw angle.
15. A clamping force controller according to any preceding claim, configured to: Determine the resultant force F on the drive element for driving each jaw; determining the rate of change of the resultant force F with the opening S of the jaws; determining a rate of change of the opening S of the jaws over time t; The determined rate of change of the resultant force exceeds a predetermined constant k S and the determined rate of change of the opening of the jaws exceeds another predetermined constant V S , set the instantaneous resultant force to the baseline force, and set the instantaneous opening to the baseline opening.
16. The clamping force controller of claim 15, configured to determine a change in a resultant force relative to the baseline force, and to determine the occurrence of the clamping event when the change in the determined resultant force exceeds a threshold force value.
17. A clamping force controller according to claim 15 or claim 16, configured to reset the baseline force upon determining that the opening of the jaws increases beyond the baseline opening and / or increases to a positive opening.
18. A method for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly being used to transmit a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the method include: controlling movement of the jaws according to a desired opening between the jaws; determining an occurrence of a clamping event when the jaws are driven relative to each other in the closing direction so as to apply a clamping force between the jaws; determining a desired opening between said jaws upon determining said occurrence of said clamping event; setting the determined desired opening as a minimum opening limit of the jaws; as well as Movement of the jaws is controlled using the minimum opening limit to control the clamping force applied by the jaws.
19. A clamping force controller for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly for transmitting a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction to release the clamped object, the clamping force controller being configured to: controlling the force applied between the jaws according to a desired force; determining an occurrence of a clamping event when the jaws are driven relative to each other in the closing direction so as to apply a clamping force between the jaws; determining an indication of a desired force between said jaws upon determining said occurrence of said clamping event; setting the determined required force as a maximum required force limit for the jaws; as well as The maximum desired force limit is used to control the force applied between the jaws in order to control the clamping force applied by the jaws.
20. A method for controlling the clamping force of an instrument in a surgical robot system, the surgical robot system comprising a robot having a base and an arm extending from the base to a drive assembly for engaging with the instrument, the arm comprising a plurality of joints by which the configuration of the arm can be changed, the instrument having an end effector comprising a plurality of jaws, and the drive assembly being used to transmit a drive force to the plurality of jaws of the instrument to drive the jaws relative to each other in a closing direction so as to clamp an object between the jaws, and to drive the jaws relative to each other in an opening direction so as to release the clamped object, the method include: controlling the force applied between the jaws according to a desired force; determining an occurrence of a clamping event when the jaws are driven relative to each other in the closing direction so as to apply a clamping force between the jaws; determining an indication of a desired force between said jaws upon determining said occurrence of said clamping event; setting the determined required force as a maximum required force limit for the jaws; as well as The maximum desired force limit is used to control the force applied between the jaws in order to control the clamping force applied by the jaws.
