Engine control unit

The control unit optimally adjusts the acceleration/deceleration time constant based on inertia estimation and feedback comparison, addressing instability in motor control by ensuring stability and performance through accurate matching of time constants to load characteristics.

DE102018209092B4Active Publication Date: 2024-12-05FANUC LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
DE102018209092
Authority / Receiving Office
DE · DE
Patent Type
Patents
Current Assignee / Owner
Priority Date
2017-06-14
Filing Date
2018-06-08
Publication Date
2024-12-05
Estimated Expiration
2038-06-08

AI Technical Summary

Technical Problem

Conventional motor control methods struggle to determine whether the acceleration/deceleration time constant is in an appropriate range, leading to unstable position control and reduced machining performance due to oscillations and inadequate consideration of physical events.

Method used

A control unit that includes an acceleration/deceleration time constant storage unit, position command generation, speed command generation, ideal feedback calculation, and feedback comparison units to determine and adjust the time constant based on inertia estimation, ensuring stability and performance by comparing ideal and actual feedback.

Benefits of technology

The control unit optimally adjusts the acceleration/deceleration time constant, improving machining performance and ensuring control stability by accurately matching the time constant to the physical characteristics of the load, thereby preventing oscillations and enhancing operational efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 00000000_0000_ABST
    Figure 00000000_0000_ABST
Patent Text Reader

Abstract

Control unit (2) of a motor (10) which drives a driven body (W), wherein the control unit comprises: an acceleration / deceleration time constant storage unit (41) that stores an acceleration / deceleration time constant which determines an acceleration / deceleration of the motor (10); a position command generation unit (42) that generates a position command value based on the acceleration / deceleration time constants; a position detection unit (12) that detects a rotational position of the motor (10); a speed command generation unit (43) that generates a speed command for the motor (10) based on the position command value and a position sensing value detected by the position sensing unit (12); a unit (44) for calculating ideal feedback, which calculates ideal feedback from the position command value using a low-pass filter (17); and a feedback comparison unit (45) that compares the ideal feedback with actual feedback acquired by the position sensing unit (12), wherein The feedback comparison unit (45) changes the acceleration / deceleration time constant stored in the acceleration / deceleration time constant storage unit (41) when it is determined that the ideal feedback does not match the actual feedback. wherein the feedback comparison unit (45) comprises an inertia estimation unit (22) which estimates an inertia based on a predefined estimation equation from a torque constant kt, a current I, an angular acceleration ω and a disturbance Tf, and changes the acceleration / deceleration time constant based on the estimated result.
Need to check novelty before this filing date? Find Prior Art

Description

Background of the invention; Field of the invention

[0001] The present invention relates to a control unit of a motor that drives a driven body. Related technology

[0002] Conventionally, patent documents 1 to 4 disclose techniques related to a control unit for controlling a motor to act on a driven body.

[0003] Patent document 1 discloses a technique for gradually changing parameters until the difference between the command and the feedback becomes smaller than an acceptable value, in cases where the optimal value of the servo parameter has changed due to aging. In patent document 1, in cases where oscillations are likely to occur in the actual feedback or where the control's sampling capability is low, the acceleration is gradually reduced and the time constant is increased until the position deviation falls within an acceptable range.

[0004] Patent document 2 discloses a method for detecting acceleration using an acceleration detector and for correcting the gain when the acceleration exceeds a certain threshold. Patent document 2 investigates whether the actual value, the mean value, and the root mean square of the acceleration difference between the motor and the load structure are greater than a predetermined value. The acceleration difference is obtained using an angle measurement of the motor and an acceleration measurement of the load structure.

[0005] Patent document 3 discloses a technique related to a device and a method for setting control parameters of a motor control unit, wherein a gain table is stored and an optimal gain is read out according to a machine stiffness. Patent document 3 relates to a technique for changing the gain value of a PL controller of a servo system and discloses a gain scheduling method in which the gain is increased when the load inertia is large and decreased when the load inertia is small.

[0006] Patent document 4 discloses as an inertia estimation method a technique in which the inertia is calculated from a representative current value and a representative acceleration value, both of which are obtained from current values ​​and acceleration values ​​in a plurality of periods of a sinusoidal command, which are stored in a sample data storage unit, together with a torque constant of a motor.

[0007] Patent document 5 relates to a control unit comprising a position command generation unit that generates a position command, a position control unit that issues a first speed command so that the detected position follows the position command, a pressure command generation unit that generates a pressure command, a pressure control unit that issues a second speed command so that the detected pressure or force follows the pressure command, a speed command selection unit that selects the creep speed, the first speed command or the second speed command and issues it as the speed command for operating the motor, and a speed control unit that issues a current command to supply current to the motor so that the motor speed follows the speed command issued by the speed command selection unit.After the first speed command is selected, the speed command selection unit selects the second speed command, or the creep speed, at the point when the first speed command falls below the creep speed. Patent document 1: JP 2011- 134 169 A Patent document 2: JP 2007- 141 189 A Patent document 3: JP 2005- 6 418 A Patent document 4: JP 2010- 148 178 A Patent document 5: US 2018 / 0120820 A1 and JP 6113378 B1 Overview of the invention

[0008] The effect on a driven body (a workpiece) by a motor is determined by the acceleration / deceleration time constant, which is adjusted based on the maximum load capacity of a machine tool. Although this time constant varies depending on the load of the machine tool's mechanism for moving the workpiece, the load of the workpiece being machined, and other factors, from a performance perspective, the acceleration time is preferably set as short as possible within the permissible range of the output torque. Conversely, if the motor is operated with an extremely short acceleration time (acceleration / deceleration time constant), the motor's position control can become unstable (vibrations may occur).

[0009] Furthermore, conventional techniques reveal a method for adjusting acceleration / deceleration. For example, if the scanning capability is low, patent document 1 gradually reduces the acceleration and increases the time constant until the position deviation falls within an acceptable range. However, scanning capability is simply a matter of control power, and it is undesirable to alter the command path that determines the mode of operation in this way. Changing the time constant means changing the command form, and there is no intention to find a truly probable physical process. Patent document 2 requires the provision of an additional detector, such as an accelerometer, in the load structure. Patent documents 3 and 4 do not determine whether the resulting acceleration is suitable.

[0010] One objective of the present invention is to provide a motor control unit that is able to determine whether an acceleration / deceleration time constant is within a reasonable range, and to implement both the improvement of machining performance and the assurance of control stability. (1) The present invention provides a control unit (for example, a control unit 2 described below) for a motor (for example, a motor 10 described below) that drives a driven body (for example, a workpiece W described below), wherein the control unit comprises: an acceleration / deceleration time constant storage unit (for example, an acceleration / deceleration time constant storage unit 41 described below) that stores an acceleration / deceleration time constant that determines an acceleration / deceleration of the motor; a position command generation unit (for example, a position command generation unit 42 described below) that generates a position command value based on the acceleration / deceleration time constant;a position sensing unit (for example, a position sensing unit 12 described below) that detects a rotational position of the motor; a speed command generation unit (for example, a speed command generation unit 43 described below) that generates a speed command for the motor based on the position command value and a position sensing value detected by the position sensing unit; a unit for calculating ideal feedback (for example, a unit 44 for calculating ideal feedback described below) that calculates ideal feedback from the position command value using a low-pass filter (for example, a low-pass filter 17 described below);and a feedback comparison unit (for example, a feedback comparison unit 45 described below) that compares the ideal feedback with actual feedback acquired by the position sensing unit, wherein the feedback comparison unit modifies the acceleration / deceleration time constant stored in the acceleration / deceleration time constant storage unit when it is determined that the ideal feedback does not match the actual feedback. (2) In the control unit according to (1) the feedback comparator unit can estimate an inertia and change the acceleration / deceleration time constant based on the estimated result. (3) In the control unit according to (1) or (2), the feedback comparison unit may calculate integral values ​​of values ​​obtained by calculating an error in a time series signal of the feedback, an absolute value thereof or a quadratic value thereof, and perform a feedback comparison based on an evaluation value obtained on the basis of the integral values ​​or a combination thereof. (4) In the control unit according to (3) the feedback comparison unit can determine that the comparison result is a mismatch if the evaluation value exceeds a threshold specified for this purpose.

[0011] According to the motor control unit of the present invention, it is possible to determine whether an acceleration / deceleration time constant is within a reasonable range, and to implement both the improvement of machining performance and the assurance of control stability. Brief description of the drawings Fig. Figure 1 is a diagram that schematically illustrates a machine tool for which a control unit according to an embodiment of the present invention is used. Fig. Figure 2 is a block diagram illustrating a design in connection with servo control of the control unit according to the present embodiment. Fig. 3A is an explanatory diagram illustrating a relationship between a command (with a time constant) and an ideal feedback. Fig. 3B is an explanatory diagram that illustrates a relationship between a command and an actual response. Fig. Figure 4A is a schematic representation illustrating the process of a conventional integration processing operation as a comparative example. Fig. Figure 4B is a schematic representation illustrating the process of an integration operation of the present embodiment. Fig. Figure 5 is a flowchart of an adjustment process of the acceleration / deceleration time constants based on a reaction comparison by a control unit of the present embodiment. Detailed description of the invention

[0012] A preferred embodiment of the present invention is described below with reference to the drawings.

[0013] Fig. Figure 1 is a diagram schematically illustrating a machine tool 1 for which a control unit according to an embodiment of the present invention is used. First, an example of a design of the machine tool 1 is described. In the Fig. The machine tool 1 illustrated in Figure 1 is a machining device that processes a workpiece (a driven body) W into a desired shape.

[0014] The machine tool 1 of the present embodiment includes a control unit 2, which includes a numerical control unit 20 and a servo control unit 30, a motor 10 controlled by the control unit 2 and a feed screw (a transmission mechanism) 11, which moves the workpiece W using the driving force of the motor 10.

[0015] The numerical control unit 20 is a computerized numerical control (CNC) and performs various operations to control the machine tool 1. The servo control unit 30 controls the drive of the motor 10 based on commands from the numerical control unit 20.

[0016] The motor 10 is a servo motor that exerts a driving force on the feed screw 11. When the feed screw 11 is driven, the workpiece W, which is a driven body, moves to a predetermined position. A position detector 12, such as a rotary encoder, is attached to the motor 10, and a detection signal obtained by the position detector 12 is used for various processing operations, such as control.

[0017] Fig. Figure 2 is a block diagram illustrating a design related to servo control of the control unit 2 according to the present embodiment. The respective in Fig. The two illustrated units are implemented by the numerical control unit 20 or the servo control unit 30, and their arrangement position is not subject to any particular restriction. Such functions can be implemented by the numerical control unit 20, the servo control unit 30, or by an external device other than the numerical control unit 20 and the servo control unit 30.

[0018] As in Fig. As illustrated in Figure 2, the control unit 2 includes an acceleration / deceleration time constant storage unit 41, a position command generation unit 42, a velocity command generation unit 43, a unit 44 for calculating ideal feedback, a feedback comparison unit 45 and a position sensing unit 12.

[0019] The acceleration / deceleration time constant storage unit 41 determines an acceleration / deceleration time constant associated with an acceleration / deceleration of the motor 10. An acceleration / deceleration time constant, determined based on an estimated inertia described below, is stored in the acceleration / deceleration time constant storage unit 41 and is updated at appropriate times. The position command generation unit 42 generates a position command value based on the acceleration / deceleration time constant. The velocity command generation unit 43 generates a velocity command for the motor 10 based on the position command value generated by the position command generation unit 42 and the position sensing value acquired by the position sensing unit 12.

[0020] Unit 44, for calculating ideal feedback, calculates ideal feedback from the position command value using a low-pass filter 17 (see Fig. 4B). Next, a relationship between ideal feedback and actual feedback is described.

[0021] Fig. Figure 3A is an explanatory diagram illustrating the relationship between a command (with a time constant) and ideal feedback. Ideal feedback from a servo controller is a behavior involving a primary delay and can be described by a low-pass filter. In other words, ideal feedback is feedback where the delay of a control system is added to a position command by a low-pass filter. In contrast, the filter based on the acceleration / deceleration time constants when generating commands on an upstream side is a moving average filter.Even if “the waveform of an ideal feedback (output of a low-pass filter)” and “the waveform of the command based on an acceleration / deceleration (output of a moving average filter)” are identical in a normal state, they therefore differ in a transition state.

[0022] Fig. 3B is an explanatory diagram that illustrates a relationship between a command and an actual response. As shown in Fig. As illustrated in Figure 3B, with conventional technology (for example, patent document 1), if vibrations are likely to occur in actual feedback or if the control's sampling capability is low, the acceleration is gradually reduced and the time constant is increased until the position deviation falls within an acceptable range. However, sampling capability is simply a matter of control power, and changing the acceleration / deceleration time constant results in a change in the command form. It is undesirable to change the command path, which determines an operating mode, in such a way.

[0023] Therefore, in the present embodiment, the suitability of an acceleration derived from inertia (an acceleration / deceleration time constant) is determined by the difference between an ideal feedback value and a sensing value. Since the acceleration / deceleration time constant is determined according to an inertial value, the acceleration / deceleration time constant should initially be suitable. In this case, the acceleration / deceleration time constant should correspond exactly to an ideal feedback of the low-pass filter 17 rather than that of a moving-average filter. In this sense, the time integration of the sum of the squares of the difference between an ideal feedback value and a sensing value should be zero, and it turns out that the process, with respect to a given instruction form, corresponds to a truly probable physical process.

[0024] Next, the difference between conventional integration processing and integration processing of the present embodiment will be described. Fig. Figure 4A is a schematic representation illustrating the process of a conventional integration procedure as a comparative example. As in Fig. Figure 4A illustrates that conventional technology (for example, patent document 2) investigates whether an actual value, a mean value, and a root mean square value of an "acceleration difference between a motor and a load structure" are greater than a predetermined value. The acceleration difference is obtained using a rotary encoder (an angle detection value) of the motor 10 and the detection value of the acceleration sensor 16 of the load structure 15. This design requires the provision of the acceleration sensor 16.

[0025] Fig. Figure 4B is a schematic representation illustrating the process flow of an integration operation of the present embodiment. As shown in Fig. As illustrated in Figure 4B, ideal feedback is obtained in the present embodiment through the low-pass filter 17. The suitability of the acceleration is determined by calculating the time integration of the sum of the squares of the difference between an ideal feedback value and a detection value, from the perspective of investigating whether an operation during a specific period of time corresponds to a truly probable physical operation with respect to a specific command form. Therefore, a small overshoot resulting from modeling errors in a machine setup is permissible in a control system.The present embodiment also differs from the conventional technology in that, in the case where the machine structure can be considered as an integrated structure, the limiting acceleration is obtained on the basis of an inertia estimate of the load structure 15 and the load structure 15 does not require the acceleration sensor 16.

[0026] As described above, the unit 44 for calculating ideal feedback of the present embodiment obtains ideal feedback using the low-pass filter 17. The feedback comparison unit 45 compares the ideal feedback obtained in this way with actual feedback. The actual feedback is obtained based on the position detection value of the position detection unit 12.

[0027] The feedback comparison unit 45 of the present embodiment determines, based on an evaluation value, whether the ideal feedback and the actual feedback correspond. The feedback comparison unit 45 calculates integral values ​​of values ​​obtained by calculating an error in a time-series signal of the feedback, an absolute value thereof, or a quadratic value thereof, and the evaluation value is obtained based on the integral values ​​or a combination thereof. A predetermined threshold value is set for the evaluation value, and whether the evaluation value deviates from the threshold value becomes the criterion for its determination.

[0028] The feedback comparison unit 45 of the present embodiment includes an inertia estimation unit 22 as a means of estimating the load or inertia (moment of inertia) of the mechanism of the machine tool 1 and the workpiece W, and the acceleration / deceleration time constant is adjusted on the basis of the inertia estimated by the inertia estimation unit 22 (see Fig. 2).

[0029] The inertia estimation unit 22 estimates the inertia of the workpiece W, which is mounted in the machine tool 1, based on a feedback signal (feedback information) from the motor 10, which is acquired during a predefined operation. The feedback signal from the motor 10 relates to torque, current, speed, and the like. For example, the inertia is calculated based on a speed feedback signal from the position detector 12 of the motor 10 or a current feedback signal from an amplifier (not illustrated) of the servo control unit 30.

[0030] The inertia estimator 22 calculates the inertia based on a predefined estimation equation. Equation (1) below, for example, can be used as an inertia estimation equation. The inertia estimator 22 acquires variables such as a current I, an angular acceleration ω, and a disturbance Tf as feedback signals for estimating the inertia. The current feedback signal can be obtained as an RMS current, which is calculated using the phase information from the position detector 12. The angular acceleration ω can be obtained, for example, by differentiating an angular velocity. The inertia estimation method is not limited to this procedure but can be modified as appropriate. Jw=(kt⋅l−Tf) / ω Jw inertia kt torque constant I current TF interference (friction or similar) ω Angular acceleration

[0031] An optimal adjustment of the acceleration / deceleration time constant based on the inertia derived from the estimate (hereinafter referred to as estimated inertia) is performed. Although the output torque to be generated by the motor 10 varies depending on the load of the mechanism of the machine tool 1 for moving the workpiece W or that of the target workpiece W to be machined, and the like, the acceleration time is preferably as short as possible within the permissible range of the output torque. Conversely, if the motor is operated with an extremely short acceleration time (an acceleration / deceleration time constant), the position control of the motor may become unstable (vibrations may occur).For example, if the acceleration / deceleration time constant is set shorter than the corresponding value with respect to the power of motor 10 and the inertia of the workpiece W, the power limitation of motor 10 may prevent the required acceleration / deceleration from being performed. The output torque may then become saturated with respect to the command torque, thus preventing proper control. Conversely, if the acceleration / deceleration time constant is set longer than the corresponding value, the acceleration / deceleration will be performed more slowly than necessary, resulting in reduced power. Therefore, the acceleration / deceleration time constant is optimally adjusted based on the estimated inertia.

[0032] Regarding the process for optimizing the acceleration / deceleration time constants, an optimal time constant for the inertia is determined in advance, for example, theoretically or experimentally, and the optimal time constant is set based on the inertia obtained from the estimate. The optimal time constant can be chosen from predefined values ​​or can be calculated sequentially; a suitable procedure can be employed.

[0033] Fig.Figure 5 is a flowchart of an adjustment process for the acceleration / deceleration time constants by the control unit 2 of the present embodiment, which compares feedback. First, the feedback comparison unit 45 determines whether an evaluation function value exceeds a threshold (step S101). If the evaluation function value is within the threshold, the process proceeds to generating a position command value in step S102.

[0034] In step S102, the position command generation unit 42 generates a position command value using a moving average filter of the acceleration / deceleration time constants (the time constants) determined by the acceleration / deceleration time constant storage unit 41 (step S102), and the position sensing unit 12 senses the position of the motor 10 (step S103). Subsequently, the velocity command generation unit 43 generates the velocity command based on the position command value and the position sensing value (step S104).

[0035] The feedback comparison unit 45 derives an inertia using the inertia estimation unit 22 (step S105). In addition, to calculate ideal feedback, the unit 44 calculates an ideal feedback value using the low-pass filter 17 of the acceleration / deceleration time constant, which has been determined by the acceleration / deceleration time constant storage unit 41 (step S106).

[0036] The feedback comparison unit 45 calculates an evaluation function from the ideal feedback value and the position recording value (step S107), and the process returns to the feedback comparison and determination process from step S101. The processing of steps S101 to S107 is repeated until the evaluation function value deviates from the threshold.

[0037] If the evaluation function value exceeds the threshold during the feedback comparison and determination processing of step S101, the process transitions to an acceleration / deceleration time constant change process of step S108. In step S108, the acceleration / deceleration time constant storage unit 41 changes the acceleration / deceleration time constant based on the estimated inertia, which was estimated by the feedback comparison unit 45.

[0038] According to the embodiment described above, the following advantages are achieved. The control unit 2 of the motor 10, which drives the plant W, includes: the acceleration / deceleration time constant storage unit 41, which stores an acceleration / deceleration time constant that determines the acceleration / deceleration of the motor 10; the position command generation unit 42, which generates the position command value based on the acceleration / deceleration time constant; the position sensing unit 12, which senses a rotational position of the motor 10; the velocity command generation unit 43, which generates a velocity command of the motor 10 based on the position command value and the position sensing value acquired by the position sensing unit 12; the ideal feedback calculation unit 44, which calculates ideal feedback from the position command value using the low-pass filter 17;and the feedback comparison unit 45, which compares the ideal feedback with actual feedback acquired by the position sensing unit, wherein the feedback comparison unit 45 changes the acceleration / deceleration time constant, which is to be stored in the acceleration / deceleration time constant storage unit 41, when it is determined that the ideal feedback does not match the actual feedback.

[0039] This method determines whether the acceleration / deceleration time constant, calculated based on the load capacity, is suitable and calibrates the time constant. Therefore, it is possible to improve both machining performance and ensure control reliability. Furthermore, by providing a mechanism for measuring inertia, it is possible to predict acceleration within a control system appropriately and align the process with a truly probable physical process, thus verifying the acceleration (the acceleration / deceleration time constant) with high accuracy.

[0040] In the present embodiment, the feedback comparator unit 45 estimates the inertia and modifies the acceleration / deceleration time constant based on the estimated result. In this way, it is possible to reflect the inertia in the acceleration / deceleration time constant.

[0041] In the present embodiment, the feedback comparison unit calculates 45 integral values ​​of values ​​obtained by calculating an error in a time-series signal of the feedback, an absolute value thereof, or a quadratic value thereof, and performs a feedback comparison based on an evaluation value derived from the integral values ​​or a combination thereof. In this way, it is possible to perform the feedback comparison determination process with high accuracy using the evaluation value.

[0042] In the present embodiment, the feedback comparison unit 45 determines that the comparison result is a non-conformity if the evaluation value exceeds a predefined threshold. This provides the determination criterion with a degree of flexibility. Therefore, it is possible to prevent cases in which the results are unnecessarily determined as non-conformities while simultaneously maintaining the accuracy of the feedback comparison determination. Explanation of reference symbols W workpiece 2 Control unit 10 Motor 17 Low-pass filters 22 Inertia estimation unit 41 Acceleration / deceleration time constant storage unit 42 Position command generation unit 43 Speed ​​command generation unit 44 units for calculating ideal feedback 45 Feedback comparison unit

Claims

[1] Control unit (2) of a motor (10) driving a driven body (W), the control unit comprising: an acceleration / deceleration time constant storage unit (41) that stores an acceleration / deceleration time constant that determines an acceleration / deceleration of the motor (10); a position command generating unit (42) that generates a position command value based on the acceleration / deceleration time constant; a position detection unit (12) that detects a rotational position of the motor (10); a speed command generation unit (43) that generates a speed command for the motor (10) based on the position command value and a position detection value detected by the position detection unit (12); an ideal feedback calculating unit (44) that calculates an ideal feedback from the position command value using a low-pass filter (17); and a feedback comparison unit (45) which compares the ideal feedback with an actual feedback detected by the position detection unit (12), wherein the feedback comparison unit (45) changes the acceleration / deceleration time constant stored in the acceleration / deceleration time constant storage unit (41) when it is determined that the ideal feedback does not match the actual feedback, wherein the feedback comparison unit (45) comprises an inertia estimation unit (22) that estimates inertia based on a predetermined estimation equation from a torque constant kt, a current I, an angular acceleration ω and a disturbance Tf, and changes the acceleration / deceleration time constant based on the estimated result. [2] The control unit (2) according to claim 1, wherein the feedback comparison unit (45) calculates integral values of values obtained by calculating an error in a time series signal of the feedback, an absolute value thereof, or a square value thereof, and performs feedback comparison based on an evaluation value obtained based on the integral values or a combination thereof. [3] Control unit (2) according to claim 2, wherein the feedback comparison unit (45) determines that the comparison result is a mismatch if the evaluation value exceeds a threshold value set therefor.

Citation Information

Patent Citations

  • Controller using acceleration sensor and adjusting device

    JP2007141189A

  • Printing device and continuous conveying control method of printing medium

    JP2008056418A

  • Inertia estimating controller and control system

    JP2010148178A

  • Control parameter adjusting method and adjusting device

    JP2011134169A

  • Motor control apparatus

    US20180120820A1