Robotic surgical systems have been used in minimally invasive medical procedures. During a medical procedure, the robotic surgical system is controlled by a surgeon interfacing with a user interface. The user interface allows the surgeon to manipulate an end effector of a surgical instrument that acts on a patient. The user interface includes an input controller or handle that is moveable by the surgeon to control the robotic surgical system.
Robotic surgical systems typically use a scaling factor to scale down the motions of the hands of a surgeon to determine the desired position of the end effector within the patient so that the surgeon can more precisely move the end effector inside the patient.
During a surgical procedure, it may be desirable to increase the precision of movements of the end effector within the patient. Movements of the end effector may be controlled by an Instrument Drive Unit (IDU) of a surgical robot. Some movements of the IDUs are controlled by motors or actuators that use torque sensors as a feedback mechanism disposed within the IDU.
During manufacturing of IDUs there may be small variations in the readings of torque sensors. The variations can be related to the torque sensors and/or the assembly of the IDU. The variations may be in a zero or offset of the torque sensor, e.g., when there is no load on the torque sensor. In addition, there can be variations in the gain of the torque sensors.
There is a need for methods for calibrating torque sensors of IDUs such that the movements of end effectors secured to the IDU can be precisely controlled.
In an aspect of the present disclosure, a method of calibrating a torque sensor for a motor with a controller includes determining a gain of the torque sensor, zeroing a torque reading of the torque sensor, accelerating the motor at a known rate, and determining an inertia of the motor in response to accelerating the motor. Zeroing the torque reading occurs when the motor is in an unloaded and unactivated condition and accelerating the motor occurs when the motor is in an unloaded condition.
In aspects, determining the gain of the torque sensor includes interrogating a memory chip of the torque sensor itself. Accelerating the motor at the known rate may include measuring a position of the motor with a position sensor.
In some aspects, the method includes activating another motor with the motor in the unactivated condition and determining a cross talk torque of the torque sensor in response to activating the other motor.
In another aspect of the present disclosure, a method of calibrating torque sensors of an IDU with a controller with each toque sensor associated with a respective motor of the IDU includes determining a gain of each of the torque sensors, zeroing a torque reading of each of the torque sensors when each of the motors is in an unloaded and unactivated condition, and determining an inertia of each of the motors. Determining the inertia of each of the motors includes accelerating a respective motor at a known rate in an unloaded condition with each of the other motors in an unloaded and unactivated condition, measuring a torque of the respective motor with a toque sensor associated with the respective motor, and determining the inertia of the respective motor from the measured torque and the known rate of acceleration.
In aspects, determining the inertia of each of the motors includes determining a cross talk torque of each torque sensor not associated with the respective motor by measuring a torque in response to accelerating the respective motor. The method may include creating a cross talk matrix includes a correction factor for each of the torque sensors for each of the motors of the IDU.
In some aspects, determining the gain of each of the torque sensors includes interrogating a memory chip of each of the torque sensors. Accelerating the respective motor at the known rate may include measuring a position of the respective motor with a position sensor associated with the respective motor.
In another aspect of the present disclosure, a method of calibrating torque sensors of an IDU with a controller is disclosed. The IDU includes a first torque sensor that is associated with a first motor, a second torque sensor that is associated with a second motor, a third torque sensor that is associated with a third motor, and a fourth torque sensor that is associated with a fourth motor. The method includes determining a gain of each of the first, second, third, and fourth torque sensors, zeroing a torque reading of each of the first, second, third, and fourth torque sensors when each of the first, second, third, and fourth torque motors is in an unloaded and unactivated condition, and determining an inertia of the first motor. Determining the inertia of the first motor includes accelerating the first motor at a first known rate in an unloaded condition with each of the second, third, and fourth motors in an unloaded and unactivated condition, measuring a toque of the first motor with the first torque sensor, and determining the inertia of the first motor from the torque measured by the first torque sensor and the first known rate of acceleration.
In aspects, the method includes determining an inertia of the second motor, determining an inertia of the third motor, and determining an inertia of the fourth motor. Determining the inertia of the second motor includes accelerating the second motor at a second known rate in an unloaded condition with each of the first, third, and fourth motors in an unloaded and unactivated condition, measuring a torque of the second motor with the second torque sensor, and determining the inertia of the second motor from the torque measured by the second torque sensor and the second known rate of acceleration. Determining an inertia of the third motor includes accelerating the third motor at a third known rate in an unloaded condition with each of the first, second, and fourth motors in an unloaded and unactivated condition, measuring a torque of the third motor with the third torque sensor, and determining the inertia of the third motor from the torque measured by the third torque sensor and the third known rate of acceleration. Determining the inertia of the fourth motor includes accelerating the fourth motor at a fourth known rate in an unloaded condition with each of the first, second, and third motors in an unloaded and unactivated condition, measuring a torque of the fourth motor with the fourth torque sensor, and determining the inertia of the fourth motor from the torque measured by the fourth torque sensor and the fourth known rate of acceleration.
In some aspects, determining the inertia of the first motor includes determining a cross talk torque of the second, third, and fourth torque sensors in response to accelerating the first motor. Determining the inertia of the second motor may include determining a cross talk torque of the first, third, and fourth torque sensors in response to accelerating the second motor. Determining the inertia of the third motor may include determining a cross talk torque of the first, second, and fourth torque sensors in response to accelerating the third motor. Determining the inertia of the fourth motor may include determining a cross talk torque of the first, second, and third torque sensors in response to accelerating the fourth motor.
In certain aspects, the method includes creating a cross talk matrix which includes a correction factor for each of the first, second, third, and fourth torque sensors for torque from each of the first, second, third, and fourth motors. The method may include utilizing the cross talk matrix during a surgical procedure to correct torque of at least one of the first, second, third, or fourth motors.
In particular aspects, determining the inertia of the first motor includes determining a cross talk toque of the second, third, and fourth torque sensors in response to accelerating the first motor. Determining the gain of the first, second, third, and fourth torque sensors may include interrogating a memory chip of reach of the first, second, third, and fourth torque sensors. Accelerating the first motor at the known rate may include measuring a position of the first motor with a position sensor associated with the first motor.
Further, to the extent consistent, any of the aspects described herein may be used in conjunction with any or all of the other aspects described herein.
Various aspects of the present disclosure are described hereinbelow with reference to the drawings, which are incorporated in and constitute a part of this specification, wherein:
Embodiments of the present disclosure are now described in detail with reference to the drawings in which like reference numerals designate identical or corresponding elements in each of the several views. As used herein, the term “clinician” refers to a doctor, a nurse, or any other care provider and may include support personnel. Throughout this description, the term “proximal” refers to the portion of the device or component thereof that is closer to the clinician or surgical robot and the term “distal” refers to the portion of the device or component thereof that is farther from the clinician or surgical robot. In addition, as used herein the term “pose” is understood to mean a position and orientation of an object in space. Further, as used herein the term “neutral” is understood to mean non-scaled.
This disclosure generally relates to a method of calibrating torque transducers of an instrument drive unit (IDU) of a surgical robot. The method includes accounting for differences in gain of each torque sensor of the IDU, accounting for the temperature effects of each torque sensor of the IDU, zeroing each torque sensor, determining the inertia of each motor of the IDU, and accounting for the cross-talk of each motor with each of the torque sensors of the IDU. By calibrating torque transducers of the IDU before a surgical procedure, movements of tools attached to the IDU may be more accurately controlled during a surgical procedure which may result in improved surgical outcomes for patients and/or reduce the time and/or costs of a surgical procedure.
Referring to
The user console 40 includes a display device 44 which is configured to display three-dimensional images. The display device 44 displays three-dimensional images of the surgical site “S” which may include data captured by imaging devices 16 positioned on the ends 14 of the linkages 12 and/or include data captured by imaging devices that are positioned about the surgical theater (e.g., an imaging device positioned within the surgical site “S”, an imaging device positioned adjacent the patient “P”, imaging device 56 positioned at a distal end of an imaging arm 52). The imaging devices (e.g., imaging devices 16, 56) may capture visual images, infra-red images, ultrasound images, X-ray images, thermal images, and/or any other known real-time images of the surgical site “S”. The imaging devices transmit captured imaging data to the processing unit 30 which creates three-dimensional images of the surgical site “S” in real-time from the imaging data and transmits the three-dimensional images to the display device 44 for display.
The user console 40 also includes input handles 42 which are supported on control arms 43 which allow a clinician to manipulate the surgical robot 10 (e.g., move the linkages 12, the ends 14 of the linkages 12, and/or the tools 20). Each of the input handles 42 is in communication with the processing unit 30 to transmit control signals thereto and to receive feedback signals therefrom. Additionally or alternatively, each of the input handles 42 may include input devices (not explicitly shown) which allow the surgeon to manipulate (e.g., clamp, grasp, fire, open, close, rotate, thrust, slice, etc.) the tools 20 supported at the ends 14 of the linkages 12.
Each of the input handles 42 is moveable through a predefined workspace to move the ends 14 of the linkages 12, e.g., tools 20, within a surgical site “S”. The three-dimensional images on the display device 44 are orientated such that the movement of the input handles 42 moves the ends 14 of the linkages 12 as viewed on the display device 44. The three-dimensional images remain stationary while movement of the input handles 42 is scaled to movement of the ends 14 of the linkages 12 within the three-dimensional images. To maintain an orientation of the three-dimensional images, kinematic mapping of the input handles 42 is based on a camera orientation relative to an orientation of the ends 14 of the linkages 12. The orientation of the three-dimensional images on the display device 44 may be mirrored or rotated relative to the view captured by the imaging devices 16, 56. In addition, the size of the three-dimensional images on the display device 44 may be scaled to be larger or smaller than the actual structures of the surgical site permitting a clinician to have a better view of structures within the surgical site “S”. As the input handles 42 are moved, the tools 20 are moved within the surgical site “S” as detailed below. Movement of the tools 20 may also include movement of the ends 14 of the linkages 12 which support the tools 20.
For a detailed discussion of the construction and operation of a robotic surgical system 1, reference may be made to U.S. Pat. No. 8,828,023, the entire contents of which are incorporated herein by reference.
The user console 40 further includes a foot pedal 60 that can be used to control various aspects of the robotic surgical system 1. For example, the foot pedal 60 may be selectively associated with an input handle, e.g., input handle 42, to actuate a tool 20 associated with the respective input handle. Additionally or alternatively, the foot pedal 60 may be associated with a camera, e.g., camera 56, to move the camera about the surgical site “S”. For a detailed discussion of suitable foot pedals, reference may be made to U.S. Provisional Patent Application Ser. Nos. 62/510,502, filed May 24, 2017, entitled “PEDAL CONTROL FOR ROBOTIC SURGICAL SYSTEMS,” (now International Patent Application Serial No. PCT/US2018/033084, filed on May 17, 2018), and 62/556,100, filed Sep. 8, 2017, entitled “HIGH PRECISION INSTRUMENT CONTROL MODE FOR ROBOTIC SURGICAL SYSTEMS,” (now International Patent Application Serial No. PCT/US2018/049634, filed on Sep. 6, 2018). The entire contents of each of the above applications are hereby incorporated by reference.
With reference to
With additional reference to
Referring to
The body 620 is generally cylindrical and formed from a plurality of struts 628 that extend between the mounting and motor flanges 610, 630 to define a channel 622 through the body 620. The struts 628 are configured to deflect or flex in response to torque applied about the transducer axis T-T. The struts 628 include low stress regions 624 adjacent each of the mounting and motor flanges 610, 630 and a high stress region 626 between the low stress regions 624. The body 620 includes a strain gauge 640 disposed in the high stress region of at least one of the struts 628.
With additional reference to
Referring to
Initially, the processing unit 30 initializes the IDU 400 (Step 710) before the IDU 400 is coupled to a surgical instrument, e.g., surgical instrument 20. The processing unit 30 may interrogate the IDU 400 to receive a measured gain of each of the torque transducers 600 from a memory chip 646 of each of the torque transducers 600 (Step 720), or, optionally stored in a memory of IDU 400. The processing unit 30 may interrogate the IDU 400 to receive performance data of each of the torque transducers 600 relative to a temperature of the IDU 400 or a temperature of each of the torque transducers 600 (Step 730). The processing unit 30 may also interrogate, once, periodically, or continuously, a temperature of the IDU 400 or each of the torque transducers 600. It is contemplated that the IDU 400 may have a single memory chip that includes a gain for each of the torque transducers 600 of the IDU 400. The processing unit 30 also zeros each of the torque transducers 600 to set a zero load or zero torque T0 for each of the torque transducers 600 (Step 740). For example, when each of the motors 420 is deactivated, the readings from each of the strain gauges 640 may be set to zero. During setting or zeroing of the torque transducers 600, the IDU 400 may be coupled to an adapter, e.g., adapter 120, with no load on any of the motors 420.
With each of the torque transducers 600 zeroed, the processing unit 30 determines an inertia J of each of the motors 420 and/or adapter 120 coupled to the IDU 400 (Step 752). To determine the inertia J associated with each of the motors 420, each of the motors 420 secured to the motor plate 404 are individually accelerated at a known, fixed rate with no load on the motors 420 and/or adapter 120 (Step 750). The known fixed rate can be verified by one or more position sensors (not explicitly shown) that measure the position of the motor 420. By accelerating the motor at a known, fixed rate, the inertia J of the respective motor 420, a gearbox, and/or adapter coupled to the IDU 400 can be determined. For example, when the respective motor 420 has an inertia J and is accelerated at a known angular acceleration a, the measured torque Tm=J·α. Thus, the inertia J=Tm/α. With the inertia J known for each of the individual motors 420, the inertia J of each motor 420 can be compensated for by the processing unit 30 to increase the accuracy of control signals sent to the motors 420.
In addition, the processing unit 30 can determine a cross talk torque Tc for each of the motors 420 when each of the motors 420 is individually accelerated at a known fixed rate (Step 754). Specifically, the cross talk torque Tc of each of the other motors 420 is measured in response to the observed torque in the motor 420 being accelerated. The cross talk torques Tc are then used to generate a 4×4 matrix, e.g., when the motor plate 404 has four motors 420 mounted thereto, to allow for correction of the cross talk torque Tc for each of the motors 420 (Step 760). An exemplary cross talk matrix is shown in Table 1 below where the correction factors CxMy is the Tc measured at each motor Y when the motor X is being accelerated. For example, the Tc of a first motor when a second motor is being accelerated is C2M1. The cross talk matrix of Table 1 is used to negate the effects of cross talk torque Tc in each of the motors 420.
It will be appreciated that the processing unit 30 may more accurately control surgical instruments coupled to IDU 400 by compensating for an offset of each of the torque transducers 600 by zeroing the torque transducers 600, compensating for a gain of each of the torque transducers 600, compensating for a temperature of the IDU 400 and/or each of the torque transducers 600, an inertia of each of the motors 420, and/or a cross talk torque of each of the motors 420. More accurately controlling surgical instruments may allow for increased performance of a surgical robot during a surgical procedure which may improve surgical outcomes. In addition, the increased performance may reduce the amount of time required to complete a given surgical procedure which may decrease the cost of the surgical procedure.
While several embodiments of the disclosure have been shown in the drawings, it is not intended that the disclosure be limited thereto, as it is intended that the disclosure be as broad in scope as the art will allow and that the specification be read likewise. Any combination of the above embodiments is also envisioned and is within the scope of the appended claims. Therefore, the above description should not be construed as limiting, but merely as exemplifications of particular embodiments. Those skilled in the art will envision other modifications within the scope of the claims appended hereto.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/US2019/035520 | 6/5/2019 | WO | 00 |
Number | Date | Country | |
---|---|---|---|
62833833 | Apr 2019 | US |