阅读说明：本技术 设定支持装置 (Setting support device ) 是由 藤冈巧 恵木守 于 2019-08-07 设计创作，主要内容包括：设定支持装置包括：第一确定部件,确定评估指标值,所述评估指标值表示负载装置的姿势或状况互不相同的多个负载装置状态的各状态下的、所述马达控制装置所进行的马达控制的稳定性或控制性能；第二确定部件,基于由所述第一确定部件所确定的、关于所述多个负载装置状态的所述评估指标值,来确定合成评估指标值,所述合成评估指标值代表关于所述多个负载装置状态的所述评估指标值；以及显示控制部件,将由所述第二确定部件所确定的所述合成评估指标值显示于显示器的画面上。由此,能够缩短对于对驱动机械参数根据姿势等而变化的负载装置的马达进行控制的马达控制装置的参数值设定所需的时间。(The setting support device includes: a first determination unit that determines an evaluation index value indicating stability or control performance of motor control by the motor control device in each of a plurality of load device states in which postures or situations of the load devices are different from each other; a second determination unit that determines a composite evaluation index value representing the evaluation index values with respect to the plurality of load device states, based on the evaluation index values with respect to the plurality of load device states determined by the first determination unit; and a display control unit that displays the composite evaluation index value determined by the second determination unit on a screen of a display. This can shorten the time required for setting the parameter value of the motor control device for controlling the motor that drives the load device whose mechanical parameter changes according to the posture or the like.)

1. A setting support device that supports setting of a control parameter for a motor control device that controls a motor that drives a load device whose mechanical parameter changes in accordance with a posture or a situation, the setting support device characterized by comprising:

a first determination unit that determines an evaluation index value indicating stability or control performance of motor control by the motor control device in each of a plurality of load device states in which postures or situations of the load device are different from each other;

a second determination unit that determines a composite evaluation index value representing the evaluation index values with respect to the plurality of load device states, based on the evaluation index values with respect to the plurality of load device states determined by the first determination unit; and

a display control unit that displays the composite evaluation index value determined by the second determination unit on a screen of a display.

2. The setting support apparatus according to claim 1,

the second determination means determines a worst value of the evaluation index values regarding the plurality of load device states as the composite evaluation index value.

3. The setting support apparatus according to claim 1 or 2,

the first determination means determines the evaluation index value in each of the plurality of load device states with respect to each of a plurality of control device states in which a value of at least one control parameter of the motor control device is different from each other,

the second determination means determines the composite evaluation index value in accordance with the control device state,

the display control means displays each of the composite evaluation index values determined by the second determination means on the screen of the display in a form associated with information indicating the state of the control device for which each of the composite evaluation index values is determined.

4. The setting support apparatus according to claim 3,

the display control means displays a graph showing a relationship between the value of the one control parameter in each control apparatus state and the composite evaluation index value for each control apparatus state on the screen of the display.

5. The setting support apparatus according to claim 1 or 2,

the first determination unit calculates each evaluation index value based on an estimation result of a frequency response of a servo system including the motor control device.

6. The setting support apparatus according to claim 1 or 2,

the first determination means calculates each evaluation index value based on a result of actual measurement of a frequency response of a servo system including the motor control device.

7. The setting support apparatus according to claim 3 or 4, characterized by further comprising:

a recommended value determination section that determines a recommended value of the at least one control parameter based on the composite evaluation index value with respect to the plurality of load device states,

the display control means further displays the recommended value determined by the recommended value determination means on the screen of the display.

8. The setting support apparatus according to claim 1,

the first determination means determines a first evaluation index value and a second evaluation index value indicating stability or control performance of motor control by the motor control device in each of the plurality of load device states in which postures of the load devices are different from each other,

the second determination means determines a first composite evaluation index value representing the first evaluation index value with respect to the plurality of load device states and a second composite evaluation index value representing the second evaluation index value with respect to the plurality of load device states, based on the first evaluation index value and the second evaluation index value with respect to the plurality of load device states calculated by the first determination means,

the display control means displays the first composite evaluation index value and the second composite evaluation index value on the screen of the display.

9. The setting support apparatus according to claim 3,

the plurality of control device states are states in which at least combinations of values of the first control parameter and values of the second control parameter are different from each other.

10. The setting support apparatus according to claim 9, characterized by further comprising:

and a calculation unit that calculates values of one or more control parameters different from both the first control parameter and the second control parameter in each control apparatus state, based on the value of the first control parameter or the value of the second control parameter in each control apparatus state.

11. Setting support apparatus according to claim 9 or 10,

the first control parameter is a speed proportional gain and the second control parameter is a position proportional gain.

12. The setting support apparatus according to claim 11, characterized by further comprising:

a recommended value output unit that outputs a value K of the position proportional gain in the control device state according to the position proportional gain in the control device state for each control device state in which the composite evaluation index value determined by the second determination unit satisfies a first prescribed condition_ppAnd the value K of the speed proportional gain_vpAnd a constant q₁And constant q₂Calculating the evaluation value E by the following calculation formula, K when the maximum evaluation value E is calculated_ppAnd K_vpDetermining and outputting the recommended value of the velocity proportional gain and the recommended value of the position proportional gain,

[ number 1]

E＝q₁K_pp ²+q₂K_vp ²。

13. The setting support apparatus according to any one of claims 1 to 12,

the evaluation index value is the peak value of the gain crest of the position closed loop or the speed closed loop.

14. The setting support apparatus according to any one of claims 1 to 12,

the evaluation index value is a gain margin or a phase margin of the position open loop or the speed open loop.

15. The setting support apparatus according to any one of claims 1 to 14, characterized by further comprising:

a notch parameter recommended value output unit that determines an optimum value of a parameter of a notch filter in the motor control device in each of the plurality of load device states; and determining a third evaluation index value indicating stability or control performance of the motor control by the motor control device when the parameter value of the notch filter is the optimum value in each load device state, with respect to each of the plurality of load device states; determining, for each of the optimal values, a second composite evaluation index value representing the third evaluation index value that has been determined as the value at which the optimal value is a parameter of the notch filter; and determining and outputting a recommended value of a parameter of the notch filter based on the second composite evaluation index value determined for each of the optimum values.

16. A setting support device that supports setting of a control parameter for a motor control device that controls a motor that drives a load device whose mechanical parameter changes in accordance with a posture or a situation, the setting support device characterized by comprising:

a determination unit that determines an evaluation index value indicating stability or control performance of motor control by the motor control device in each of a plurality of load device states in which postures or situations of the load devices are different from each other; and

a display control unit that displays information indicating the evaluation index value regarding the plurality of load device states calculated by the determination unit on a screen of a display.

Technical Field

The present invention relates to a setting support device for supporting setting of parameter values for a motor control device.

Background

In a system such as a serial link robot (serial link robot), mechanical parameters (inertia, etc.) of a load device of each motor vary depending on the posture of the load device. Therefore, the values of the various control parameters of the motor control devices of the motors in such a system must be values that can control the motors well regardless of the posture of the load device, but the conventional technique for setting the control parameters of the motor control devices (see patent document 1, for example) is premised on the fixation of the mechanical parameters of the load device. Therefore, when setting and adjusting various control parameters of a motor control device that controls a motor that drives a load device in which a machine parameter changes according to the posture, the work of "setting and adjusting a control parameter value → evaluating → changing the posture of the load device → evaluating" has to be repeated a plurality of times.

Since the mechanical parameter of the load device may vary depending on the state of the load device (presence or absence, change, and the like of the load weight), a technique is desired that can shorten the time required for setting the parameter value of the motor control device for driving the motor of the load device in which the mechanical parameter varies depending on the posture or the state.

Documents of the prior art

Patent document

Patent document 1: japanese patent laid-open publication No. 2017-167607

Disclosure of Invention

Problems to be solved by the invention

The present invention has been made in view of the above-described problems, and an object thereof is to provide a setting support device capable of shortening the time required for setting a parameter value of a motor control device that controls a motor that drives a load device in which a mechanical parameter changes depending on a posture or a situation.

Means for solving the problems

In order to achieve the above object, a setting support device according to an aspect of the present invention supports setting of a control parameter for a motor control device that controls a motor that drives a load device whose mechanical parameter changes according to a posture or a situation, the setting support device including: a first determination unit that determines an evaluation index value indicating stability or control performance of motor control by the motor control device in each of a plurality of load device states in which postures or situations of the load device are different from each other; a second determination unit that determines a composite evaluation index value representing the evaluation index values with respect to the plurality of load device states, based on the evaluation index values with respect to the plurality of load device states determined by the first determination unit; and a display control unit that displays the composite evaluation index value determined by the second determination unit on a screen of a display.

That is, the setting support device displays a composite evaluation index value representing evaluation index values regarding a plurality of load device states on a screen of a display. Therefore, the user of the setting support device can determine whether or not the current control parameter value of the motor control device is appropriate (no problem occurs in all postures/conditions of the load device) by simply looking at the composite evaluation index value. Therefore, according to the setting support device, it is possible to shorten the time required for setting the parameter value of the motor control device that controls the motor that drives the load device in which the mechanical parameter changes according to the posture or the situation.

As the "composite evaluation index value", the "worst value of the evaluation index values with respect to the plurality of load device states" is generally used. However, it is also possible to estimate the evaluation index value for each posture or situation that is not the target of the evaluation index value determination from the relationship between the posture or situation and the evaluation index value, and to use the estimation result of the worst evaluation index value as the composite evaluation index value.

The setting support device may be configured such that: "the first determination means determines the evaluation index value in each of the plurality of load device states with respect to each of a plurality of control device states in which at least one control parameter of the motor control device has a value different from each other, the second determination means determines the composite evaluation index value in accordance with the control device state, and the display control means displays each composite evaluation index value determined by the second determination means on the screen of the display in a form associated with information indicating the control device state in which each composite evaluation index value is determined". In the case where this configuration (hereinafter referred to as a first configuration) is adopted for the setting support device, the display control means may display a graph showing a relationship between the value of the one control parameter in each control device state and the composite evaluation index value for each control device state on the screen of the display.

The first determining means may calculate each of the evaluation index values based on an estimation result of a frequency response of a servo system including the motor control device, or may calculate each of the evaluation index values based on an actual measurement result of a frequency response of a servo system including the motor control device.

In the case where the first configuration is adopted for the setting support device, it is also possible to add, to the setting support device, recommended value determining means for determining a recommended value of the at least one control parameter based on the composite evaluation index value regarding the plurality of load device states, and as display control means, means for further displaying the recommended value determined by the recommended value determining means on the screen of the display.

Further, the setting support device may be configured such that: "the first determination means determines a first evaluation index value and a second evaluation index value representing stability or control performance of motor control by the motor control device in each of the plurality of load device states in which postures of the load device are different from each other, the second determination means determines a first composite evaluation index value representing the first evaluation index value with respect to the plurality of load device states and a second composite evaluation index value representing the second evaluation index value with respect to the plurality of load device states based on the first evaluation index value and the second evaluation index value with respect to the plurality of load device states calculated by the first determination means, the display control means displays the first composite evaluation index value and the second composite evaluation index value On the screen of the display.

The plurality of control device states in the setting support device may be states in which at least combinations of the values of the first control parameter and the values of the second control parameter are different from each other.

When a plurality of control device states are the states, a calculation means may be added to the setting support device, the calculation means calculating the value of one or more control parameters different from both the first control parameter and the second control parameter in each control device state, based on the value of the first control parameter or the value of the second control parameter in each control device state.

The first control parameter may also be a speed proportional gain and the second control parameter may also be a position proportional gain. Further, the setting support device may further include recommended value output means for outputting the value K of the position proportional gain in the control device state for each control device state in which the composite evaluation index value determined by the second determination means satisfies a first predetermined condition, based on the value K of the position proportional gain in the control device state_ppAnd the value K of the speed proportional gain_vpAnd a constant q₁And constant q₂Calculating the evaluation value E by the following calculation formula, K when the maximum evaluation value E is calculated_ppAnd K_vpAnd determining and outputting the recommended value of the speed proportional gain and the recommended value of the position proportional gain.

[ number 1]

E＝q₁K_pp ²+q₂K_vp ²

The evaluation index value is preferably an index value of stability. Therefore, the evaluation index value is preferably a gain peak of the position closed loop or the speed closed loop, or a gain margin or a phase margin of the position open loop or the speed open loop.

A notch parameter recommendation value output unit that determines an optimum value of a parameter of a notch filter in the motor control device in each of the plurality of load device states may be added to the setting support device; and determining a third evaluation index value indicating stability or control performance of the motor control by the motor control device when the parameter value of the notch filter is the optimum value in each load device state, with respect to each of the plurality of load device states; determining, for each of the optimal values, a second composite evaluation index value representing the third evaluation index value that has been determined as the value at which the optimal value is a parameter of the notch filter; and determining and outputting a recommended value of a parameter of the notch filter based on the second composite evaluation index value determined for each of the optimum values.

Further, a setting support device according to an aspect of the present invention supports setting of a control parameter for a motor control device that controls a motor that drives a load device whose mechanical parameter changes according to a posture or a situation, the setting support device including: a determination unit that determines an evaluation index value indicating stability or control performance of motor control by the motor control device in each of a plurality of load device states in which postures or situations of the load devices are different from each other; and a display control unit that displays information indicating the evaluation index value calculated by the determination unit with respect to the plurality of load device states on a screen of a display.

That is, the setting support device (hereinafter referred to as a second setting support device) displays information indicating evaluation index values regarding the states of the plurality of load devices on the screen of the display. Therefore, the user who sets the support device can determine whether or not the current control parameter value of the motor control device is appropriate based on the information (no problem occurs in all postures and conditions of the load device). Therefore, according to the setting support device, it is possible to shorten the time required for setting the parameter value of the motor control device that controls the motor that drives the load device in which the mechanical parameter changes according to the posture or the situation.

In addition, "information indicating the evaluation index value regarding a plurality of load device states" in the second setting support device may be any form of information. For example, the second setting support device may be configured such that: "the determination means determines the evaluation index value in each of the plurality of load device states with respect to each of a plurality of control device states in which values of at least one control parameter of the motor control device are different from each other, and the display control means displays the composite evaluation index value determined with respect to the plurality of control device states by the determination means in a tab (tab) according to the load device state".

ADVANTAGEOUS EFFECTS OF INVENTION

According to the present invention, it is possible to provide a setting support device capable of shortening the time required for setting the parameter value of a motor control device that controls a motor that drives a load device in which a mechanical parameter changes depending on the posture or the situation.

Drawings

Fig. 1 is an explanatory view of a usage form of a setting support device 10 according to an embodiment of the present invention.

Fig. 2 is a block diagram for explaining control parameters of the motor control device.

Fig. 3 is a functional block diagram of the setting support apparatus 10.

Fig. 4A is an explanatory diagram of the position closed loop characteristic Gp _ closed and the position open loop characteristic Gp _ open.

Fig. 4B is an explanatory diagram of the speed closed-loop characteristic Gv _ closed and the speed open-loop characteristic Gv _ open.

Fig. 5 is a flowchart of the first setting support process.

Fig. 6 is an explanatory diagram of a synthesized gain peak map.

Fig. 7 is an explanatory diagram of information displayed as a result of the second setting support process.

Fig. 8 is an explanatory diagram of information displayed as a result of the processing by the second setting support processing.

Fig. 9 is an explanatory diagram of information displayed as a result of the processing by the second setting support processing.

FIG. 10 is a flowchart of a notching parameter setting support process.

Detailed Description

Hereinafter, embodiments of the present invention will be described based on the drawings.

Fig. 1 shows an example of a usage form of a setting support device 10 according to an embodiment of the present invention.

The setting support device 10 of the present embodiment is a device for supporting the setting of parameter values for the motor control device 30, and the motor control device 30 controls the motor 41 that drives the load device 42 in which the mechanical parameter changes according to the posture or the situation.

The motor control device 30 is a device that controls the motor 41 in accordance with a command (a position command, a torque command, or a speed command) input from a host device (not shown) such as a Programmable Logic Controller (PLC). Hereinafter, a portion including the motor 41 and the load device 42 is referred to as a control target 40, and a portion including the motor control device 30 and the control target 40 is referred to as a servo system.

When a position command is input from a higher-level device, the motor control device 30 operates as a position controller 31, a speed controller 32, a current controller 34, a speed detector 35, and the like, as shown in fig. 2.

The speed detector 35 is a unit that integrates a position (hereinafter referred to as a detection position) of the control object 40 detected by an encoder (not shown) attached to the motor 41 or the load device 42, and outputs a speed (hereinafter referred to as a detection speed) of the control object 40.

The position controller 31 has a position proportional gain K_ppAs a unit of control parameters. As shown in the figure, the position controller 31 inputs a position deviation, which is a deviation of a position command from a detected position. And, the position controller 31 calculates a position proportional gain K to multiply the position deviation by the position proportional gain K_ppThe obtained value is the speed command and is output.

The speed controller 32 is a unit that performs Proportional Integral (PI) control in which a speed deviation, which is a deviation between a speed command and a detected speed, is used as an operation amount and a torque command is used as a control amount. The speed controller 32 has a speed proportional gain K_vpAnd integral gain K_iAs a control parameter.

The speed controller 32 includes a torque filter (low pass filter) and a notch filter (notch filter) that can set ON/OFF (ON/OFF) (whether or not to function). The torque filter in the speed controller 32 has a cutoff frequency as a control parameter (hereinafter also referred to as a filter parameter), and the notch filter in the speed controller 32 has a center frequency, a notch depth, and a Q value (center frequency/notch width) as control parameters (hereinafter also referred to as a filter parameter).

The current controller 34 is a unit that generates a drive current corresponding to the torque command from the speed controller 32 and supplies the drive current to the motor.

On the premise of the above, the configuration and operation of the setting support device 10 will be described in detail below.

Fig. 3 shows a functional block diagram of the setting support apparatus 10.

The setting support apparatus 10 according to the present embodiment is an apparatus in which a setting support program is installed in a Personal Computer (PC). As shown in fig. 3, the setting support program installed in the PC causes a main body 13 (a portion including a Central Processing Unit (CPU) and peripheral components) of the PC to operate as an arithmetic Processing Unit 14, a User Interface (UI) Unit 15, and a display control Unit 16.

The display control unit 16 is a functional block that displays an image of the content instructed from the arithmetic processing unit 14 or the UI unit 15 on the screen of the display device 12. The UI unit 15 is a functional block for causing the arithmetic processing unit 14 to execute a process of a type specified by a user under a process condition specified by the user by causing the arithmetic processing unit 14 to specify the type and the process condition of the process to be executed by the user by operating the input device 11 such as a mouse or a keyboard by the user.

The arithmetic processing unit 14 is a functional block that can execute the first setting support process, the second setting support process, the notch parameter setting support process, and the like.

Hereinafter, each process will be described in order. In the following description of the respective processes, the posture or the state of the load device 42 will be simply referred to as the posture of the load device 42. In the following description, the closed-loop position characteristic Gp _ closed and the open-loop position characteristic Gp _ open refer to frequency transfer functions of the servo system at portions indicated by dashed boxes 51 and 52 in fig. 4A, respectively. The velocity closed-loop characteristic Gv _ closed and the velocity open-loop characteristic Gv _ open refer to frequency transfer functions of the servo system at portions indicated by dashed boxes 53 and 54 in fig. 4B, respectively.

First setting support processing

Fig. 5 is a flowchart of the first setting support process.

The first setting support process is a process capable of setting, as processing conditions, the total number n of postures to be evaluated and information defining the contents of processing to be executed to set the posture of the load device 42 to the 1 st posture to the nth posture. However, when the setting support apparatus 10 cannot control the posture of the load device 42 (when the user performs the posture change operation of the load device 42), the setting of the predetermined information on the processing contents is omitted. In step S102 of the first setting support process, a process of waiting for input of information indicating that the posture work of the load device 42 is completed is performed instead of the process described below.

Specifically, as shown in the figure, the arithmetic processing unit 14 which has started the first setting support process first sets "1" to the variable i (step S101). Next, the arithmetic processing unit 14 controls the posture of the load device 42 to the i-th posture (step S102). As described above, when the setting support device 10 cannot control the posture of the load device 42, for example, in step S102, a process of waiting for information to be input that the posture work of the load device 42 is completed is performed.

When the control of the posture of the load device 42 to the i-th posture is completed, the arithmetic processing unit 14 controls the motor control device 30 to measure the position closed loop characteristic Gp _ closed (arrangement of plural numbers) (step S103). This processing may be "processing for periodically collecting the detected positions while inputting a position command that changes over time so as to include a plurality of frequency components to the motor control device 30 and calculating the position closed-loop characteristic Gp _ closed by taking a ratio of the input position command and the collected detected positions through fourier transform", or "processing for measuring the position closed-loop characteristic Gp _ closed by the motor control device 30 and acquiring a measurement result from the motor control device 30".

Then, the arithmetic processing unit 14 calculates the controlled object characteristic P (the frequency transfer function P of the controlled object 40) using the measurement result (step S103). More specifically, the arithmetic processing unit 14 first determines various parameters (K) at the time point (Gv _ closed measurement time point)_pp、K_vp、K_iFilter parameters) to determine the characteristic (frequency transfer function, the same applies hereinafter) Cp of the position controller 31 and the characteristic Cv of the velocity controller 32. Then, the arithmetic processing unit 14 calculates the controlled object characteristic P from the determined characteristics Cp and Cv and the characteristics Cd and Gv _ close of the speed detector 35 (see fig. 4B).

The arithmetic processing unit 14 having completed the processing of step S103 calculates an evaluation index value for each of the plurality of device setting states using the control target characteristic P in step S104 (step S104). More specifically, the arithmetic processing unit 14 repeats "processing of determining the characteristics of each unit in the device setting state (the characteristic Cp of the position controller 31 and the characteristic Cv of the speed controller 32)," calculating Gp _ closed from the determined characteristics of each unit, the characteristic Cd, and the controlled object characteristic P, and calculating the evaluation index value from the calculated Gp _ closed "for each device setting state.

The plurality of control device states are position proportional gains K_ppProportional to speed gain K_vpAre different from each other, and the integral gain K_iTo gain the speed proportion by K_vpThe value obtained by multiplying 1/4, the cut-off frequency of the torque filter is the speed proportional gain K_vpThe filter parameter value of the notch filter is a value obtained by multiplying 6.8, and is a value at the start time point of the first setting support process. The evaluation index value is a gain peak (peak of gain peak) of the position closed loop. The evaluation index value may also be other information (stabilization time, etc.). However, the evaluation index value is preferably an index value of stability such as a gain peak of the position closed loop or the speed closed loop, or a gain margin or a phase margin of the position open loop or the speed open loop.

The arithmetic processing unit 14 having completed the processing of step S104 determines whether the value i is smaller than the total number n of the evaluation target postures (step S105). When the value of i is smaller than n (step S105; YES), the arithmetic processing unit 14 increases the value of i by "1" (step S106), and thereafter, executes the processing from step S102 onward again.

If the value of i is not less than n (step S105; NO), the arithmetic processing unit 14 determines the worst value of the evaluation index values for the respective device setting states as the composite evaluation index value for the respective device setting states (step S107). More specifically, in step S107, a process is performed in which the worst value among n evaluation index values having different postures of the load device is searched for in accordance with the device setting state, and the searched worst value is stored as a composite evaluation index value. The processing in step S107 may be other processing, for example, processing of estimating an evaluation index value for each posture that is not a target of evaluation index value determination from a relationship between the posture and the evaluation index value, and setting the estimation result of the worst evaluation index value as a composite evaluation index value.

The arithmetic processing unit 14 having completed the processing of step S107 determines the position proportional gain K based on the composite evaluation index value determined according to the device setting state_ppProportional to speed gain K_vpIs set (step S108). The processing performed by the arithmetic processing unit 14 of the present embodiment in step S108 is processing in which the synthesis estimation index value is a predetermined value (for example, 1 dB)]) K is as follows_ppAnd K_vpThe evaluation value E is calculated by the following calculation formula, and K is the maximum evaluation value E_ppAnd K_vpIs determined as K_ppAnd K_vpThe recommended value of (1).

[ number 2]

E＝q₁K_pp ²+q₂K_vp ²

In addition, q is₁、q₂Is a predetermined constant.

In a certain device setting state a, if the evaluation index value when the load device 42 takes the j-th posture is referred to as an evaluation index value # j, it can be said that the composite evaluation index value with respect to the device setting state a is the worst value among the evaluation index values #1 to # n. Also, the evaluation index value (gain peak value) is a value positively correlated with the safety. Therefore, no matter the synthesis evaluation index value is set to K below the predetermined value_ppAnd K_vpWhich of the combinations is set to the motor control device 30 can ensure safety regardless of the posture of the load device 42. And, a speed proportional gain K_vpIntegral gain K_iAll of them are values having a substantially positive correlation with the track following performance, and therefore, if the composite evaluation index value is a predetermined value, K is searched for the evaluation value E_ppAnd K_vpIn combination, the stability can be ensured regardless of the posture of the load device 42, and K that exhibits the maximum performance of the motor control device 30 can be specified_ppAnd K_vpGroup (2)And (i.e., K)_ppAnd K_vpRecommended value of).

The arithmetic processing unit 14 having completed the processing of step S108 displays the synthesized gain peak map on the screen of the display device 12 by the display control unit 16 (step S109).

Fig. 6 shows an example of a synthesized gain peak map. As shown, the resultant gain-peak map is substantially for the velocity proportional gain K_vpValue of (3) and position proportional gain K_ppIn each combination of (1), a graph indicating the recommended value (∘) is displayed on a contour diagram indicating the stability index value in color.

The arithmetic processing unit 14 having completed the processing of step S109 waits for (monitors) the input of the end instruction or the setting instruction (step S110; none). When a setting instruction is input (step S110; setting), the arithmetic processing unit 14 sets each recommended value (and a value calculated based on each recommended value) to the motor control device 30 (step S111), and then ends the first setting support process. When the termination instruction is input (step S110; end), the arithmetic processing unit 14 terminates the first setting support process without changing the control parameter values of the motor control device 30.

Second setting support processing

Hereinafter, the contents of the second setting support process will be described centering on the difference from the first setting support process, using fig. 5 which is a flowchart of the first setting support process.

The second setting support process is essentially the same content process as the first setting support process. However, the second setting support process is a process capable of specifying what state the plurality of control target states are (which parameter the setting target control parameter is set to, how the setting target control parameter is changed, whether or not to link a parameter other than the setting target control parameter with the setting target control parameter value, and the like). In addition, the second setting support process may specify the number and type of evaluation target values to be calculated, and in step S104 of the second setting support process, the evaluation index value of the type and number specified by the user is calculated for each of the plurality of control target states specified by the user.

Specifically, for example, when the user designates the settling time as the evaluation index value and designates the control parameter a as the setting target control parameter, the settling time is calculated in step S104 in accordance with the posture and in accordance with the control device state. When the correspondence between the settling time and the control device state (control parameter a value) shown in fig. 7(a), (B), and (C) is obtained for each of the first to third postures (where n is 3), the worst value of the settling time in the first to third postures is obtained in step S107 in accordance with the value of the control parameter a, and is used as the synthesis estimation index value.

In the second setting support process, the process of step S108 is omitted, and in step S109, a graph shown in (D) of fig. 7, that is, a graph in which the optimum value of the control parameter a is clearly 11 is displayed on the screen of the display device 12. In addition, the dotted line, the one-dot chain line, and the broken line shown in this graph are lines which are not actually shown.

In step S110 of the second setting support process in which only one value is designated as the evaluation index value, the progress of an operation of designating one point on the graph with a mouse or the like and a predetermined end instruction operation is monitored. When the former operation is performed, the value corresponding to the X coordinate of the designated point is set as the value of the control parameter a to the motor control device 30, and the second setting support process is terminated. When the end instruction operation is performed, the second setting support process is simply ended.

In the case where various values, for example, the settling time and the overshoot amount are specified as the evaluation index value, the settling time and the overshoot amount are calculated in step S104. Next, in step S109, as shown in fig. 8, a graph regarding the settling time (combined settling time) and a graph regarding the overshoot (combined overshoot) are displayed on the screen of the display device 12. Further, ". smallcircle" on each graph is an indicator (pointer) that moves in conjunction on the curve in each graph. The user can easily grasp the overshoot and the settling time when the control parameter a value is set to a certain value, from the Y-direction position (height) of the pointer on each graph.

In step S110 of the second setting support process in which two values are designated as the evaluation index value, the progress of an operation of designating one point on the graph with a mouse or the like and a predetermined end instruction operation is monitored. When the former operation is performed, the value corresponding to the X coordinate of the designated point is set as the value of the control parameter a to the motor control device 30, and the second setting support process is terminated. When the end instruction operation is performed, the second setting support process is simply ended.

Further, the second setting support process is a process capable of calculating several evaluation index values while maintaining the current parameter setting.

When it is instructed by the user to perform estimation of the peak value of the gain peak of the stationary time and position closed loop or the like in a state where the current parameter setting is held, the peak value of the stationary time and the gain peak is calculated as the estimation index value in a state where the current parameter setting is held in step S104.

Then, instead of the processing of steps S108 and S109, processing is performed to display the combined evaluation index value for the settling time and the peak value of the gain peak on the screen of the display, and in step S110, processing is performed to monitor only the input of the end instruction.

When the user instructs to evaluate the peak values of the settling time and the gain peak while keeping the current parameter settings, the peak values of the settling time and the gain peak are calculated for each posture as shown in fig. 9, and a composite evaluation index value for each index value is also calculated. However, only the composite evaluation index value is presented to the user. Therefore, the user can determine whether or not the current setting is appropriate without being bothered about what information the user should look at.

Processing for supporting setting of trap parameters

Fig. 10 is a flowchart of the notching parameter setting support process.

As shown in the drawing, the arithmetic processing unit 14 having started the notch parameter setting support process first determines the optimum values of the filter parameters (center frequency, notch depth, Q value or less, NF parameters) of the notch filter in each of the postures of the load device 42 (step S201). The processing of step S201 is processing of measuring the position closed loop characteristic Gp _ closed, and determining the optimum value from the position and shape of the resonance peak of the measurement result.

Next, the arithmetic processing unit 14 calculates an evaluation index value (in the present embodiment, a gain peak of the position closed loop) when the NF parameter value is the determined optimum value for each posture for which the optimum value is determined (step S202). Then, the arithmetic processing unit 14 determines a composite evaluation index value for each NF parameter value (for each determined optimum value) (step S203).

Subsequently, the arithmetic processing unit 14 searches for an optimum synthesis evaluation index value from the determined synthesis evaluation index values, and determines an NF parameter value in which the searched synthesis evaluation index value (hereinafter, referred to as a corresponding synthesis evaluation index value) is determined as a recommended value of the NF parameter (step S204).

In the next step S205, the arithmetic processing unit 14 displays the determined recommended value and the composite evaluation index value on the screen of the display device 12. Subsequently, the arithmetic processing unit 14 waits for (monitors) the input of an end instruction or a setting instruction (step S206; none). When a setting instruction is input (step S206; setting), the arithmetic processing unit 14 sets the recommended value to the motor control device 30 (step S207), and then ends the notch parameter setting support process. When an end instruction is input (step S206; end), the arithmetic processing unit 14 ends the notch parameter setting support process without changing the parameter values of the notch filter.

As described above, the setting support device 10 according to the present embodiment can display the composite evaluation index value, which is the worst value of the evaluation index values when the load device 42 takes various postures or when the load device 42 is in various situations, on the screen of the display device 12 in various forms (fig. 6, 7(D), 8, and 9). Therefore, the user of the setting support apparatus 10 can grasp whether or not the current control parameter value of the motor control apparatus 30 is appropriate (no problem occurs in all postures of the load apparatus 42) or what value is preferably used for the control parameter value, by looking at the composite evaluation index value. Further, the setting support device 10 also has a function of calculating a recommended value and setting it to the motor control device 30. Therefore, according to the setting support device 10, it is possible to shorten the time required for setting the parameter value of the motor control device 30 that controls the motor 41 that drives the load device 42 whose mechanical parameter changes according to the posture or the situation.

The setting support device 10 also has a function of determining an NF parameter value for which the composite evaluation index value is optimal and outputting the NF parameter value as a recommended value (fig. 10). If the composite evaluation index value is optimal, the range (parameter value range) in which stability (control performance in the case where the evaluation index value is an index value of the control performance) can be ensured becomes wide. Therefore, if the first setting support process is executed after the use of the above-described function, it is possible to set a control parameter value that substantially exhibits the maximum performance to the motor control device 30.

"deformation form

The setting support device 10 can be variously modified. For example, the setting support device 10 may be modified to be a device that calculates each evaluation index value based on the actual measurement result of the position closed loop characteristic. Further, the determination K may be given to the notch parameter setting support processing_ppAnd K_vpThe recommended value of (a). Further, the first setting support process (fig. 5) may be modified to a process in which the index value relating to the control performance is further calculated in step S104, and K is determined based on the index value relating to the control performance in step S108_ppAnd K_vpThe recommended value of (1).

Further, the setting support device 10 may be modified to be a device that does not obtain the composite evaluation index value, but presents the evaluation index value itself determined with respect to the load device state to the user, that is, a device that displays (for example, displays a label on the screen of the display device 12) the graphs shown in fig. 7(a) to 7(C) instead of the graph shown in fig. 7 (D). However, when the setting support device 10 is modified to such a device, the user needs to compare a plurality of evaluation index values, and thus it is preferable to obtain a composite evaluation index value as in the above-described embodiment.

Remarks attached hereto

A setting support device (10) that supports setting of a control parameter for a motor control device (30), the motor control device (30) controlling a motor (41) that drives a load device (42) in which a mechanical parameter changes according to a posture or a situation, the setting support device (10) characterized by comprising:

a first determination unit (14) that determines an evaluation index value indicating stability or control performance of motor control by the motor control device (30) in each of a plurality of load device states in which postures of the load devices (42) are different from each other;

a second determination means (14) that determines a composite evaluation index value that represents the evaluation index values with respect to the plurality of load device states, based on the evaluation index values with respect to the plurality of load device states determined by the first determination means (14); and

display control means (14, 16) for displaying the composite evaluation index value determined by the second determination means (14) on a screen of a display (12).

A setting support device (10) that supports setting of a control parameter for a motor control device (30), the motor control device (30) controlling a motor (41) that drives a load device (42) in which a mechanical parameter changes according to a posture or a situation, the setting support device (10) characterized by comprising:

a determination unit (14) that determines an evaluation index value indicating the stability or control performance of motor control by the motor control device (30) in each of a plurality of load device states in which the postures of the load devices (42) are different from each other; and

and display control means (14, 16) for displaying information indicating the evaluation index value on the plurality of load device states calculated by the determination means (14) on a screen of a display (12).

Description of the symbols

10: setting support device

11: input device

12: display device

13: body part

14: arithmetic processing unit

15: UI section

16: display control unit

30: motor control device

31: position controller

32: speed controller

34: current controller

35: position detector

40: control object

41: motor with a stator having a stator core

42: load device