Control device, model creation method, and control program

1. A control device connected to a servo driver configured to drive a servomotor configured to move a controlled object, and configured to output a manipulated variable to the servo driver to control a position of the controlled object, the control device comprising:

a processor; and

a memory storing instructions that, when executed by the processor, cause the processor to at least:

perform model predictive control for each control period using a dynamics model representing a relationship between the manipulated variable and a position of the controlled object to generate the manipulated variable to be output to the servo driver,

the dynamics model including a first dynamics model representing a relationship between the manipulated variable and a position of the servomotor, and a second dynamics model representing a relationship between the position of the servomotor and the position of the controlled object,

the second dynamics model being created using a waveform parameter extracted from a vibration waveform of the controlled object,

the waveform parameter including a vibration frequency.

2. The control device according to claim 1 , wherein the waveform parameter further includes an amplitude ratio of two successive waves in the vibration waveform.

3. The control device according to claim 1 , wherein the instructions, when executed by the processor, further cause the processor to:

input the manipulated variable generated before a current control period to the first dynamics model to calculate a predicted position of the servomotor;

input the predicted position of the servomotor to the second dynamics model to calculate a predicted position of the controlled object for a future control period elapsing after the current control period ends by a dead time defined in the dynamics model; and

use the predicted position of the controlled object and the dynamics model to generate the manipulated variable to be output to the servo driver in a subsequent control period so as to minimize a deviation from a target trajectory of a position assumed by the controlled object in the future control period and following control periods.

4. The control device according to claim 1 , wherein the instructions, when executed by the processor, cause the processor to compensate for a predicted position of the servomotor based on a feedback value received from the servomotor.

5. The control device according to claim 1 , wherein the instructions, when executed by the processor, cause the processor to:

output a characteristic parameter which defines the first dynamics model; and

receive the characteristic parameter and the waveform parameter and generate the manipulated variable to be output to the servo driver.

6. The control device according to claim 1 , wherein the instructions, when executed by the processor, cause the processor to:

receive the waveform parameter and output a characteristic parameter which defines the dynamics model composed of the first and second dynamics models combined together; and

receive the characteristic parameter and generate the manipulated variable to be output to the servo driver.

7. The control device according to claim 1 , wherein the instructions, when executed by the processor, cause the processor to:

output a characteristic parameter which defines the first dynamics model, and receive a measured position of the controlled object and output the waveform parameter; and

receive the characteristic parameter and the waveform parameter and generate the manipulated variable to be output to the servo driver.

8. The control device according to claim 5 , wherein

the instructions include a function block causing the processor to output the characteristic parameter and generate the manipulated variable to be output to the servo driver.

9. A model creation method for creating the second dynamics model used by the control device according to claim 1 , the model creation method comprising:

obtaining a vibration waveform of a controlled object;

extracting a waveform parameter from the vibration waveform; and

creating the second dynamics model using the waveform parameter,

the waveform parameter including a vibration frequency.

10. A non-transitory computer-readable storage medium storing a control program executed in a control device connected to a servo driver configured to drive a servomotor configured to move a controlled object, and configured to output a manipulated variable to the servo driver to positionally control the controlled object,

the control program, when executed by the control device, causing the control device to at least:

create a first dynamics model representing a relationship between the manipulated variable and a position of the servomotor;

use a waveform parameter extracted from a vibration waveform of the controlled object to create a second dynamics model representing a relationship between the position of the servomotor and a position of the controlled object; and

use the first and second dynamics models to perform model predictive control for each control period to generate the manipulated variable to be output to the servo driver,

the waveform parameter including a vibration frequency.

11. The non-transitory computer-readable storage medium according to claim 10 , wherein the waveform parameter further includes an amplitude ratio of two successive waves in the vibration waveform.

12. The non-transitory computer-readable storage medium according to claim 10 , wherein the control program, when executed by the control device, further causes the control device to:

input the manipulated variable generated before a current control period to the first dynamics model to calculate a predicted position of the servomotor;

input the predicted position of the servomotor to the second dynamics model to calculate a predicted position of the controlled object for a future control period elapsing after the current control period ends by a dead time defined in the dynamics model; and

use the predicted position of the controlled object and the dynamics model to generate the manipulated variable to be output to the servo driver in a subsequent control period so as to minimize a deviation from a target trajectory of a position assumed by the controlled object in the future control period and following control periods.

13. The non-transitory computer-readable storage medium according to claim 10 , wherein the control program, when executed by the control device, further causes the control device to compensate for a predicted position of the servomotor based on a feedback value received from the servomotor.

14. The non-transitory computer-readable storage medium according to claim 10 , wherein the control program, when executed by the control device, further causes the control device to:

generate a characteristic parameter which defines the first dynamics model; and

use the characteristic parameter and the waveform parameter to generate the manipulated variable to be output to the servo driver.

15. The non-transitory computer-readable storage medium according to claim 10 , wherein the control program, when executed by the control device, further causes the control device to:

use the waveform parameter to generate a characteristic parameter which defines the dynamics model composed of the first and second dynamics models combined together; and

use the characteristic parameter to generate the manipulated variable to be output to the servo driver.

16. The non-transitory computer-readable storage medium according to claim 10 , wherein the control program, when executed by the control device, further causes the control device to:

generate a characteristic parameter which defines the first dynamics model;

use a measured position of the controlled object to generate the waveform parameter; and

use the characteristic parameter and the waveform parameter to generate the manipulated variable to be output to the servo driver.