Mechanical constant estimation device and motor control device
The mechanical constant estimating device enhances precision and speed in estimating motor and load parameters by integrating torque, acceleration, and speed signals during acceleration and deceleration, followed by averaging, addressing the limitations of existing methods.
Patent Information
- Application Number
- JP2021089125
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-05-27
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2041-05-27
AI Technical Summary
Existing methods for estimating mechanical constants of motors and their loads, such as inertia, viscosity coefficient, and Coulomb friction, face challenges in achieving high precision and speed, especially when motor speed and acceleration are inappropriate, leading to unreliable and potentially outdated estimates.
A mechanical constant estimating device that calculates inertia, viscosity coefficient, and Coulomb friction using numerical integration of motor torque, acceleration, and speed signals during acceleration and deceleration periods, followed by averaging processes to stabilize estimates, and utilizes low-pass filters to smooth these signals.
Enables precise estimation of mechanical constants in a short time, even under suboptimal motor conditions, reducing estimation errors and improving motor control accuracy.
Smart Images

Figure 0007585970000008 
Figure 0007585970000009 
Figure 0007585970000010
Abstract
Description
[Technical field]
[0001] The present invention relates to a mechanical constant estimation device that estimates the mechanical constants of a motor and its mechanical load, and to a motor control device equipped with this mechanical constant estimation device. [Background technology]
[0002] In order to effectively control the speed of a motor that drives a mechanical load, it is necessary to acquire the inertia of the motor and its mechanical load, as well as the load torque such as the viscosity coefficient (viscous friction coefficient) and Coulomb friction, and reflect these in the speed control conditions. Furthermore, even if a motor continues to drive the same mechanical load, the load torque may change. In such cases, it is convenient to be able to estimate mechanical constants such as inertia regardless of the operating conditions.
[0003] Here, Non-Patent Document 1 discloses a method for estimating inertia together with Coulomb friction and viscosity coefficient, on the premise that the load torque is expressed as the sum of Coulomb friction of a sign function type independent of speed and a viscosity coefficient proportional to speed. In this document, a periodic signal with symmetrical positive and negative polarities is given as a speed command, and a signal τ based on a torque command u and an angular velocity ω is generated as shown in FIG. 8 (FIG. 4 of Non-Patent Document 1). e ,q0,q0 ’ , q1 are multiplied together, and the value obtained is integrated at periodic intervals using the formulas (Eqs. (37) to (44)) described in the same paper to obtain the element φ of the matrix Φ. 11 ,φ 13 ,φ 22 ,φ 23 ,φ 33 , and calculate elements v1, v2, and v3 of vector V, and then perform the operation Φ -1 By performing V, the mechanical constants including inertia are identified.
[0004] Patent Document 1 describes a motor control device that performs adaptive identification calculations on torque command differential values, motor acceleration, motor jerk, etc. through a low-pass filter with the same characteristics to identify inertia and viscosity coefficients. Furthermore, Patent Document 2 describes a mechanical constant identification device for a driving machine that estimates inertia and viscosity coefficients by inputting speed, acceleration, and torque weighted using a weighting signal updated according to the time after the start of the driving machine to a least squares calculation unit. [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2006-217729 A (
[0036] to
[0059] , Fig. 1, etc.) [Patent Document 2] Patent No. 3683121 (
[0092] to
[0103] , Figs. 7, 8, etc.) [Non-patent literature]
[0006] [Non-Patent Document 1] Ichiro Awaya et al., "Parameter Identification Method for Mechanical Motion Systems with Coulomb Friction", Transactions of the Japan Society of Mechanical Engineers (Series C), Vol. 59, No. 567 (1993), pp. 108-114 Summary of the Invention [Problem to be solved by the invention]
[0007] According to the method for identifying mechanical constants described in Non-Patent Document 1, for example, even when the motor is driven at a small acceleration at which it is difficult to obtain a desired estimation accuracy of the inertia, the estimated inertia value is updated regardless of the estimation accuracy. Alternatively, even when the motor is driven at a small maximum speed at which it is difficult to obtain a desired estimation accuracy of the viscosity coefficient, the estimated inertia value is updated regardless of the estimation accuracy. In other words, even if a more reliable estimation result was obtained in the past, the estimated value may be updated to the latest less reliable estimation result. Furthermore, while it is desirable to estimate the machine constants as accurately as possible, there are also cases where it is desired to estimate the machine constants within a short period of time. However, with the method described in Non-Patent Document 1, it is difficult to achieve both improved estimation accuracy and reduced estimation time.
[0008] In addition, in the conventional technology disclosed in Patent Document 1, the inertia and viscosity coefficients are identified quickly and accurately even when the motor rotation speed is low, while in the conventional technology disclosed in Patent Document 2, the weights are reduced during the period from when the drive machine is started until a predetermined time has elapsed, thereby reducing the estimation error caused by Coulomb friction. However, Patent Documents 1 and 2 do not specifically disclose a means for estimating the Coulomb friction.
[0009] Therefore, the problem to be solved by the present invention is to provide a mechanical constant estimation device that can estimate inertia, viscosity coefficient, and Coulomb friction with high accuracy and in a short time in a manner that is unlikely to lead to deterioration of the estimated values even when the motor speed or acceleration is inappropriate when estimating the mechanical constants, and a motor control device that performs motor speed control, etc. using the mechanical constants estimated by this estimation device. [Means for solving the problem]
[0010] In order to solve the above problem, a mechanical constant estimation device according to claim 1 is a mechanical constant estimation device that estimates mechanical constants consisting of inertia, viscosity coefficient, and Coulomb friction of a motor and a mechanical load driven by the motor, comprising: an integrating means for starting a numerical integration using the product of any two of the torque, acceleration, speed, and speed sign of the motor as an integrand function when the absolute value of the speed of the motor exceeds a predetermined estimation start speed after the motor is started, and for ending the numerical integration when the absolute value of the speed of the motor becomes equal to or less than the estimation start speed as a result of the deceleration of the motor; Based on the integral value by the integrating means, an estimated inertia value J1, an estimated viscosity coefficient value D1, and an estimated Coulomb friction value Tf1 An estimate calculation means for calculating the inertia estimate J1, the viscosity coefficient estimate D1, and the Coulomb friction estimate T f1 The weights W J1 ,W D1 ,W Tf1 A means for calculating The inertia estimation value J1 and the weight W J1 The inertia estimated average value J2 and the integrated weight W calculated before the acceleration / deceleration period are calculated using J2 and outputting the updated inertia estimation average value J2 as an inertia estimation result; The viscosity coefficient estimated value D1 and the weight W D1 The estimated average viscosity coefficient D2 and the integrated weight W calculated before the acceleration / deceleration period are calculated using D2 and outputting the updated viscosity coefficient estimated average value D2 as a viscosity coefficient estimated result; The Coulomb friction estimate T f1 and the weight W Tf1 The estimated average Coulomb friction T calculated before the acceleration / deceleration period f2 and the cumulative weight W Tf2 The updated average Coulomb friction estimate T f2 a Coulomb friction estimated value averaging means for outputting the Coulomb friction estimated value as a result of the Coulomb friction estimation; The present invention is characterized by comprising:
[0011] The mechanical constant estimation device according to claim 2 is the mechanical constant estimation device according to claim 1, The estimation value calculation means When the acceleration a(t), velocity v(t), velocity sign(v(t)), and torque T(t) during the acceleration / deceleration period t of the motor are respectively x1(t), x2(t), x3(t), and y(t), the product of any two of x1(t), x2(t), x3(t), and y(t) is used as the integrand function m ij =∫{x i (t)x j (t)}dt and q i =∫{xi (t)y(t)}dt (where i, j = 1 to 3), the inertia estimated value J1, the viscosity coefficient estimated value D1, and the Coulomb friction estimated value T f1 The present invention is characterized in that it calculates the following:
[0012] The mechanical constant estimation device according to claim 3 is the mechanical constant estimation device according to claim 1 or 2, characterized in that the torque, acceleration, and speed used to find the integrand function are values obtained after being calculated through a low-pass filter having the same time constant.
[0013] The mechanical constant estimation device according to claim 4 is the mechanical constant estimation device according to claim 1 or 2, further comprising: J1 is a value obtained by numerically integrating a value that increases monotonically with respect to the absolute value of the acceleration of the motor, and the weight W D1 is a value obtained by numerically integrating a value that increases monotonically with respect to the absolute value of the motor speed, and the weight W Tf1 is a value obtained by numerically integrating a value that is independent of the speed and acceleration of the motor.
[0014] The mechanical constant estimation device according to claim 5 is the mechanical constant estimation device according to claim 3, further comprising: J1 is a value obtained by numerically integrating a value that monotonically increases with respect to the absolute value of the acceleration of the motor after the calculation by the low-pass filter, and the weight W D1 is a value obtained by numerically integrating a value that monotonically increases with respect to the absolute value of the motor speed after the calculation by the low-pass filter, and the weight W Tf1 is a value obtained by numerically integrating a value that is independent of the speed and acceleration of the motor.
[0015] A mechanical constant estimation device according to claim 6 is the mechanical constant estimation device according to claim 4 or 5, wherein the inertia estimated value averaging means averages the inertia estimated value J1 and the weight W J1 Each time a new weight W is obtained, J2 and the weight W J1 The sum of this value and the upper limit WJmax The value limited by the above-mentioned integrated weight W J2 With this as the current value, Current value of inertia estimation average value J2 = Previous value of inertia estimation average value J2 + (Weight W J1 Current value / Accumulated weight W J2 (current value of inertia estimated value J1) × (current value of inertia estimated average value J2) The present invention is characterized in that it calculates the following:
[0016] A mechanical constant estimation device according to claim 7 is the mechanical constant estimation device according to any one of claims 4 to 6, wherein the viscosity coefficient estimated value averaging means averages the viscosity coefficient estimated value D1 and the weight W D1 Each time a new weight W is obtained, D2 and the weight W D1 The sum of this value and the upper limit W Dmax The value limited by the above-mentioned integrated weight W D2 With this as the current value, Current value of estimated average viscosity coefficient D2 = Previous value of estimated average viscosity coefficient D2 + (Weight W D1 Current value / Accumulated weight W D2 (current value of viscosity coefficient estimated value D1) × (current value of viscosity coefficient estimated average value D2) The present invention is characterized in that it calculates the following:
[0017] The mechanical constant estimation device according to claim 8 is the mechanical constant estimation device according to any one of claims 4 to 7, wherein the Coulomb friction estimated value averaging means calculates the Coulomb friction estimated value T f1 and the weight W Tf1 Each time a new weight W is obtained, Tf2 and the weight W Tf1 The sum of this value and the upper limit W Tfmax The value limited by the above-mentioned integrated weight W Tf2 With this as the current value, Coulomb friction estimated average value T f2 Current value = Estimated average Coulomb friction T f2 Previous value of + (weight W Tf1 Current value / Accumulated weight W Tf2 (current value) × (estimated Coulomb friction value Tf1 This time value - Coulomb friction estimated average value T f2 (previous value of The present invention is characterized in that it calculates the following:
[0018] A mechanical constant estimation device according to claim 9 is the mechanical constant estimation device according to any one of claims 1 to 8, further comprising: f2 , and the integrated weight W J2 ,W D2 ,W Tf2 The present invention is characterized in that the above-mentioned is stored in a non-volatile memory and can be initialized from the outside.
[0019] A motor control device according to a tenth aspect of the present invention is characterized in that the motor is controlled by using the mechanical constant estimated by the mechanical constant estimation device according to any one of the first to ninth aspects. Effect of the Invention
[0020] According to the present invention, even when it is difficult to appropriately estimate the mechanical constants because the motor speed or acceleration is small, the mechanical constants can be estimated highly accurately and in a short time in a manner that is unlikely to lead to deterioration of the estimated values. [Brief description of the drawings]
[0021] [Figure 1] 1 is a block diagram showing an overview of a mechanical constant estimation device according to an embodiment of the present invention. [Diagram 2] 2 is a configuration diagram showing a first embodiment of a mechanical constant estimation unit in FIG. 1. [Diagram 3] FIG. 4 is a configuration diagram of an integration start / end determination means in each embodiment of the machine constant estimation unit. [Figure 4] 1. FIG. 4 is a configuration diagram showing a second embodiment of the mechanical constant estimating unit in FIG. [Diagram 5] FIG. 4 is a configuration diagram of an estimated inertia value averaging means in each embodiment of the mechanical constant estimating unit. [Figure 6] FIG. 4 is a configuration diagram of a viscosity coefficient estimated value averaging means in each embodiment of the mechanical constant estimating unit. [Figure 7] FIG. 13 is a configuration diagram of a Coulomb friction estimated value averaging means in each embodiment of the mechanical constant estimating unit. [Figure 8] FIG. 1 is an explanatory diagram of the conventional technology described in Non-Patent Document 1. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0022] Hereinafter, an embodiment of the present invention will be described with reference to the drawings. 1 is a block diagram showing an outline of a mechanical constant estimation device according to this embodiment. This mechanical constant estimation device estimates the inertia, viscosity coefficient, and Coulomb friction of a motor / mechanical load 200 connected to a motor (collectively referred to as a motor / mechanical load 200) based on the speed and torque of the motor and mechanical load.
[0023] 1, a speed control unit 100 outputs torque so that the motor speed obtained from a motor / mechanical load 200 coincides with a speed command. Here, the torque may be a torque command or a torque estimate obtained by detecting the current flowing through the motor. The motor speed and torque are input to a mechanical constant estimation unit 300. The mechanical constant estimation unit 300 estimates the inertia, viscosity coefficient, and Coulomb friction by the operation described later, and performs weighting processing to obtain the average values J2, D2, T f2 Calculate the following. The speed control unit 100 and the mechanical constant estimation unit 300 are realized by an arithmetic processing device such as a microcomputer and a program therefor.
[0024] FIG. 2 is a configuration diagram showing a first embodiment of the mechanical constant estimating section 300 (mechanical constant estimating section 300A). 2, the motor speed obtained from the motor / mechanical load 200 is given to integration start / end determination means 320, differentiation means 301, and sign determination means 302 in a mechanical constant estimation section 300A, and the motor torque is given to multiplication means 303. In addition, an external reset command is input to inertia estimated value averaging means 340, viscosity coefficient estimated value averaging means 360, and Coulomb friction estimated value averaging means 380, which will be described later.
[0025] Now, assuming that the motor acceleration is a(t), the motor speed is v(t), the sign of the motor speed is sign(v(t)) and the torque is T(t), and these are respectively designated as x1(t), x2(t), x3(t) and y(t), the motor acceleration x1(t), motor speed x2(t) which are the outputs of the differentiation means 301, the speed sign x3(t) which is the output of the sign determination means 302, and the torque y(t) are input to the multiplication means 303.
[0026] The multiplication means 303 multiplies x by using two parameters from among x1(t), x2(t), x3(t), and y(t). i (t)x j (t) and x i (t)y(t) (i, j=1 to 3). Note that the calculation in the multiplication means 303 includes x1(t) 2 ,x2(t) 2 ,x3(t) 2 This also includes operations (i.e., i=j=1, i=j=2, i=j=3). The multiplication results from the multiplication means 303 are input to the integration means 304 at the next stage.
[0027] Integrating means 304 calculates m ij =∫{x i (t)x j (t)}dt and q i =∫{x i (t)y(t)}dt, and the results of these calculations are sent to the estimate calculation means 311. In actual numerical integration, for example, m ij =Σ{x i (n)x j(n)},q i =Σ{x i (n)y(n)} Then, calculate m ij ,q i When the n-th data point is obtained, m ij ←m ij +x i (n)x j (n), q i ←q i +x i (n)y(n) As, m ij ,q i Update each one.
[0028] FIG. 3 is a configuration diagram of the integration start / end determination means 320 in FIG. In FIG. 3, absolute value calculation means 321 calculates the absolute value of the motor speed and sends it to comparison means 322, which compares the speed absolute value with a preset estimated start speed. 2 via instruction generating means 323, and when the absolute value of the velocity becomes equal to or lower than the estimation start velocity, the comparison means 322 sends an integration start instruction to the integration means 304 in FIG. 2 via instruction generating means 323. The period from the integration start instruction to the integration end instruction is the integration period. The instruction generating means 324 also sends the inertia estimation value J1, the viscosity coefficient estimation value D1, the Coulomb friction estimation value T f1 and weights W for the inertia estimation value averaging means 340, the viscosity coefficient estimation value averaging means 360, and the Coulomb friction estimation value averaging means 380. J1 ,W D1 ,W Tf1 Update instructions are also output.
[0029] The reason why the integration start / end determination means 320 issues the integration start instruction, integration end instruction, and update instruction at the above-mentioned times is as follows. When a motor drives a mechanical load, a load torque accompanied by hysteresis often occurs near zero speed. In order for the estimated value calculation means 311 to correctly estimate the mechanical constant, it is necessary to exclude the above-mentioned hysteresis region from the period during which the integrating means 304 performs integration. Therefore, the integration period is set so that integration begins when the absolute speed value exceeds a predetermined estimation start speed after the motor starts, and then the integration ends when the motor decelerates and the absolute speed value falls below the estimation start speed, and an instruction to update each parameter is issued, thereby obtaining the estimated inertia value J1, the estimated viscosity coefficient value D1, and the estimated Coulomb friction value T during the integration period. f1 , and weight W J1 ,W D1 ,W Tf1 It was decided to confirm the following. In this case, by making the absolute motor speed values at the integration end instruction time point and the integration start instruction time point equal (ie, using the same estimation start speed), it is possible to reduce errors in each estimated value when the load torque has nonlinearity.
[0030] If the use of the speed signal, its differential acceleration signal, and torque signal as they are for calculations becomes problematic due to detection errors in the motor speed and energizing current, it is advisable to use the results of calculations performed by low-pass filters 312 and 313 on the motor speed and torque, as in mechanical constant estimation unit 300B of the second embodiment shown in Fig. 4. In this case, it is desirable to make the time constants of low-pass filters 312 and 313 equal.
[0031] Returning to FIG. 2, the estimated value calculation means 311 calculates m ij ,q i Using (i, j = 1 to 3), the estimated inertia value J1, the estimated viscosity coefficient D1, and the estimated Coulomb friction value T f1 is calculated using Equation 1.
number
[0032] This formula 1 expresses the equation of motion as T(t)=J(dv / dt)+Dv+T f For the system represented as sign(v), the parameters J1, D1, and T are calculated by the least squares method for one acceleration / deceleration period. f1 This is equivalent to asking for
[0033] The above will be specifically explained. In the least squares method, Integral value I=∫{T(t)-J(dv / dt)-Dv-T f sign(v)} 2 dt The J, D, and T that minimize f To do this, we set the integral I to J, D, T f By setting the partial differential values of each to zero and rearranging, we obtain Equation 2.
number
[0034] By substituting the above formula 2 with the previously mentioned x1(t), x2(t), x3(t), and y(t), we obtain formula 3.
number
number
[0035] Furthermore, the above-mentioned m ij =Σ{x i (n)x j (n)},q i =Σ{x i (n)y(n)} nth data point x i (n), x j (n), y(n) is the data x at time t i (t), x j (t), y(t), respectively, ij =Σ{x i (t)x j (t)},qi =Σ{x i (t)y(t)}, so equation 4 can be expressed as equation 5.
number
number
[0036] 2, motor acceleration x1(t) is input to first integrand generating means 305, which generates integrand f1 that increases monotonically with the absolute value of x1(t), and motor speed x2(t) is input to second integrand generating means 307, which generates integrand f2 that increases monotonically with the absolute value of x2(t). Third integrand generating means 309 generates integrand f3 that does not depend on the motor acceleration or speed. Here, for example, f1 may be the square of x1(t), f2 may be the square of x2(t), and f3 may simply be 1.
[0037] The integrands f1, f2, and f3 are integrated by integration means 306, 308, and 310, respectively, and the results are weighted by W J1 ,W D1 ,W Tf1 These are input to an inertia estimated value averaging means 340, a viscosity coefficient estimated value averaging means 360, and a Coulomb friction estimated value averaging means 380, respectively. The inertia estimated value averaging means 340, the viscosity coefficient estimated value averaging means 360, and the Coulomb friction estimated value averaging means 380 calculate the inertia estimated value J1, the viscosity coefficient estimated value D1, and the Coulomb friction estimated value T f1 For this, the weight W J1 ,W D1 ,W Tf1Weighting calculation is performed using each estimated average value J2, D2, T f2 Calculate.
[0038] The configurations and operations of the inertia estimated value averaging means 340, the viscosity coefficient estimated value averaging means 360, and the Coulomb friction estimated value averaging means 380 will be described below. For example, when the inertia is small and the acceleration is also small, it is considered that the inertia cannot be estimated with sufficient accuracy by only one acceleration / deceleration operation, even if the estimation calculation is performed by the above-mentioned estimated value calculation means 311. Also, when an acceleration / deceleration operation with a small maximum speed is performed, it is considered that the viscosity coefficient cannot be estimated with sufficient accuracy by only one acceleration / deceleration operation, and further, when the acceleration / deceleration operation period is very short, it is considered that the Coulomb friction cannot be estimated with sufficient accuracy by only that one acceleration / deceleration operation.
[0039] When the same pattern of acceleration / deceleration operation is repeated, the estimation accuracy can be improved by a method such as applying a simple moving average to each estimated value obtained for each acceleration / deceleration operation. However, when it is desired to improve the estimation accuracy of each machine constant in a situation where the operation is not repeated, the reliability of each estimation differs for each acceleration / deceleration operation. Therefore, in this embodiment, the inertia estimated value averaging means 340, the viscosity coefficient estimated value averaging means 360, and the Coulomb friction estimated value averaging means 380 perform the following operations to improve the estimation accuracy.
[0040] First, the inertia estimate averaging means 340 will be described with reference to FIG. It is assumed that the switching means 344, 348 are in the state shown in the figure until a reset command is input. This also applies to switching means 364, 368 in Fig. 6 and switching means 384, 388 in Fig. 7, which will be described later.
[0041] In FIG. 5, the inertia estimation value averaging means 340 calculates the inertia estimation value J1 and the weight W J1 Each time a new value is obtained, the inertial estimation mean value J2 and weight W J2 The weights W J2 always has weight WJ1 The cumulative weight W is calculated by adding the current value (latest value) and the previous value of J2 " As shown in FIG. 5, the integrated weight W J2 The previous value of and weight W J1 The current value (latest value) of is added by the addition / subtraction means 341, and the result is set to a preset upper limit value W Jmax The cumulative weight W is limited by J2 Then, the weight W is calculated by the division means 342. J1 The current value is integrated as weight W J2 The result is input to the multiplication means 346.
[0042] Also, the deviation between the previous value of the inertia estimated average value J2 held by the previous value holding means 349 and the current value of the inertia estimated average value J1 is found by addition and subtraction means 345, and this deviation is input to multiplication means 346 and multiplied by the output of the division means 342. Furthermore, the output of the multiplication means 346 and the previous value of the inertia estimated average value J2 are added by addition and subtraction means 347, and the result is output as the current value of the inertia estimated average value J2.
[0043] The above operations can be expressed by the following equations. J2 current value = J2 previous value + (W J1 Current value / W J2 Current value) x (J1 current value - J2 previous value) In addition, the cumulative weight W J2 The inertia estimated average value J2 can be initialized by switching the switching means 344, 348 to the "0" side in response to an external reset command, thereby substantially removing the loop including the previous value holding means 343, 349, etc. Specifically, for example, when the mechanical load is changed, the switching means 344, 348 is switched to the "0" side to J2 , J2 is initialized, and then W is written to a storage means such as a non-volatile memory. J2 , J2 are stored and updated. Also, when the system is restarted, W is read from the storage means prior to operation after the restart. J2 , so that the value of J2 is read.
[0044] The method of updating the inertia estimated average value J2 will now be described in more detail. First, the addition / subtraction means 341 calculates W J2 Previous value and W J1 The sum of this value and the upper limit W Jmax If it remains below: J2 current value = J2 previous value + {W J1 This time value / (W J2 Previous value + W J1 current value)}×(J1 current value - J2 previous value) = (J2 previous value × W J2 Previous value + J1 current value × W J1 Current value) / (W J2 Previous value + W J1 Current value) It becomes. This is equivalent to finding a weighted average value using all past acceleration / deceleration driving data. In the case of acceleration / deceleration driving patterns where it is difficult to obtain accurate inertia estimation (for example, driving with low acceleration), x1(t) in Figure 2 becomes smaller, and the weight W J1 Since the inertia estimation average value J2 can be kept small, a highly reliable inertia estimation average value J2 can be obtained.
[0045] However, W J2 Previous value and W J1 If we continue driving without placing any restrictions on the value obtained by adding this value, W J2 Eventually, it becomes infinite and the output of the division means 342 approaches zero, so that the inertia estimated average value J2 is no longer updated even if a new acceleration / deceleration operation is performed. Therefore, as shown in Figure 5, J2 Previous value and W J1 The sum of this value and the upper limit W Jmax By limiting it to the range below, the latest driving results are reflected in the inertia estimated average value J2 as acceleration / deceleration driving continues.
[0046] Here, without defining weights, J2 current value = J2 previous value + constant x (J1 current value - J2 previous value) (0 < constant < 1) We will now consider how to calculate the J2 value. Even when calculating in this way, the accuracy of the inertia estimation improves if the acceleration and deceleration operations are repeated. However, in this case, the current J2 value will be smaller than the true value until the number of acceleration and deceleration operations reaches about (3 / constant). Also, when low acceleration or short-term acceleration and deceleration operations that are not suitable for inertia estimation are performed, the inertia estimation value will be updated with the results, just like other driving patterns.
[0047] In contrast, in this embodiment, when the mechanical load is changed, for example, a reset command is issued to W J2 By initializing the value of J2, an inertia estimation value close to the true value can be obtained even if the number of acceleration / deceleration operations is small, and a highly accurate inertia estimation average value J2 can be obtained in a short time. In addition, the weight W is calculated by numerically integrating f1, which increases monotonically with respect to the absolute value of acceleration x1(t). J1 Calculate the weight W J1 and the cumulative weight W J2 Since the inertia estimated value J1 is updated using the above, the inertia estimated average value J2 is less likely to be disturbed even for driving that is not suitable for inertia estimation.
[0048] Next, FIG. 6 shows the configuration of the viscosity coefficient estimated value averaging means 360. The viscosity coefficient estimated value averaging means 360 calculates the viscosity coefficient estimated value D1 and the weight W D1 Each time a new viscosity coefficient is obtained, the estimated average viscosity coefficient D2 and the integrated weight W D2 It operates to update the
[0049] In the viscosity coefficient estimated value averaging means 360 shown in FIG. 6, 361, 365, and 367 are addition and subtraction means, 362 is division means, 363 and 369 are previous value holding means, 364 and 368 are switching means, 366 is multiplication means, W Dmax W D2 Previous value and W D1 This is the upper limit set for the result of adding the current value. The overall operation of this viscosity coefficient estimated value averaging means 360 is similar to that of the inertia estimated value averaging means 340, except for the input and output signals. The viscosity coefficient is estimated by numerically integrating f2, which increases monotonically with respect to the absolute value of the velocity x2(t), and using the weight W D1 and the cumulative weight W D2 Since the viscosity coefficient estimated average value D2 is obtained by updating the viscosity coefficient estimated value D1 using the above, the viscosity coefficient estimated average value D2 is less likely to be disturbed even for driving patterns that are not suitable for estimating the viscosity coefficient, such as driving with a small maximum speed.
[0050] FIG. 7 also shows the configuration of the Coulomb friction estimated value averaging means 380. The Coulomb friction estimated value averaging means 380 calculates the Coulomb friction estimated value T f1 and weight W Tf1 Each time a new value is obtained, the average Coulomb friction estimate T f2 and the cumulative weight W Tf2 It operates to update the
[0051] In the Coulomb friction estimated value averaging means 380 shown in FIG. 7, 381, 385, and 387 are addition and subtraction means, 382 is division means, 383 and 389 are previous value holding means, 384 and 388 are switching means, 386 is multiplication means, W Tfmax W Tf2 Previous value and W Tf1 This is the upper limit set for the sum of the current value and the Coulomb friction estimated value averaging means 380. The overall operation of this Coulomb friction estimated value averaging means 380 is similar to the inertia estimated value averaging means 340 and the viscosity coefficient estimated value averaging means 360 described above, except for the input and output signals. In estimating the Coulomb friction, the weight W is obtained by numerically integrating the value f3, which does not depend on either the acceleration x1(t) or the velocity x2(t). Tf1 and the cumulative weight W Tf2 Using and, the Coulomb friction estimate T f1 This updates the average Coulomb friction estimate T f2 Therefore, even if the driving is not suitable for estimating the Coulomb friction, the average Coulomb friction estimation value T f2 becomes less likely to become disturbed.
[0052] As described above, according to the mechanical constant estimation device of this embodiment, even if the operating pattern is such that the motor speed, acceleration, or acceleration / deceleration operating period is inappropriate for estimating the mechanical constants, the mechanical constants can be estimated with high accuracy and in a short time in a manner that is unlikely to lead to a deterioration in the estimated value. Furthermore, by implementing this mechanical constant estimation device in a motor control device and reflecting the mechanical constants estimated for each acceleration / deceleration period in accordance with the mechanical load in the speed control and torque control of the motor, it is possible to reduce tracking errors and vibrations in the mechanical drive system. [Explanation of symbols]
[0053] 100: Speed control section 200: Motor and mechanical load 300,300A,300B: Mechanical constant estimation part 301: Differential means 302: Sign determination means 303: Multiplication means 304,306,308,310: Integration means 305, 307, 309: Means for generating integral value 311: Estimated value calculation means 312, 313: Low-pass filter 320: Integration start / end determination means 321: Absolute value calculation means 322: Comparison means 323,324: Instruction generation means 340: Inertial estimate averaging means 341,345,347: Addition and subtraction means 342:Division means 343, 349: Previous value retention means 346: Multiplication means 344,348: Switching method 360: Viscosity coefficient estimate average means 361,365,367: Addition and subtraction means 362:Division means 363, 369: Previous value retention means 366: Multiplication means 364,368: Switching method 380: Coulomb friction estimate average means 381,385,387: Addition and subtraction means 382:Division means 383, 389: Previous value retention means 386: Multiplication means 384, 388: Switching method
Claims
1. A mechanical constant estimation device that estimates mechanical constants, which are composed of inertia, viscosity coefficient, and Coulomb friction, of a motor and a mechanical load driven by the motor, comprising: an integrating means for starting a numerical integration using the product of any two of the torque, acceleration, speed, and speed sign of the motor as an integrand function when the absolute value of the speed of the motor exceeds a predetermined estimation start speed after the motor is started, and for ending the numerical integration when the absolute value of the speed of the motor becomes equal to or less than the estimation start speed as a result of the deceleration of the motor; Based on the integral value by the integrating means, an estimated inertia value J during the acceleration / deceleration period of the motor is calculated. 1 , viscosity coefficient estimate D 1 , and the Coulomb friction estimate T f1 An estimate calculation means for calculating The inertia estimate J 1 , the viscosity coefficient estimate value D 1 , and the Coulomb friction estimate T f1 The weights W J1 , W D1 , W Tf1 A means for calculating The estimated inertia value J during the acceleration / deceleration period 1 and the weight W J1 The estimated inertia average value J calculated before the acceleration / deceleration period 2 and the cumulative weight W J2 is updated, and the updated inertia estimated average value J 2 as an inertia estimation result; The viscosity coefficient estimated value D during the acceleration / deceleration period 1 and the weight W D1 The viscosity coefficient estimated average value D calculated before the acceleration / deceleration period 2 and the cumulative weight W D2 The updated viscosity coefficient estimated average value D 2 as a viscosity coefficient estimation result; The Coulomb friction estimate value T f1 and the weight W Tf1 The estimated average Coulomb friction value T calculated before the acceleration / deceleration period f2 and the cumulative weight W Tf2 The updated average Coulomb friction estimate T f2 a Coulomb friction estimated value averaging means for outputting the Coulomb friction estimated value as a result of the Coulomb friction estimation; A mechanical constant estimation device comprising:
2. 2. The mechanical constant estimation device according to claim 1, The estimated value calculation means The acceleration a(t), velocity v(t), velocity sign(v(t)), and torque T(t) during the acceleration / deceleration period t of the motor are respectively expressed as x 1 (t), x 2 (t), x 3 (t), y(t), the above x 1 (t), x 2 (t), x 3 m(t), y(t) is the product of any two of them as the integrand function. ij = ∫ {x i (t) x j (t)}dt and q i = ∫ {x i (t)y(t)}dt (where i, j = 1 to 3), the inertia estimate J is calculated using the following formula 1: 1 , viscosity coefficient estimate D 1 , and the Coulomb friction estimate T f1 A mechanical constant estimation device comprising: [0010]
3. 3. The mechanical constant estimation device according to claim 1, A mechanical constant estimation device, characterized in that the torque, acceleration, and speed used to find the integrand function are values obtained after being calculated through a low-pass filter having the same time constant.
4. 3. The mechanical constant estimation device according to claim 1, The weight W J1 is a value obtained by numerically integrating a value that increases monotonically with respect to the absolute value of the acceleration of the motor, and the weight W D1 is a value obtained by numerically integrating a value that increases monotonically with respect to the absolute value of the motor speed, and the weight W Tf1 is a value obtained by numerically integrating a value that is independent of the speed and acceleration of the motor.
5. 4. The mechanical constant estimation device according to claim 3, The weight W J1 is a value obtained by numerically integrating a value that monotonically increases with respect to the absolute value of the acceleration of the motor after the calculation by the low-pass filter, and the weight W D1 is a value obtained by numerically integrating a value that monotonically increases with respect to the absolute value of the motor speed after the calculation by the low-pass filter, and the weight W Tf1 is a value obtained by numerically integrating a value that is independent of the speed and acceleration of the motor.
6. 6. The mechanical constant estimation device according to claim 4, The inertia estimate averaging means The inertia estimate J 1 and the weight W J1 Each time a new weight W is obtained, J2 and the weight W J1 The sum of this value and the current value is set to a predetermined upper limit value W Jmax The value limited by the integrated weight W J2 With this as the current value, Inertia estimated average value J 2 Current value = Estimated inertia average value J 2 Previous value of + (weight W J1 Current value / Accumulated weight W J2 (current value of inertia) × (estimated inertia value J 1 Current value - Inertia estimated average value J 2 (previous value of A mechanical constant estimation device comprising:
7. In the machine constant estimation device according to any one of claims 4 to 6, The viscosity coefficient estimated value averaging means The viscosity coefficient estimate value D 1 and the weight W D1 Each time a new weight W is obtained, D2 and the weight W D1 The sum of this value and the current value is set to a predetermined upper limit value W Dmax The value limited by the integrated weight W D2 With this as the current value, Viscosity coefficient estimated average value D 2 Current value = Estimated average viscosity coefficient D 2 Previous value of + (weight W D1 Current value / Accumulated weight W D2 (current value) × (estimated viscosity coefficient D 1 Current value - Estimated average viscosity coefficient D 2 (previous value of A mechanical constant estimation device comprising:
8. In the mechanical constant estimation device according to any one of claims 4 to 7, The Coulomb friction estimate averaging means The Coulomb friction estimate T f1 and the weight W Tf1 Each time a new weight W is obtained, Tf2 and the weight W Tf1 The sum of this value and the current value is set to a predetermined upper limit value W Tfmax The value limited by the integrated weight W Tf2 With this as the current value, Coulomb friction estimated average value T f2 Current value = Coulomb friction estimated average value T f2 Previous value of + (weight W Tf1 Current value / Accumulated weight W Tf2 (current value) × (estimated Coulomb friction value T f1 Current value - Coulomb friction estimated average value T f2 (previous value of A mechanical constant estimation device comprising:
9. In the machine constant estimation device according to any one of claims 1 to 8, The inertia estimated average value J 2 , the viscosity coefficient estimated average value D 2 and the Coulomb friction estimated average value T f2 , and the integrated weight W J2 , W D2 , W Tf2 A machine constant estimation device characterized in that the above is stored in a non-volatile memory and can be initialized externally.
10. A motor control device, comprising: a motor control unit that controls the motor using the mechanical constant estimated by the mechanical constant estimation device according to any one of claims 1 to 9.
Citation Information
Patent Citations
Device for estimating machine constant of driving machine
JP2000346738A
Motor control device and its control method
JP2006217729A
Servo system parameter identification method
JP2020194375A
Mechanical constant estimator for drive machine
JP3683121B2
Motion controller and system identifying method
WO2006051651A1
