Motor control device

Patent metadata

Field	Value
Publication number	US-2025343496-A1
Application number	US-202218869860-A
Country	US
Kind code	A1
Filing date	Jun 10, 2022
Priority date	Jun 10, 2022
Publication date	Nov 6, 2025
Grant date	—

Abstract

A motor control device includes a feedforward controller generating motor torque and position commands, an encoder outputting a motor position detection value, a machine-end sensor detecting a target object as a measurement value, a signal processor calculating movable component position based on the measurement value as a machine-end position detection value, and a feedback torque command generation unit generating a feedback torque command based on the machine-end and motor position detection values and the motor position command. When a positional relationship between the movable component and a target point is undetectable, the feedback torque command is generated based on the motor position detection value and the motor position command, and when the positional relationship is detectable, the feedback torque command is generated based on the motor and machine-end position detection values, the motor position command, and a signal adding a time delay to the motor position command.

First claim

1 . A motor control device that drives a motor on a basis of a position command to move a movable component to a target point specified by the position command, the motor control device comprising:
feedforward control circuitry to generate a motor torque command and a motor position command on a basis of the position command; an encoder to detect a position of the motor and to output a motor position detection value signal representing the position; a machine-end sensor to detect a target object present in a certain area including the movable component and output a measurement value signal representing a result of detection; a signal processor to calculate a position of the movable component with the target point used as a reference on a basis of the measurement value signal and output a machine-end position detection value signal representing a result of calculation; feedback torque command generation circuitry to generate a feedback torque command for correcting the motor torque command, on a basis of the machine-end position detection value signal, the motor position detection value signal, and the motor position command; and torque signal adding circuitry to add the motor torque command and the feedback torque command to generate a torque command directed to the motor, wherein when the machine-end sensor is in a first state, the feedback torque command generation circuitry generates the feedback torque command on a basis of the motor position detection value signal and the motor position command, and when the machine-end sensor is in a second state, the feedback torque command generation circuitry generates the feedback torque command on a basis of the motor position detection value signal, the machine-end position detection value signal, the motor position command, and a signal obtained by adding a time delay to the motor position command, the first state being a state in which a relative positional relationship between the movable component and the target point is undetectable by the machine-end sensor, the second state being a state in which the relative positional relationship between the movable component and the target point is detectable by the machine-end sensor.

2 . The motor control device according to claim 1 , wherein
the feedback torque command generation circuitry includes a first low-pass filter to pass a signal component having a frequency lower than or equal to a predetermined frequency, of the machine-end position detection value signal, a first high-pass filter to pass a signal component having a frequency higher than or equal to a predetermined frequency, of the motor position detection value signal, first adding circuitry to add an output of the first low-pass filter and an output of the first high-pass filter, motor position command delaying circuitry to add the time delay to the motor position command and output a resulting signal, a second low-pass filter to pass a signal component having a frequency lower than or equal to a predetermined frequency, of the resulting signal output by the motor position command delaying circuitry, a second high-pass filter to pass a signal component having a frequency higher than or equal to a predetermined frequency, of the motor position command, second adding circuitry to add an output of the second low-pass filter and an output of the second high-pass filter, detection value signal switching circuitry to receive the motor position detection value signal and a signal output from the first adding circuitry, to output the motor position detection value signal when the machine-end sensor is in the first state, and to output the signal input from the first adding circuitry when the machine-end sensor is in the second state, command value switching circuitry to receive the motor position command and a signal output from the second adding circuitry, to output the motor position command when the machine-end sensor is in the first state, and to output the signal input from the second adding circuitry when the machine-end sensor is in the second state, and feedback control circuitry to calculate the feedback torque command on a basis of a difference between an output of the detection value signal switching circuitry and an output of the command value switching circuitry.

3 . The motor control device according to claim 2 , comprising:
switching determination circuitry to determine whether the machine-end sensor is in the first state or in the second state on a basis of the motor position detection value signal, the machine-end position detection value signal, the position command, or the motor position command, and to control the detection value signal switching circuitry and the command value switching circuitry on a basis of a result of determination.

4 . The motor control device according to claim 1 , wherein
the feedback torque command generation circuitry includes first switching circuitry to receive the motor position detection value signal and the machine-end position detection value signal, to output the motor position detection value signal when the machine-end sensor is in the first state, and to output the machine-end position detection value signal when the machine-end sensor is in the second state, a first low-pass filter to pass a signal component having a frequency lower than or equal to a predetermined frequency, of a signal output by the first switching circuitry, a first high-pass filter to pass a signal component having a frequency higher than or equal to a predetermined frequency, of the motor position detection value signal, first adding circuitry to add an output of the first low-pass filter and an output of the first high-pass filter, motor position command delaying circuitry to add the time delay to the motor position command and to output a resulting signal, second switching circuitry to receive the motor position command and a signal output from the motor position command delaying circuitry, to output the motor position command when the machine-end sensor is in the first state, and to output the signal input from the motor position command delaying circuitry when the machine-end sensor is in the second state, a second low-pass filter to pass a signal component having a frequency lower than or equal to a predetermined frequency, of a signal output by the second switching circuitry, a second high-pass filter to pass a signal component having a frequency higher than or equal to a predetermined frequency, of the motor position command, second adding circuitry to add an output of the second low-pass filter and an output of the second high-pass filter, and feedback control circuitry to calculate the feedback torque command on a basis of a difference between an output of the first adding circuitry and an output of the second adding circuitry.

5 . The motor control device according to claim 4 , comprising:
switching determination circuitry to determine whether the machine-end sensor is in the first state or in the second state on a basis of the motor position detection value signal, the machine-end position detection value signal, the position command, or the motor position command, and to control the first switching circuitry and the second switching circuitry on a basis of a result of determination.

6 . The motor control device according to claim 1 , wherein
the feedback torque command generation circuitry includes motor position detection value delaying circuitry to add a time delay to the motor position detection value signal and output a resulting signal, switching circuitry to receive a signal output from the motor position detection value delaying circuitry and the machine-end position detection value signal, to output the signal input from the motor position detection value delaying circ

Assignees

• Mitsubishi Electric Corp

Inventors

• Sekiguchi Hiroyuki
• Kai Takashi
• Ikeda Hidetoshi
• Ueno Sho

Classifications

• G05B15/02

  electric · CPC title

• H02P23/14 Primary

  Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage · CPC title

• G05B19/18 Primary

  Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form (G05B19/418 takes precedence) · CPC title