CPC A61B 90/03 (2016.02) [A61B 34/30 (2016.02); B25J 9/1638 (2013.01); A61B 2034/2048 (2016.02); A61B 34/37 (2016.02); A61B 2090/031 (2016.02); A61B 2090/066 (2016.02); G05B 2219/39178 (2013.01); G05B 2219/39194 (2013.01); G05B 2219/45117 (2013.01)] | 15 Claims |
1. An instrument drive unit configured to manipulate a tool, the instrument drive unit comprising:
a housing defining a central longitudinal axis and configured to couple to the tool;
at least one motor disposed in the housing and including a torque sensor configured to measure torque of the at least one motor;
an inertial measurement unit disposed along the central longitudinal axis within the housing and configured to measure an orientation of the instrument drive unit; and
a controller configured to:
generate a calibration map between the orientation of the instrument drive unit and the torque of the at least one motor;
calculate an output signal to control the at least one motor to manipulate the tool;
determine a pose of the instrument drive unit based on the orientation of the instrument drive unit;
retrieve a correction value from the calibration map based on the pose of the instrument drive unit; and
generate a corrected output signal to manipulate the tool by adjusting the output signal based on the correction value, wherein the corrected output signal compensates for the pose of the instrument drive unit.
|