Compensating robot movement deviations
AssigneeABB Schweiz AG
InventorStig Moberg
Life of this patent
Estimating the term…
Abstract
A method, device, and computer program product for compensating robot movement deviations caused by a gear box as well as to a robot arrangement including such a device. The device has a drift estimating block configured to obtain motor data ({dot over (q)}r) and motor torque data (τ) related to the motor, determine a measure of the temperature of the gear box based on the motor data ({dot over (q)}r) and motor torque data (τ) and estimate the drift (Δq) based on a drift value of the robot section, the drift value in turn being obtained based on the gearbox temperature measure and a gravitational torque (τgrav) of the motor, and a drift adjusting block (44) configured to adjust a control value (qr) used to control the positioning of the robot based on the estimated drift (Δq).
Claims13
A method for compensating robot movement deviations caused by a gearbox connected between a robot section and a motor controlling the movement of the robot section, the method comprising the steps of:
- obtaining motor data of the motor;
- obtaining motor torque data;
- determining a temperature measure of the gearbox based on the motor data and motor torque data, said determining the gearbox temperature measure includes low pass filtering the motor data, where the result of filtering is the gearbox temperature measure;
- estimating a drift compensation based on a drift value of the robot section, said drift value being obtained based on the gearbox temperature measure and a gravitational torque of the motor by applying the gearbox temperature measure and the gravitational torque in known relationships between drift value, temperature measure, and gravitational torque;
- and
- adjusting a control value used to control the positioning of the robot based on the estimated drift compensation.
A device for compensating robot movement deviations caused by a gearbox connected between a robot section and a motor controlling the movement of the robot section, the device comprising:
- at least one drift estimating block configured to:
- obtain motor data of the motor;
- obtain motor torque data;
- determine a temperature measure gearbox based on the motor data and the motor torque data;
- estimate a drift compensation based on a drift value of the robot section, said drift value being obtained based on the gearbox temperature measure and a gravitational torque of the motor;
- the drift estimating block having a temperature dependent measure forming element configured to determine the gearbox temperature measure through low pass filtering the motor data, where the result of the filtering is the gearbox temperature measure;
- the drift estimating block having a temperature measure handling element configured to obtain the drift value by applying the gearbox temperature measure and the gravitational torque in known relationships between drift value, temperature measure, and gravitational torque;
- and
- a drift adjusting block configured to adjust a control value used to control the positioning of the robot based on the estimated drift compensation.
A robot arrangement comprising an industrial robot and a device for compensating robot movement deviations,
- the industrial robot including:
- a number of moveable arm sections,
- at least one motor for moving a corresponding arm section, and
- a gearbox between the motor and the arm section,
- the device for compensating robot movement deviations including:
- a drift estimating block configured to obtain motor data of the motor, obtain motor torque data, determine a temperature measure of the gearbox based on the motor data and the motor torque data, and estimate a drift compensation based on a drift value of the robot section, said drift value being obtained based on the gearbox temperature measure and a gravitational torque of the motor,
- the drift estimating block having a temperature dependent measure forming element configured to determine the gearbox temperature measure through low pass filtering the motor data, where the result of the filtering is the gearbox temperature measure,
- the drift estimating block having a temperature measure handling element configured to obtain the drift value by applying the gearbox temperature measure and the gravitational torque in known relationships between drift value, temperature measure, and gravitational torque, and
- a drift adjusting block configured to adjust a control value used to control the positioning of the robot based on the estimated drift compensation.
A non-transitory computer program product for compensating robot movement deviations caused by a gearbox connected between a robot section and a motor controlling the movement of the robot section, the computer program product comprising a data carrier with computer program code which when run in a device for compensating robot movement deviations, causes the device to:
- obtain motor data of the motor;
- obtain motor torque data;
- determine a temperature measure of the gearbox based on the motor data and motor torque data, said determining the gearbox temperature measure includes low pass filtering the motor data, where the result of the filtering is the gearbox temperature measure;
- estimate a drift compensation based on a drift value of the robot section, said drift value being obtained based on the gearbox temperature measure and a gravitational torque of the motor by applying the gearbox temperature measure and the gravitational torque in known relationships between drift value, temperature measure, and gravitational torque;
- and
- adjust a control value used to control the positioning of the robot based on the estimated drift compensation.
Dependencies are inferred from the claim text.