Motor control device, motor control method, and non-transitory computer readable medium recording a motor control program

Patent metadata

Field	Value
Publication number	US-10423170-B2
Application number	US-201715602729-A
Country	US
Kind code	B2
Filing date	May 23, 2017
Priority date	May 25, 2016
Publication date	Sep 24, 2019
Grant date	Sep 24, 2019

Abstract

Included are a first position detection part that detects a first position which is the position of a movable part; a second position detection part that detects a second position which is the position of a driven part; a positional error calculation part that calculates positional error, which is deviation between a converted first position detection value and a second position detection value; and a positional error variation calculation part that calculates an absolute value for variation of positional error since reversal of a position command was detected, in which addition of a backlash correction amount is started if the absolute value for the variation of the positional error exceeds a first reference value, and addition of a backlash acceleration amount is started if the absolute value of variation of the positional error exceeds a second reference value.

First claim

What is claimed is:

1. A motor control device for correcting backlash between a movable part that is driven by a motor, and a driven part that is driven by the movable part, the device comprising:
a first position detection part that detects a first position which is a position of the movable part;
a second position detection part that detects a second position which is a position of the driven part;
a positional error calculation part that calculates positional error, which is deviation between a converted first position detected value arrived at by converting a first position detected value detected by the first position detection part into a value of a position of the driven part according to a rotation ratio between the movable part and the driven part; and a second position detected value detected by the second position detection part;
a position command creation part that creates a position command;
a reversal detection part that detects reversal of the position command;
a positional error variation calculation part that calculates an absolute value for variation of the positional error since reversal was detected;
a determination part that determines whether the absolute value for the variation of the positional error has exceeded a predetermined reference value;
a backlash correction part that adds a backlash correction amount to the position command based on the positional error;
a control unit that calculates a speed command or a torque command from a position command after the backlash correction amount was added; and
a backlash acceleration part that adds a backlash acceleration amount to the speed command or the torque command,
wherein the backlash correction part starts addition of the backlash correction amount if an absolute value for variation of the positional error exceeds a first reference value designated in advance, and the backlash acceleration part starts addition of the backlash acceleration amount if the absolute value for the variation of the positional error exceeds a second reference value designated in advance.

2. The motor control device according to claim 1 , wherein the movable part driven by the motor and the driven part driven by the movable part are mechanically joined by combination of gears and a belt.

3. A method for controlling a motor that corrects for backlash between a movable part that is driven by a motor and a driven part that is driven by the movable part, the method comprising the steps executed by a computer of:
detecting a first position which is a position of the movable part;
detecting a second position which is a position of the driven part;
calculating a positional error which is a deviation between a converted first position detected value arrived at by converting a first position detected value that was detected in the step of detecting a first position into a value of a position of the driven part according to a rotation ratio between the movable part and the driven part, and a second position detected value that was detected in the step of detecting a second position;
creating a position command;
detecting reversal of the position command;
calculating an absolute value for variation of the positional error since reversal was detected;
determining whether the absolute value for the variation of the positional error has exceeded a predetermined reference value;
adding a backlash correction amount to the position command based on the positional error;
calculating a speed command or a torque command from a position command to which the backlash correction amount was added; and
adding a backlash acceleration amount to the speed command or the torque command,
wherein addition of the backlash correction amount to the position command is started if the absolute value for the variation of the positional error exceeds a first reference value designated in advance, and addition of the backlash acceleration amount to the speed command or the torque command is started if the absolute value for the variation of the positional error exceeds a second reference value designated in advance.

4. A non-transitory computer readable medium recording a motor control program for correcting backlash between a movable part that is driven by a motor and a driven part that is driven by the movable part, the program enabling a computer to execute the steps of:
detecting a first position which is a position of the movable part;
detecting a second position which is a position of the driven part;
calculating a positional error which is a deviation between a converted first position detected value arrived at by converting a first position detected value that was detected in the step of detecting a first position into a value of a position of the driven part according to a rotation ratio between the movable part and the driven part, and a second position detected value that was detected in the step of detecting a second position;
creating a position command;
detecting reversal of the position command;
calculating an absolute value for variation of the positional error since reversal was detected;
determining whether the absolute value for the variation of the positional error has exceeded a predetermined reference value;
adding a backlash correction amount to the position command based on the positional error;
calculating a speed command or a torque command from a position command to which the backlash correction amount was added; and
adding a backlash acceleration amount to the speed command or the torque command,
wherein addition of the backlash correction amount to the position command is started if the absolute value for the variation of the positional error exceeds a first reference value designated in advance, and addition of the backlash acceleration amount to the speed command or the torque command is started if the absolute value for the variation of the positional error exceeds a second reference value designated in advance.

Assignees

• Fanuc Corp

Inventors

• Hashimoto Shoutarou
• Okita Tadashi
• Morita Yuuki

Classifications

• G05B19/0428

  Safety, monitoring (G05B19/0423 takes precedence) · CPC title

• G05B2219/43003

  Acceleration deceleration in presence of backlash, dynamic backlash · CPC title

• G05B19/416 Primary

  characterised by control of velocity, acceleration or deceleration (G05B19/19 takes precedence) · CPC title

• H02P29/00 Primary

  Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors (arrangements for starting electric motors H02P1/00; arrangements for stopping or slowing electric motors H02P3/00; control of motors that can be connected to two or more different electric power supplies H02P4/00; regulating or controlling the speed or torque of two or more electric motors H02P5/00; vector control H02P21/00) · CPC title

• G05D3/20 Primary

  using a digital comparing device · CPC title