External force estimation device, external force estimation method, and non-transitory computer-readable storage medium
An external force estimation device is configured to estimate an external force acting on a motor. The external force estimation device includes a processor. The processor is configured to: calculate an output torque of the motor by using a value of a current supplied to the motor; estimate an inertia torque of the motor by using rotational position information of the motor; estimate a first friction torque of the motor by using the rotational position information of the motor; perform temperature-based correction for the first friction torque by using temperature information of the motor; and estimate the external force by subtracting the inertia torque and the first friction torque after the temperature-based correction from the output torque.
1. An external force estimation device configured to estimate an external force acting on a motor, the external force estimation device comprising a processor configured to:
calculate an output torque of the motor by using a value of a current supplied to the motor;
estimate an inertia torque of the motor by using rotational position information of the motor;
estimate a first friction torque of the motor by using the rotational position information of the motor;
perform temperature-based correction for the first friction torque by using temperature information of the motor; and
estimate the external force by subtracting the inertia torque and the first friction torque after the temperature-based correction from the output torque.
2. The external force estimation device according to claim 1 , wherein the first friction torque includes at least one of a Coulomb friction torque and a viscous friction torque.
3. The external force estimation device according to claim 1 , wherein the processor is configured to estimate the inertia torque of the motor by using a result of inverse dynamics calculation.
4. The external force estimation device according to claim 1 , wherein:
the motor is configured to operate a load via a gear; and
the processor is configured to:
estimate a second friction torque that varies depending on a rotation angle of the motor based on a correspondence between the rotation angle of the motor and the second friction torque; and
estimate the external force by subtracting the inertia torque, the first friction torque after the temperature-based correction, and the second friction torque from the output torque.
5. The external force estimation device according to claim 1 , wherein:
the motor is configured to operate a load via a gear; and
the processor is configured to:
estimate a third friction torque that varies depending on a rotation angle of the load based on a correspondence between the rotation angle of the load and the third friction torque; and
estimate the external force by subtracting the inertia torque, the first friction torque after the temperature-based correction, and the third friction torque from the output torque.
6. The external force estimation device according to claim 1 , wherein:
the motor is configured to operate a load via a gear; and
the processor is configured to:
estimate a second friction torque that varies depending on a rotation angle of the motor based on a correspondence between the rotation angle of the motor and the second friction torque;
estimate a third friction torque that varies depending on a rotation angle of the load based on a correspondence between the rotation angle of the load and the third friction torque; and
estimate the external force by subtracting the inertia torque, the first friction torque after the temperature-based correction, the second friction torque, and the third friction torque from the output torque.
7. An external force estimation method for estimating an external force acting on a motor, the external force estimation method comprising:
calculating an output torque of the motor by using a value of a current supplied to the motor;
estimating an inertia torque of the motor and a friction torque of the motor by using rotational position information of the motor;
performing temperature-based correction for the friction torque by using temperature information of the motor; and
estimating the external force by subtracting the inertia torque and the friction torque after the temperature-based correction from the output torque.
8. A non-transitory computer-readable storage medium storing a program that, when executed by a processor of an external force estimation device configured to estimate an external force acting on a motor, causes the external force estimation device to:
calculate an output torque of the motor by using a value of a current supplied to the motor;
estimate an inertia torque of the motor and a friction torque of the motor by using rotational position information of the motor;
perform temperature-based correction for the friction torque by using temperature information of the motor; and
estimate the external force by subtracting the inertia torque and the friction torque after the temperature-based correction from the output torque.