Motor control apparatus, motor control method and motor control program

Patent metadata

Field	Value
Publication number	US-9853585-B2
Application number	US-201615167607-A
Country	US
Kind code	B2
Filing date	May 27, 2016
Priority date	Jun 2, 2015
Publication date	Dec 26, 2017
Grant date	Dec 26, 2017

Abstract

A control apparatus for controlling a motor performing pressure control includes circuitry which calculates a detected speed of a motor based on an input pressure command, sensor reaction force, movable part viscous damping force and movable part mass, outputs the detected speed, calculates the movable part viscous damping force by multiplying the detected speed by a movable part viscous damping coefficient to calculate the detected speed, calculates a detected position of the motor by integrating the detected speed, outputs the detected position, calculates a sensor viscous damping pressure by multiplying the detected speed by a sensor viscous damping coefficient, calculates a sensor spring pressure by multiplying the detected position by a sensor spring constant, calculates a detected pressure of a pressure sensor by adding the sensor spring pressure to the sensor viscous damping pressure, and outputs the sensor reaction force which is the detected pressure to calculate the detected speed.

First claim

What is claimed is:

1. A motor control apparatus for controlling a motor that performs pressure control, comprising:
processing circuitry configured to:
calculate a movable part viscous damping force by multiplying a detected speed, obtained from a sensor detecting characteristics of the motor, by a movable part viscous damping coefficient,
calculate a sensor viscous damping pressure by multiplying the detected speed, obtained from the sensor detecting characteristics of the motor, by a sensor viscous damping coefficient,
calculate a position of the motor by integrating the detected speed obtained from the sensor detecting characteristics of the motor,
output the calculated position of the motor,
calculate a sensor spring pressure by multiplying the calculated position of the motor by a sensor spring constant,
calculate a pressure by adding the calculated sensor spring pressure to the calculated sensor viscous damping pressure,
output the calculated pressure,
calculate an updated speed of a motor based on an input pressure command, a sensor reaction force generated from the calculated pressure, the calculated movable part viscous damping force, and a movable part mass, and
output the calculated updated speed.

2. The motor control apparatus according to claim 1 , wherein the processing circuitry is configured to receive a high-level pressure command that is externally input, and calculate the input pressure command by multiplying a deviation between the high-level pressure command and the calculated pressure by a third gain, integrating a resulting value, and subtracting from the resulting value a product of the calculated position and a first gain and a product of the detected speed and a second gain.

3. The motor control apparatus according to claim 2 , wherein the first gain, second gain and third gain are set to satisfy a relationship, k 1 >J·K st ·k 3 /k 2 −K st , where J represents the movable part mass, K st represents the sensor spring constant, k 1 represents the first gain, k 2 represents the second gain, and k 3 represents the third gain.

4. The motor control apparatus according to claim 3 , wherein the first gain, second gain and third gain are set to satisfy relationships, k 1 ≈3ω 2 ·J−K st , k 2 ≈3ω·J, and k 3 ≈(J/K st )·ω 3 , where ω represents a response frequency.

5. The motor control apparatus according to claim 2 , wherein the circuitry is configured to multiply the second gain by a deviation between the detected speed and the high-level speed command that is externally input.

6. The motor control apparatus according to claim 2 , wherein the circuitry is configured to multiply a deviation between the calculated position and the high-level position command that is externally input.

7. The motor control apparatus according to claim 6 , wherein the circuitry is configured to integrate a deviation between the calculated position and the high-level position command and multiply the first gain by a resulting value.

8. The motor control apparatus according to claim 3 , wherein the circuitry is configured to multiply the second gain by a deviation between the detected speed and the high-level speed command that is externally input.

9. The motor control apparatus according to claim 3 , wherein the circuitry is configured to multiply a deviation between the calculated position and the high-level position command that is externally input.

10. The motor control apparatus according to claim 9 , wherein the circuitry is configured to integrate a deviation between the calculated position and the high-level position command and multiply the first gain by a resulting value.

11. The motor control apparatus according to claim 4 , wherein the circuitry is configured to multiply the second gain by a deviation between the detected speed and the high-level speed command that is externally input.

12. The motor control apparatus according to claim 4 , wherein the circuitry is configured to multiply a deviation between the calculated position and the high-level position command that is externally input.

13. The motor control apparatus according to claim 12 , wherein the circuitry is configured to integrate a deviation between the calculated position and the high-level position command and multiply the first gain by a resulting value.

14. A motor control apparatus for controlling a motor that drives a control object with a pressure sensor, comprising:
circuitry configured to
calculate a position deviation between a high-level position command that is externally input and a detected position of a motor, obtained from a sensor detecting characteristics of the motor, that drives a control object,
calculate a speed command based on the position deviation,
calculate a speed deviation between the speed command and an output speed of the motor,
calculate a torque command based on the speed deviation,
input the torque command to the motor,
calculate a pressure deviation between a high-level pressure command that is externally input and a detected pressure that is detected from a pressure sensor of the control object,
calculate a position correction command based on the pressure deviation, and
add the position correction command to the high-level position command to calculate the position deviation.

15. The motor control apparatus according to claim 14 , wherein the circuitry includes integrator circuitry configured to integrate the pressure deviation.

16. The motor control apparatus according to claim 14 , wherein the circuitry includes proportioning circuitry configured to multiply the position deviation.

17. The motor control apparatus according to claim 14 , wherein the circuitry is configured to add the detected pressure to the torque command and input a resulting value to the motor.

18. The motor control apparatus according to claim 15 , wherein the circuitry includes proportioning circuitry configured to multiply the position deviation.

19. The motor control apparatus according to claim 15 , wherein the circuitry is configured to add the detected pressure to the torque command and input a resulting value to the motor.

20. A method for controlling a motor that drives a control object with a pressure sensor, comprising:
calculating a position deviation between a high-level position command that is externally input and a detected position of a motor that drives a control object;
calculating a speed command based on the position deviation;
calculating a speed deviation between the speed command and an output speed of the motor;
calculating a torque command based on the speed deviation;
inputting the torque command to the motor;
calculating a pressure deviation between a high-level pressure command that is externally input and a detected pressure that is detected from a pressure sensor of the control object;
calculating a position correction command based on the pressure deviation; and
adding the position correction command to the high-level position command to calculate the position deviation.

Assignees

• Yaskawa Electric Corp

Inventors

• Yoshiura Yasufumi
• Kaku Yasuhiko
• SUGANUMA Takuhiro

Classifications

• G05D1/00

  Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots (drive control systems specially adapted for autonomous road vehicles B60W60/00) · CPC title

• H02P23/18 Primary

  Controlling the angular speed together with angular position or phase · CPC title