Sensorless force control for transeopagel echocardiography probe
A robotic actuation system for sensorless force control of an interventional tool ( 14 ) having cable driven distal end (e.g., a probe, a steerable catheter, a guidewire and a colonoscope). The system employs a robotic actuator ( 30 ) having one or more motorized gears operate the cable drive of the interventional tool ( 14 ). The system further employs a robotic workstation ( 20 ) to generate motor commands for simultaneous actuation position and contact force control of the interventional tool ( 14 ). The motor commands are a function of an actuation position measurement and a motor current measurement of the at least one motorized gear for a desired actuation position of the interventional tool ( 14 ).
1. A robotic workstation for sensorless force control of an interventional tool having a cable driven distal end, the robotic workstation comprising:
an actuation controller including
a calibration lookup table of expected motor currents for a measured motor position of one or each of at least one motorized gear engaging the interventional tool, and
a calibration curve including a force-to-motor current curve for the interventional tool;
wherein the actuation controller is configured to generate motor commands for simultaneous actuation position and contact force control of the interventional tool derived from the calibration lookup table and the calibration curve; and
wherein the robotic workstation is configured to generate the motor commands as a function of an actuation position measurement and a motor current measurement of the at least one motorized gear for a desired actuation position of the interventional tool.
2. The robotic workstation of claim 1 ,
wherein the actuation controller generates a motor position error as a function of a comparison of a measured motor position of one or each of the at least one motorized gear to a desired motor position of one or each of the at least one motorized gear associated with the desired actuation position of the interventional tool;
wherein the robotic workstation generates a contact force error as a function of a comparison of an expected contact force of the interventional tool to a desired contact force of the interventional tool; and
wherein the motor commands are generated by the actuator controller to minimize the motor position error and the contact force error.
3. The robotic workstation of claim 2 ,
wherein the actuation controller derives the expected contact force of the interventional tool from the calibration lookup table and the calibration curve.
4. The robotic workstation of claim 3 , wherein the actuation controller inputs a measured motor position of one or each of the at least one motorized gear into the calibration lookup table to output at least one expected motor current.
5. The robotic workstation of claim 4 , wherein the actuation controller applies the at least one expected motor current and a measured current motor of one or each of the at least one motorized gear to the calibration curve to output the expected contact force of the interventional tool.
6. The robotic workstation of claim 1 , wherein the interventional tool is one of a cable driven group of interventional tools including a probe, a steerable catheter, a guidewire and a colonoscope.
7. A robotic workstation for sensorless force control of an interventional tool having a cable driven distal end, the robotic workstation comprising:
an actuation position calibrator configured to generate a calibration lookup table of expected motor currents for a measured motor position of one or each of at least one motorized gear engaging the interventional tool;
a contact force calibrator configured to a generate a calibration curve including a force-to-motor current curve for the interventional tool;
an actuation controller operably connected to the actuation position calibrator and the contact force calibrator, wherein the actuator controller is configured to generate motor commands for simultaneous actuation position and contact force control of the interventional tool derived from the calibration lookup table and the calibration curve; and
wherein the robotic workstation is configured to generate the motor commands as a function of an actuation position measurement and a motor current measurement of the at least one motorized gear for a desired actuation position of the interventional tool.
8. The robotic workstation of claim 7 ,
wherein the actuation controller generates a motor position error as a function of a comparison of a measured motor position of one or each of the at least one motorized gear to a desired motor position of one or each of the at least one motorized gear associated with the desired actuation position of the interventional tool;
wherein the robotic workstation generates a contact force error as a function of a comparison of an expected contact force of the interventional tool to a desired contact force of the interventional tool; and
wherein the motor commands are generated by the actuator controller to minimize the motor position error and the contact force error.
9. The robotic workstation of claim 8 ,
wherein the actuation controller derives the expected contact force of the interventional tool from the calibration lookup table and the calibration curve.
10. The robotic workstation of claim 9 , wherein the actuation controller inputs a measured motor position of one or each of the at least one motorized gear into the calibration lookup table to output at least one expected motor current.
11. The robotic workstation of claim 10 , wherein the actuation controller applies the at least one expected motor current and a measured current motor of one or each of the at least one motorized gear to the calibration curve to output the expected contact force of the interventional tool.
12. The robotic workstation of claim 7 , wherein the interventional tool is one of a cable driven group of interventional tools including a probe, a steerable catheter, a guidewire and a colonoscope.