Systems and methods for motor torque compensation
A method for torque compensation of a motor associated with a medical instrument includes determining a torque profile for a motor, the torque profile defining torque output as a function of rotor angle and during operation of the motor, compensating for deviations in the torque profile by adjusting an input signal to the motor, the compensating being based on the torque profile and rotor position.
1. A method for torque compensation of a motor associated with a medical instrument, the method comprising:
determining, using a control system, a torque profile for the motor, the torque profile defining torque output as a first function of a rotor angle of the motor and of multiple discrete loads;
storing a compensation profile for controlling an input signal to the motor, the compensation profile defining adjustments to the input signal as a second function of the rotor angle of the motor; and
applying the compensation profile during operation of the motor.
2. The method of claim 1 , further comprising, creating the compensation profile based on the torque profile.
3. The method of claim 1 , further comprising, performing a calibration operation on the motor, the calibration operation comprising determining effects on a torque ripple at a harmonic in response to a change in the input signal to the motor.
4. The method of claim 3 , further comprising, storing the effects in association with a sensitivity profile for the harmonic.
5. The method of claim 4 , wherein compensating for deviations in the torque profile comprises adjusting the input signal based on the sensitivity profile.
6. The method of claim 3 , wherein the harmonic is one of: a 1× harmonic, a 2× harmonic, and a 4× harmonic.
7. The method of claim 3 , further comprising, storing sensitivity profiles for torque ripples at different harmonics, each of the sensitivity profiles defining variation in amplitudes in response to varying input signals at each of the different harmonics.
8. The method of claim 7 , further comprising, during operation of the motor, using each of the sensitivity profiles to compensate for the torque ripples at different harmonics.
9. The method of claim 1 , wherein determining the torque profile comprises measuring torque output as a function of the rotor angle with a constant input current.
10. The method of claim 1 , wherein the motor comprises a direct current (DC) brushless motor.
11. The method of claim 1 , wherein the motor is used to drive a medical instrument attached to a manipulator arm.
12. The method of claim 1 , wherein the torque profile identifies torque ripples caused by torque harmonics.
13. A motor system for driving an instrument of a teleoperative system, the motor system comprising:
a motor; and
a control system comprising a processor and a memory, the memory comprising machine readable instructions that cause the motor system to:
determine a torque profile for the motor, the torque profile defining torque output as a first function of a rotor angle of the motor and of multiple discrete loads;
store a compensation profile for controlling an input signal to the motor, the compensation profile defining adjustments to the input signal as a second function of the rotor angle of the motor; and
apply the compensation profile during operation of the motor.
14. The motor system of claim 13 , wherein to determine the torque profile, the control system is configured to measure torque output as a function of the rotor angle with a constant input current.
15. The motor system of claim 13 , further comprising, creating the compensation profile based on the torque profile.
16. The motor system of claim 13 , wherein the torque profile further defines torque output as a function of an applied load.
17. The motor system of claim 13 , wherein determining the compensation profile for a new load comprises interpolating the torque profile for each of the discrete loads.
18. A teleoperative medical device comprising:
a manipulator arm;
a medical instrument detachably connected to the manipulator arm;
a plurality of motors connected to the manipulator arm, each motor of the plurality of motors configured to move the medical instrument in a different manner from another of the plurality of motors;
a control system comprising a processor and a memory, the memory comprising machine readable instructions that when executed by the processor, cause the control system to:
store a separate compensation profile for each motor of the plurality of motors, each compensation profile configured for controlling an input signal to a respective motor, each compensation profile defining adjustments to the input signal of the respective motor as a second function of a rotor angle of the respective motor, each compensation profile being based on a torque profile associated with the respective motor, wherein the torque profile associated with the respective motor defines torque output as a first function of the rotor angle at a set of discrete loads; and
apply each compensation profile during operation of each of the plurality of motors.
19. The teleoperative medical device of claim 18 , wherein to apply the compensation profile, the machine readable instructions further cause the control system to interpolate the torque profile at the discrete set of loads to determine the torque profile for each load of the discrete set of loads.
20. The teleoperative medical device of claim 18 , wherein each compensation profile comprises a load independent factor that contributes to torque ripples.