Electrical angle deviation identification and compensation device and method, servo system and computer readable storage medium

By designing an electrical angle deviation identification compensation device in the servo system, calculating and compensating the electrical angle deviation, the problem of difficulty in obtaining electrical angle deviation in traditional servo systems is solved, and the working efficiency and control accuracy of the servo motor are improved.

CN119051528APending Publication Date: 2024-11-29GUANGZHOU ZEROJI TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411213291.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-30
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

The lack of electrical angle deviation acquisition device in traditional servo systems causes the servo motor to be unable to accurately obtain the electrical angle corresponding to the actual position of the rotor, affecting working efficiency.

Method used

Design an electrical angle deviation identification compensation device, including a sampling module, an identification module and a compensation module, calculate the electrical angle deviation value and compensation value by obtaining the parameters and feedback signals of the motor object, and reduce or eliminate the theoretical electrical angle and actual rotor. Deviation corresponding to position.

Benefits of technology

The control module's position control accuracy of the rotor is improved, and the working stability of the servo system and the working efficiency of the motor object are enhanced.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119051528A_ABST
    Figure CN119051528A_ABST
Patent Text Reader

Abstract

The invention provides an electrical angle deviation identification and compensation device and method, a servo system and a computer readable storage medium. The servo system comprises a control module, a driving module, a coordinate transformation module and a motor object. The electrical angle deviation identification and compensation device comprises a sampling module, an identification module and a compensation module. The sampling module obtains a first parameter when the working state of the motor object is in a steady state, obtains a second parameter of the control module, and obtains a third parameter of the coordinate conversion module. And the identification module processes the first parameter, the second parameter and the third parameter according to a first preset relation to obtain an electrical angle deviation value of the motor object and obtain a fixed deviation value and a lagging time delay value. The sampling module also obtains an electrical angle feedback value of the motor object, and the compensation module obtains an electrical angle compensation value according to at least one of the fixed deviation value and the lagging time delay value and the electrical angle feedback value, so as to reduce or eliminate the deviation between the theoretical electrical angle and the actual electrical angle of the rotor, and improve the working efficiency of the motor object.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of servo control technology, and in particular to an electrical angle deviation identification and compensation device, method, servo system and computer-readable storage medium. Background Art

[0002] When the servo motor is working, there is a deviation between the electrical angle of the rotor obtained by the encoder and the electrical angle corresponding to the actual position of the rotor due to the time delay of position detection and phase-seeking error in the servo system. The traditional servo system lacks a device for obtaining the electrical angle deviation, resulting in the servo system being unable to accurately obtain the electrical angle corresponding to the actual position of the rotor, which reduces the working efficiency of the servo motor. Summary of the invention

[0003] The present application provides an electrical angle deviation identification and compensation device, method, servo system and computer-readable storage medium to solve the problem of obtaining electrical angle deviation.

[0004] In a first aspect, the present application provides an electrical angle deviation identification and compensation device, which is applied to a servo system, wherein the servo system includes a control module, a drive module, a coordinate transformation module, and a motor object, wherein the coordinate transformation module is connected to the motor object and the control module respectively, and the coordinate transformation module is used to receive the output signal of the motor object and generate a feedback signal according to the output signal, wherein the control module is connected to the drive module and is used to generate a control signal according to the input signal received by the control module and the feedback signal, wherein the drive module is connected to the motor object and is used to drive the motor object to work according to the control signal. The electrical angle deviation identification and compensation device is connected to the motor object, the control module, and the coordinate transformation module respectively. The electrical angle deviation identification and compensation device includes a sampling module, an identification module, and a compensation module. The sampling module is used to obtain a first parameter of the motor object when the working state is in a steady state, obtain a second parameter of the control module, and obtain a third parameter of the coordinate transformation module when the working state of the motor object is in a steady state, and calculate a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value. The identification module is connected to the sampling module, and the identification module is used to process the first parameter, the second parameter and the third parameter according to a first preset relationship to obtain the electrical angle deviation value of the motor object. The compensation module is connected to the sampling module and the identification module respectively, and the sampling module is also used to obtain the electrical angle feedback value of the motor object, and the compensation module is used to obtain the electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle feedback value.

[0005] In a second aspect, the present application provides a servo system, which includes the electrical angle deviation identification and compensation device as described above.

[0006] In a third aspect, the present application provides an electrical angle deviation identification and compensation method, the electrical angle deviation identification and compensation method is applied to the electrical angle deviation identification and compensation device as described above, or the servo system as described above, the electrical angle deviation identification and compensation method comprising:

[0007] Get the first parameter of the motor object;

[0008] Obtain a second parameter of the control module;

[0009] Get the third parameter of the coordinate transformation module;

[0010] Processing the first parameter, the second parameter and the third parameter according to a first preset relationship to obtain an electrical angle deviation value of the motor object;

[0011] A fixed deviation value and a hysteresis delay value are calculated based on the electrical angle deviation value;

[0012] Obtaining an electrical angle feedback value of the motor object;

[0013] An electrical angle compensation value is obtained according to at least one of the fixed offset value and the hysteresis delay value and the electrical angle feedback value.

[0014] In a fourth aspect, the present application provides an electrical angle deviation identification and compensation device, which includes a memory and a processor, the memory is used to store program instructions, and the processor is used to call the program instructions to execute the electrical angle deviation identification and compensation method as described above.

[0015] In a fifth aspect, the present application provides a computer-readable storage medium, which is used to store instructions. When the instructions are executed, the electrical angle deviation identification and compensation method as described above is implemented.

[0016] In the electrical angle deviation identification and compensation device, method, servo system and computer-readable storage medium provided by the present application, based on the sampling module, when the working state of the motor object is in a steady state, a first parameter of the motor object, a second parameter of the control module and a third parameter of the coordinate transformation module are obtained, the identification module processes the first parameter, the second parameter and the third parameter according to a first preset relationship to obtain the electrical angle deviation value of the motor object, the compensation module obtains the electrical angle compensation value according to the electrical angle feedback value and the electrical angle deviation value, and calculates the fixed deviation value and the hysteresis delay value based on the electrical angle compensation value, and the compensation module obtains the electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle feedback value, thereby realizing the acquisition of the electrical angle deviation value and the electrical angle compensation value of the rotor of the motor object, so as to compensate for the fixed deviation and / or hysteresis delay of the electrical angle of the motor object of the servo system, which is beneficial for the servo system to reduce or eliminate the deviation between the theoretical electrical angle of the rotor of the motor object and the actual electrical angle corresponding to the actual position of the rotor, improve the control accuracy of the control module on the position of the rotor, and thus improve the working efficiency of the motor object. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0018] Figure 1 It is a structural block diagram of the servo system provided in an embodiment of the present application.

[0019] Figure 2 It is a structural block diagram of the offline electrical angle deviation identification and compensation device provided in an embodiment of the present application.

[0020] Figure 3 It is a structural block diagram of an online electrical angle deviation identification and compensation device provided in an embodiment of the present application.

[0021] Figure 4 It is a flow chart of the electrical angle deviation identification and compensation method provided in an embodiment of the present application.

[0022] Figure 5 This is a flowchart for obtaining a fixed deviation value and a lag delay value in the electrical angle deviation identification and compensation method provided in some embodiments of the present application.

[0023] Figure 6 This is a flowchart of an electrical angle deviation identification and compensation method provided in some embodiments of the present application.

[0024] Figure 7This is a flowchart for obtaining an electrical angle compensation value in the electrical angle deviation identification and compensation method provided in some embodiments of the present application.

[0025] Figure 8 This is a flow chart of obtaining an electrical angle compensation value by an electrical angle deviation identification and compensation method provided in other embodiments of the present application.

[0026] Fig. 9 It is a flowchart of the electrical angle deviation identification and compensation method provided in other embodiments of the present application.

[0027] Fig.10 This is a flowchart of an electrical angle deviation identification and compensation method provided in some other embodiments of the present application.

[0028] Fig.11 This is a flowchart of an electrical angle deviation identification and compensation method provided in some other embodiments of the present application.

[0029] Fig.12 This is a flowchart of an electrical angle deviation identification and compensation method provided in some embodiments of the present application and applicable to when the electrical angle deviation identification and compensation device is in an offline working mode.

[0030] Fig.13 It is a flowchart of an electrical angle deviation identification and compensation method provided in some embodiments of the present application and applicable to when the electrical angle deviation identification and compensation device is in an online working mode.

[0031] Fig.14 It is a structural block diagram of the electrical angle deviation identification and compensation device provided in some embodiments of the present application.

[0032] Fig.15 It is a diagram of input signals received by the control module provided in the embodiment of the present application.

[0033] Fig.16 It is a comparison chart of the fitting results of the electrical angular velocity and electrical angle deviation value of the electrical angle deviation identification and compensation method provided in the embodiment of the present application and the electrical angular velocity and electrical angle deviation value measured by the encoder.

[0034] Fig.17 It is a measurement result diagram of the electrical angle deviation of the motor object provided in the embodiment of the present application before and after compensation.

[0035] Fig.18 This is a measurement result diagram of the direct-axis voltage to quadrature-axis voltage output by the control module provided in an embodiment of the present application before and after compensation.

[0036] Explanation of main figure marks: servo system 100; control module 11; drive module 12; coordinate transformation module 13; motor object 14; electrical angle deviation identification and compensation device 20; sampling module 21; identification module 22; compensation module 23; abnormality judgment module 24; filtering module 25; sampling judgment module 26; steady-state judgment module 27.

[0037] The following specific implementation methods will further illustrate the present application in conjunction with the above-mentioned drawings. DETAILED DESCRIPTION

[0038] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments in the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0039] Reference to "embodiment" or "implementation" herein means that a particular feature, structure, or characteristic described in conjunction with the embodiment or implementation may be included in at least one embodiment of the present application. The appearance of the phrase in various locations in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.

[0040] It should be noted that the terms in the specification and claims of this application and the above-mentioned drawings are only for describing specific embodiments and are not intended to limit this application. The terms "first", "second", etc. in the specification and claims of this application and the above-mentioned drawings are used to distinguish different objects rather than to describe a specific order. The term "and / or" used in the specification and claims of this application refers to any combination of one or more of the associated listed items and all possible combinations, including these combinations.

[0041] See also Figure 1 , Figure 11 is a block diagram of a servo system 100 provided in an embodiment of the present application. The servo system 100 includes a control module 11, a drive module 12, a coordinate transformation module 13 and a motor object 14. The coordinate transformation module 13 is connected to the motor object 14 and the control module 11 respectively, and the coordinate transformation module 13 is used to receive the output signal of the motor object 14 and generate a feedback signal according to the output signal. The control module 11 is connected to the drive module 12, and is used to generate a control signal according to the input signal and the feedback signal received by the control module 11. The drive module 12 is connected to the motor object 14, and is used to drive the motor object 14 to work according to the control signal. Among them, the control module 11, the drive module 12, the coordinate transformation module 13 and the motor object 14 are connected to form a closed-loop control system. The input signal can come from an external device, and the external device controls the working state of the servo system 100 by injecting the input signal into the servo system 100. After receiving the input signal, the control module 11 compensates the input signal according to the feedback signal and generates a control signal. The driving module 12 is used to convert the control signal and generate a voltage signal, and the voltage signal is used to make the motor object 14 work.

[0042] The motor object 14 can be configured as, but not limited to, a permanent magnet synchronous motor or a brushless DC motor. The motor object 14 can be configured as a rotary motor or a linear motor. For example, in the present application, the servo system 100 and the electrical angle deviation identification and compensation device 20 are described in detail by taking the motor object 14 as a rotary permanent magnet synchronous motor as an example. Of course, in some embodiments, the motor object 14 can also be configured as other forms of motors.

[0043] The motor object usually uses an encoder to obtain the position information of the rotor. However, due to the delay of position detection in the servo system, phase-seeking error and other reasons, there is a deviation between the theoretical electrical angle of the rotor obtained by the encoder and the actual electrical angle corresponding to the actual position of the rotor. The traditional servo system lacks a device to obtain the electrical angle deviation, resulting in the servo system being unable to accurately obtain the actual electrical angle corresponding to the actual position of the rotor. The electrical angle deviation of the rotor will cause the stability of the control module to decrease, resulting in a decrease in the working efficiency of the motor object, causing the motor object to be unable to reach the peak speed, and there is also a risk of overcurrent when the motor object is in high-speed operation.

[0044] Please also read Figure 1 , Figure 2 and Figure 3 , Figure 2 is a structural block diagram of an offline electrical angle deviation identification and compensation device 20 provided in an embodiment of the present application; Figure 31 is a block diagram of the structure of the online electrical angle deviation identification and compensation device 20 provided in the embodiment of the present application. In the embodiment of the present application, the electrical angle deviation identification and compensation device 20 is applied to the servo system 100. The electrical angle deviation identification and compensation device 20 is used to identify and compensate for the deviation between the theoretical electrical angle of the rotor obtained by the encoder based on the motor object 14 in the servo system 100 and the actual electrical angle corresponding to the actual position of the rotor. The electrical angle deviation identification and compensation device 20 is connected to the motor object 14, the control module 11 and the coordinate transformation module 13 respectively. The electrical angle deviation identification and compensation device 20 includes a sampling module 21, an identification module 22 and a compensation module 23. The sampling module 21 is used to obtain the first parameter of the motor object 14, the second parameter of the control module 11 and the third parameter of the coordinate transformation module 13 when the working state of the motor object 14 is in a steady state. The identification module 22 is connected to the sampling module 21. The identification module 22 is used to process the first parameter, the second parameter and the third parameter according to the first preset relationship, and obtain the electrical angle deviation value of the motor object 14, and calculate the fixed deviation value and the hysteresis delay value based on the electrical angle deviation value. The compensation module 23 is connected to the sampling module 21 and the identification module 22 respectively. The sampling module 21 is also used to obtain the electrical angle feedback value of the motor object 14. The compensation module 23 is used to obtain the electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis time delay value and the electrical angle feedback value. In this way, the acquisition of the electrical angle deviation value and the electrical angle compensation value of the rotor of the motor object 14 can be achieved, so as to compensate for the fixed deviation and / or hysteresis time delay of the electrical angle of the motor object 14 of the servo system 100, thereby facilitating the servo system 100 to reduce or eliminate the deviation between the theoretical electrical angle of the rotor used by the control module 11 when performing signal processing and the actual electrical angle corresponding to the actual position of the rotor, improve the control accuracy of the control module 11 on the position of the rotor, and then improve the working efficiency of the motor object 14, and improve the working stability, control performance and voltage utilization of the servo system 100.

[0045] It should be noted that the present application does not specifically limit the order in which the sampling module 21 acquires the first parameter, the second parameter, and the third parameter, and the sampling module 21 can set the order in which the first parameter, the third parameter, and the second parameter are acquired according to actual needs. Exemplarily, the sampling module 21 can acquire the first parameter, the second parameter, and the third parameter in sequence, or the sampling module 21 can acquire them in other sequences, such as acquiring the first parameter, the third parameter, and the second parameter in sequence.

[0046] The first parameter includes the quadrature-axis inductance of the motor object 14, the phase resistance of the motor object 14, and the electrical angular velocity of the motor object 14. The second parameter includes the quadrature-axis voltage command value output by the control module 11, and the direct-axis voltage command value output by the control module 11. The third parameter includes the quadrature-axis current value output by the coordinate transformation module 13. Exemplarily, in this embodiment, the direct-axis voltage command mean value can be expressed as the average value of the direct-axis voltage sampling values ​​at multiple sampling moments, the quadrature-axis voltage command mean value can be expressed as the average value of the quadrature-axis voltage sampling values ​​at multiple sampling moments, and the quadrature-axis current mean value can be expressed as the average value of the quadrature-axis current sampling values ​​at multiple sampling moments.

[0047] Among them, the sampling module 21 can obtain the direct-axis voltage sampling values ​​at multiple sampling moments, and average the multiple direct-axis voltage sampling values. The sampling module 21 can obtain the quadrature-axis voltage sampling values ​​at multiple sampling moments, and average the multiple quadrature-axis voltage sampling values. The sampling module 21 can obtain the quadrature-axis current sampling values ​​at multiple sampling moments, and average the multiple quadrature-axis current sampling values. In some embodiments, the sampling module 21 can obtain the direct-axis voltage sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple direct-axis voltage sampling values. In some embodiments, the sampling module 21 can obtain the quadrature-axis voltage sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple quadrature-axis voltage sampling values. In some embodiments, the sampling module 21 can obtain the quadrature-axis current sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple quadrature-axis current sampling values.

[0048] The first preset relationship is:

[0049]

[0050] Δθ=arctan(E)

[0051] Among them, E represents the evaluation index, Expressed as the mean value of the direct-axis voltage command, Expressed as the mean value of the quadrature axis voltage command, It is represented by the mean value of the quadrature axis current, ω is represented by the electrical angular velocity, R s Expressed as phase resistance, L q It is expressed as the quadrature-axis inductance, and Δθ is expressed as the electrical angle deviation.

[0052] In some embodiments, the identification module 22 is also used to calculate a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value when it is determined that the electrical angle deviation value exceeds the allowable range. Among them, the fixed deviation value is used to characterize the inherent error of the servo system 100. The reasons that cause the servo system 100 to generate a fixed deviation value include but are not limited to phase-seeking error, encoder error, position solution error, etc. The hysteresis delay value is used to characterize the error of the servo system 100 caused by time-consuming signal transmission, calculation, etc. The reasons that cause the servo system 100 to generate a hysteresis delay value include but are not limited to signal transmission time consumption, control algorithm calculation time consumption, communication delay, actuator response time consumption, etc.

[0053] After the identification module 22 determines that the electrical angle deviation value exceeds the allowable range, the sampling module 21 is also used to obtain the electrical angular velocities of the motor object 14 during j steady-state operation and the second parameter and the third parameter corresponding to the j electrical angular velocities. The identification module 22 is also used to determine n mutually different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities, and determine the n electrical angle deviation values ​​corresponding to the n electrical angular velocities according to the first preset relationship, and fit the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain a fixed deviation value and a hysteresis delay value. Wherein, 3≤n≤j. Exemplarily, the value of n can be but is not limited to 3, 4, 5, 6, 8, 10, 15.

[0054] Among the j electrical angular velocities, each electrical angular velocity may be an average value of electrical angular velocity values ​​at multiple sampling moments in a certain speed steady state of the motor object 14, or may be an electrical angular velocity value at a certain sampling moment in a certain speed steady state of the motor object 14. The electrical angular velocity value is a speed setting value of the motor object 14.

[0055] In this embodiment, among the second parameters and the third parameters corresponding to the j electrical angular velocities, corresponding to each electrical angular velocity, the direct-axis voltage command mean value is the average value of a plurality of direct-axis voltage sampling values ​​of the motor object 14 at a certain speed steady state, the quadrature-axis voltage command mean value is the average value of a plurality of quadrature-axis voltage sampling values ​​of the motor object 14 at a certain speed steady state, and the quadrature-axis current value is the average value of a plurality of quadrature-axis current sampling values ​​of the motor object 14 at a certain speed steady state. Exemplarily, corresponding to each electrical angular velocity, the sampling module 21 can sample a plurality of electrical angular velocity values, a plurality of direct-axis voltage sampling values, a plurality of quadrature-axis voltage sampling values, and a plurality of quadrature-axis current sampling values ​​when the motor object 14 is in a certain speed steady state.

[0056] Among them, the identification module 22 is used to perform straight-line fitting on n electrical angular velocities and n electrical angle deviation values ​​according to a second preset relationship. The second preset relationship can be one of the least squares method, the dichotomy method, and the gradient descent method. In some embodiments, the second preset relationship can also be other straight-line fitting methods. Exemplarily, the second preset relationship in this embodiment is the least squares method. The second preset relationship is:

[0057]

[0058] X=(A T A) -1 A T B

[0059]

[0060] Among them, the n electrical angular velocities are represented as: w1, w2, ..., w n , the n electrical angle deviation values ​​are expressed as: Δθ1, Δθ2, …, Δθ n , Δθ e Expressed as a fixed deviation value, t d A represents a first matrix composed of n electrical angular velocities, B represents a second matrix composed of n electrical angle deviation values, and X represents a third matrix composed of fixed deviation values ​​and hysteresis delay values.

[0061] In some embodiments, the electrical angle deviation identification and compensation device 20 further includes an abnormality judgment module 24. The abnormality judgment module 24 is connected to the sampling module 21 and the identification module 22 respectively. The abnormality judgment module 24 is used to determine whether there is a jump point in the n electrical angular velocities and the n electrical angle deviation values. Among them, the abnormality judgment module 24 is used to obtain the phase difference value after the fixed deviation value is subtracted from the product of each electrical angular velocity and the hysteresis delay value, and obtain the standardized residual of each electrical angle deviation value and the corresponding phase difference value, and determine whether each standardized residual is within the threshold range, or determine whether the absolute value of each standardized residual is greater than the threshold. When a certain standardized residual exceeds the threshold range, or the absolute value of a certain standardized residual is greater than the threshold, the electrical angular velocity and electrical angle deviation value corresponding to the standardized residual is a jump point. Among them, the threshold range or the size of the threshold can be specifically set according to actual needs, and is not specifically limited in this application. For example, the threshold range can be ±0.5°, ±1°, ±2°, etc. The threshold can be 0.5°, 1°, 2°, etc.

[0062] The abnormality judgment module 24 can obtain the standardized residual or the absolute value of the standardized residual according to the abnormality judgment relationship. The abnormality judgment relationship is:

[0063] r i =Δθ i -(Δθe -t d w i )

[0064] |z i |=|r i / σ r |

[0065] Among them, r i It is expressed as the residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, σ r Expressed as the standard deviation of the residual, z i It is expressed as the absolute value of the standardized residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, |z i | is represented by the absolute value of the standardized residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, Δθ i It is expressed as the i-th electrical angle deviation value among n electrical angle deviation values, w i Expressed as the i-th electrical angular velocity among n electrical angular velocities.

[0066] The identification module 22 is also used to delete the corresponding electrical angle deviation value from the n electrical angle deviation values ​​and the corresponding electrical angular velocity from the n electrical angular velocities when it is determined that the standardized residual exceeds the threshold range or the absolute value of the standardized residual is greater than the threshold, that is, to delete the electrical angle deviation value and electrical angular velocity corresponding to the standardized residual that exceeds the threshold range or the standardized residual whose absolute value is greater than the threshold, and to obtain a new fixed deviation value and a new lag delay value based on the second preset relationship.

[0067] In some embodiments, after deleting the corresponding electrical angle deviation value and the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are less than 3, the sampling module 21 re-acquires the new electrical angular velocity and the second parameter and the third parameter corresponding to the new electrical angular velocity, and the identification module 22 re-fits the n electrical angular velocities and n electrical angle deviation values ​​according to the second preset relationship to obtain a new fixed deviation value and a new lag delay value.

[0068] In some embodiments, after deleting the corresponding electrical angle deviation value and the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are greater than or equal to 3, the identification module 22 can re-fit the remaining electrical angular velocity and the remaining electrical angle deviation value according to the second preset relationship to obtain a new fixed deviation value and a new lag delay value.

[0069] In some embodiments, the compensation module 23 may send the electrical angle compensation value to the coordinate transformation module 13. The coordinate transformation module 13 is used to perform coordinate transformation on the electrical angle compensation value, and send the electrical angle compensation value after coordinate transformation to the control module 11. The control module 11 is used to compensate the electrical angle of the motor object 14 according to the electrical angle compensation value after coordinate transformation, thereby reducing or eliminating the deviation between the theoretical electrical angle of the rotor and the actual electrical angle corresponding to the actual position of the rotor, improving the control accuracy of the control module 11 on the position of the rotor, and improving the working efficiency of the motor object 14.

[0070] In some embodiments, the compensation module 23 can be used to obtain the electrical angle compensation value according to the fixed deviation value and the electrical angle feedback value. For example, the compensation module 23 can be used to add the fixed deviation value and the electrical angle feedback value to obtain the electrical angle compensation value. In some embodiments, the compensation module 23 can be used to obtain the electrical angle compensation value according to the hysteresis delay value and the electrical angle feedback value. In some embodiments, the compensation module 23 can be used to obtain the electrical angle compensation value according to the fixed deviation value, the hysteresis delay value and the electrical angle feedback value.

[0071] In some embodiments, the sampling module 21 is also used to obtain the electrical angular velocity value of the motor object 14 and the control cycle of the servo system 100. The compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value and the control cycle according to the first preset compensation relationship to obtain the electrical angle compensation value. In this way, the fixed deviation and hysteresis delay of the motor object 14 are compensated in combination with the dynamic change of the electrical angular velocity of the motor object 14, which can improve the compensation effect of the electrical angle compensation value obtained by the compensation module 23 on the motor object 14 and improve the compensation accuracy. The first preset compensation relationship is:

[0072]

[0073] TB=t d / t s

[0074] Among them, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, Expressed as electrical angle compensation value, t s It is represented as the control cycle, TB is represented as the compensation beat number, Δθ e Expressed as a fixed deviation value, t d Expressed as a hysteresis delay value.

[0075] In some embodiments, the sampling module 21 is also used to obtain the electrical angular velocity value of the motor object 14, the electrical angular acceleration value of the motor object 14, and the control cycle of the servo system 100. The compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value, the electrical angular acceleration value, and the control cycle according to the second preset compensation relationship to obtain the electrical angle compensation value. In this way, the fixed deviation and hysteresis delay of the motor object 14 are compensated in combination with the dynamic changes of the electrical angular velocity and electrical angular acceleration of the motor object 14, which can improve the compensation effect of the electrical angle compensation value obtained by the compensation module 23 on the motor object 14 and improve the compensation accuracy. The second preset compensation relationship is:

[0076]

[0077] TB=t d / t s

[0078] Among them, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, and TA(K) represents the electrical angular acceleration value. Expressed as electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ e Expressed as a fixed deviation value, t d Expressed as a hysteresis delay value.

[0079] It should be noted that the "feedback value" in this article can be obtained according to the encoder in the motor object 14, or can also be obtained according to a preset corresponding relationship based on the relevant working output value of the motor object 14. Among them, the preset corresponding relationship can be a corresponding relationship given by the manufacturer of the motor object 14, or other corresponding relationships for obtaining the "feedback value".

[0080] In some embodiments, the electrical angle deviation identification and compensation device 20 further includes a filtering module 25. The filtering module 25 is used to filter the electrical angular velocity value and / or the electrical angular acceleration value before the compensation module 23 obtains the electrical angle compensation value to reduce noise interference. The compensation module 23 obtains the electrical angle compensation value according to the electrical angular velocity value and / or the electrical angular acceleration value after filtering, thereby improving the compensation accuracy of the compensation module 23. In some embodiments, the filtering module 25 is used to filter the electrical angular velocity value, and the compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value after filtering, and the control cycle according to the first preset compensation relationship to obtain the electrical angle compensation value, or the compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value after filtering, the electrical angular acceleration value, and the control cycle according to the second preset compensation relationship to obtain the electrical angle compensation value. In some embodiments, the filter module 25 is used to filter the electrical angular acceleration value, and the compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value, the electrical angular acceleration value after filtering, and the control cycle according to the second preset compensation relationship to obtain the electrical angle compensation value. In some embodiments, the filter module 25 is used to filter the electrical angular velocity value and the electrical angular acceleration value respectively, and the compensation module 23 is used to process the electrical angle feedback value, the electrical angular velocity value after filtering, the electrical angular acceleration value after filtering, and the control cycle according to the second preset compensation relationship to obtain the electrical angle compensation value. Among them, the filter module 25 can be configured as any one of a Kalman filter module, a low-pass filter module, and a band-pass filter module. In some embodiments, the filter module 25 can also be configured as other types of filter modules, which are not specifically limited in this application.

[0081] In some embodiments, the electrical angle deviation identification and compensation device 20 further includes a steady-state judgment module 27. The steady-state judgment module 27 is connected to the sampling module 21 and the identification module 22 respectively. The steady-state judgment module 27 is used to judge whether the working state of the motor object 14 is in a steady state. Among them, the sampling module 21 is also used to obtain the speed setting value of the motor object 14 and multiple speed feedback values ​​corresponding to the speed setting value when the motor object 14 is in a speed closed-loop working state. The steady-state judgment module 27 is used to judge whether the speed difference between each speed feedback value and the corresponding speed setting value is within the error range. If all the speed differences are within the error range, the speed steady-state judgment module 27 determines that the working state of the motor object 14 is in a steady state. When the working state of the motor object 14 is in a steady state, the speed of the motor object 14 is maintained at the set value, or fluctuates around the set value, wherein the fluctuation of the speed of the motor object 14 is within the error range. The error range can be specifically set according to actual needs, and is not specifically limited in this application. For example, the error range can be but not limited to ±0.5rpm, ±1rpm, ±2rpm. The number of speed feedback values ​​of the motor object 14 acquired by the sampling module 21 may be, but is not limited to, 3, 4, 5, 6, etc. When the motor object 14 is in a speed closed-loop working state, the control module 11 can adjust the speed command signal of the motor object 14 according to the speed feedback of the motor object 14 .

[0082] In some embodiments, the steady-state judgment module 27 is used to judge whether the speed difference between the speed setting value and the multiple speed feedback values ​​is less than or equal to the error threshold. If all the speed differences are less than or equal to the error threshold, the speed steady-state judgment module 27 determines that the working state of the motor object 14 is in a steady state. The steady-state judgment module 27 can judge whether the working state of the motor object 14 is in a steady state according to the steady-state judgment relationship. The steady-state judgment relationship is:

[0083] e(k)=V set -V(k)

[0084] if|e(k)|≤∈then flag(k)=1else flag(k)=0

[0085]

[0086] Among them, V setrepresents the speed setting value of the motor object 14, V(k) represents the speed feedback value of the motor object 14, e(k) represents the speed difference between the speed setting value and the speed feedback value, |e(k)| represents the absolute value of the speed difference between the speed setting value and the speed feedback value, ∈ represents the error threshold, h represents the number of continuous sampling points required for steady-state judgment, and k represents the kth in h. The error threshold can be specifically set according to actual needs and is not specifically limited in this application. For example, the error threshold can be but not limited to 0.5rpm, 1rpm, 2rpm.

[0087] In some embodiments, the number of speed feedback values ​​of the motor object 14 obtained by the sampling module 21 can be specifically set according to actual needs, and is not specifically limited in this application. For example, the number of sampling points of the speed feedback value of the motor object 14 obtained by the sampling module 21 can be, but not limited to, 3, 4, 5, 6, etc. Among them, the multiple sampling moments are continuous sampling moments.

[0088] In some embodiments, the electrical angle deviation identification and compensation device 20 further includes a sampling judgment module 26. The sampling judgment module 26 is connected to the sampling module 21 and the identification module 22 respectively. The sampling judgment module 26 is used to judge whether the electrical angular velocity at the back is repeated with the electrical angular velocity at the front among the j electrical angular velocities sampled by the sampling module 21. Exemplarily, the identification module 22 is also used to store the electrical angular velocities sampled by the sampling module 21. The identification module 22 is also used to delete the electrical angular velocity at the front or delete the electrical angular velocity at the back when it is determined that the electrical angular velocity at the back is repeated with the electrical angular velocity at the front. Exemplarily, when there is no repetition between all the electrical angular velocities sampled by the sampling module 21, j is equal to n, and when there is repetition between the electrical angular velocities sampled by the sampling module 21, j is greater than n. Among them, each of the n electrical angular velocities is different, and the n electrical angular velocities correspond to the electrical angular velocities of the motor object 14 when it is in a speed closed-loop working state and is in steady-state operation under n different electrical angular velocity control instructions.

[0089] The sampling judgment module 26 may include a first working mode and a second working mode. In the first working mode, the sampling judgment module 26 is used to determine whether the electrical angular velocity is repeated with the electrical angular velocity stored in the identification module 22 when the sampling module 21 samples an electrical angular velocity. When the identification module 22 determines that the electrical angular velocity is repeated with the stored electrical angular velocity, the electrical angular velocity that is repeated with the stored electrical angular velocity is deleted and the electrical angular velocity is stored; or the electrical angular velocity is deleted. When the identification module 22 determines that the electrical angular velocity is not repeated with the stored electrical angular velocity, the electrical angular velocity is stored. This cycle is repeated until the number of electrical angular velocities stored in the identification module 22 reaches n.

[0090] In the second working mode, the sampling and judging module 26 is used to judge whether an unmarked electric angular velocity among the j electric angular velocities is repeated with the remaining electric angular velocities after the sampling module 21 samples j electric angular velocities and the identification module 22 stores the j electric angular velocities. When the identification module 22 determines that the unmarked electric angular velocity is not repeated with the remaining electric angular velocities, the unmarked electric angular velocity is marked. When the identification module 22 determines that the unmarked electric angular velocity is repeated with the remaining electric angular velocities, the unmarked electric angular velocity and one of the repeated electric angular velocities are marked. This cycle is repeated until the number of electric angular velocities marked by the identification module 22 reaches n. The sampling and judging module 26 stops judging, and the identification module 22 retains the marked n electric angular velocities and the second parameters and third parameters corresponding to the n electric angular velocities, and deletes the remaining unmarked electric angular velocities and the second parameters and third parameters corresponding to the unmarked electric angular velocities. When the sampling judgment module 26 judges whether the latter electrical angular velocity among the j electrical angular velocities is repeated with the former electrical angular velocity, the sampling judgment module 26 may judge according to the sampling order of the j electrical angular velocities, or may judge the j electrical angular velocities according to other orders. The present application does not specifically limit the order of judging the j electrical angular velocities by the sampling judgment module 26. If the electrical angular velocity that is repeated with the unmarked electrical angular velocity is marked, the mark of the repeated electrical angular velocity may be removed, and the unmarked electrical angular velocity may be marked, or the mark of the repeated electrical angular velocity may be retained.

[0091] In some embodiments, the sampling judgment module 26 is used to obtain the difference between the electrical angular velocity obtained later and each electrical angular velocity stored previously, and to determine whether each difference is within a preset difference range. The identification module 22 is used to determine that the electrical angular velocity obtained later and the electrical angular velocity stored previously corresponding to the difference are repeated when at least one difference is within the preset difference range, and delete the electrical angular velocity located in the previous or delete the electrical angular velocity obtained later. The identification module 22 is also used to determine that the electrical angular velocity obtained later and the electrical angular velocity stored previously corresponding to the difference are not repeated when all differences exceed the preset difference range, and store or retain the electrical angular velocity in the later. Among them, the preset difference range can be specifically set according to actual needs, and is not specifically limited in this application. For example, the preset difference range can be but is not limited to ±0.5rpm, ±1rpm, ±2rpm.

[0092] See also Figure 2In some embodiments, the electrical angle deviation identification and compensation device 20 can be configured as an offline electrical angle deviation identification and compensation device. The offline electrical angle deviation identification and compensation device is suitable for offline working mode. The offline electrical angle deviation identification and compensation device includes a sampling module 21, an identification module 22, a compensation module 23 and an abnormality judgment module 24. The offline electrical angle deviation identification and compensation device is used when the working state of the motor object 14 is in a steady state. When the offline electrical angle deviation identification and compensation device is working, when the working state of the motor object 14 is in a steady state, the sampling module 21 obtains the first parameter of the motor object 14, obtains the second parameter of the control module 11 and obtains the third parameter of the coordinate transformation module 13, and the identification module 22 processes the first parameter, the second parameter and the third parameter according to the first preset relationship, and obtains the electrical angle deviation value of the motor object 14. When the electrical angle deviation value exceeds the allowable range, the sampling module 21 obtains n different electrical angular velocities of the motor object 14 and the second parameter and the third parameter corresponding to the n electrical angular velocities. The identification module 22 determines the n electrical angle deviation values ​​corresponding to the n electrical angular velocities according to the first preset relationship, and fits the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain a fixed deviation value and a hysteresis delay value. The abnormality judgment module 24 judges whether there is a jump point in the n electrical angular velocities and the n electrical angle deviation values ​​according to the fixed deviation value and the hysteresis delay value. After determining that there is no jump point, the sampling module 21 obtains the electrical angular velocity feedback value of the motor object 14, and the compensation module 23 obtains the electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angular velocity feedback value. In some embodiments, the offline electrical angle deviation identification and compensation device includes a sampling module 21, an identification module 22, a compensation module 23, an abnormality judgment module 24, and a filtering module 25. Among them, the various modules in the offline electrical angle deviation identification and compensation device can refer to the description in the aforementioned embodiment, and will not be described in detail here.

[0093] See also Figure 3In some embodiments, the electrical angle deviation identification and compensation device 20 can be configured as an online electrical angle deviation identification and compensation device. The online electrical angle deviation identification and compensation device is suitable for an online working mode. The structure of the online electrical angle deviation identification and compensation device is similar to that of the offline electrical angle deviation identification and compensation device, except that the online electrical angle deviation identification and compensation device further includes a sampling judgment module 26 and a steady-state judgment module 27. When the online electrical angle deviation identification and compensation device is working, the sampling module 21 obtains the speed setting value of the motor object 14 and multiple speed feedback values ​​corresponding to the speed setting value when the motor object 14 is in a speed closed-loop working state, and the steady-state judgment module 27 judges whether the working state of the motor object 14 is in a steady state according to the speed setting value and the speed feedback value. When the working state of the motor object 14 is in a steady state, the sampling module 21 obtains the first parameter of the motor object 14, obtains the second parameter of the control module 11, and obtains the third parameter of the coordinate transformation module 13. The identification module 22 processes the first parameter, the second parameter, and the third parameter according to the first preset relationship, and obtains the electrical angle deviation value of the motor object 14. When the electrical angle deviation value exceeds the allowable range, the sampling module 21 again obtains the speed setting value of the motor object 14 and multiple speed feedback values ​​corresponding to the speed setting value when the motor object 14 is in a speed closed-loop working state, and the steady-state judgment module 27 judges whether the working state of the motor object 14 is in a steady state according to the speed setting value and the speed feedback value. Whether it is in a steady state, when the working state of the motor object 14 is in a steady state, the sampling module 21 obtains j electrical angular velocities of the motor object 14 and the second parameter and the third parameter corresponding to the j electrical angular velocities, the sampling judgment module 26 judges whether there is repetition in the j electrical angular velocities, the identification module 22 determines n different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities according to the judgment result of the sampling judgment module 26, and determines n electrical angle deviation values ​​corresponding to the n electrical angular velocities according to the first preset relationship, and fits the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain a fixed deviation value and a hysteresis delay value, the abnormality judgment module 24 judges whether there is a jump point in the n electrical angular velocities and the n electrical angle deviation values ​​according to the fixed deviation value and the hysteresis delay value, after determining that there is no jump point, the sampling module 21 obtains the electrical angular velocity feedback value of the motor object 14, and the compensation module 23 obtains the electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angular velocity feedback value. In some embodiments, the online electrical angle deviation identification and compensation device includes a sampling module 21, an identification module 22, a compensation module 23, an abnormal judgment module 24, a filtering module 25, a sampling judgment module 26, and a steady-state judgment module 27. Among them, the various modules in the online electrical angle deviation identification and compensation device can refer to the description in the above embodiments, and will not be described in detail here.

[0094] In some embodiments, the embodiments of the present application further provide a servo system 100, which includes a control module 11, a drive module 12, a coordinate transformation module 13, a motor object 14, and an electrical angle deviation identification and compensation device 20 as in any of the above embodiments.

[0095] See also Figure 4 The embodiment of the present application also provides an electrical angle deviation identification and compensation method. The electrical angle deviation identification and compensation method can be applied to the electrical angle deviation identification and compensation device in any of the above embodiments, or applied to the servo system 100 in any of the above embodiments to identify the electrical angle deviation value of the motor object 14. The electrical angle deviation identification and compensation method includes:

[0096] Step 210: Acquire a first parameter when the working state of the motor object is in a steady state.

[0097] The first parameter includes the quadrature-axis inductance of the motor object 14 , the phase resistance of the motor object 14 , and the electrical angular velocity of the motor object 14 .

[0098] Step 230 : obtaining a second parameter of the control module when the working state of the motor object is in a steady state.

[0099] Wherein, the second parameter includes the mean value of the quadrature-axis voltage command output by the control module 11 and the mean value of the direct-axis voltage command output by the control module 11. Exemplarily, in this embodiment, the mean value of the direct-axis voltage command can be expressed as the average value of the direct-axis voltage sampling values ​​at multiple sampling moments, and the mean value of the quadrature-axis voltage command can be expressed as the average value of the quadrature-axis voltage sampling values ​​at multiple sampling moments. Wherein, the sampling module 21 can obtain the direct-axis voltage sampling values ​​at multiple sampling moments and average the multiple direct-axis voltage sampling values. The sampling module 21 can obtain the quadrature-axis voltage sampling values ​​at multiple sampling moments and average the multiple quadrature-axis voltage sampling values. In some embodiments, the sampling module 21 can obtain the direct-axis voltage sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple direct-axis voltage sampling values. In some embodiments, the sampling module 21 can obtain the quadrature-axis voltage sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple quadrature-axis voltage sampling values.

[0100] Step 250 , obtaining a third parameter of the coordinate transformation module when the working state of the motor object is in a steady state.

[0101] Wherein, the third parameter includes the quadrature axis current mean value output by the coordinate transformation module 13. Exemplarily, in this embodiment, the quadrature axis current mean value can be expressed as the average value of the quadrature axis current sampling values ​​at multiple sampling moments. Wherein, the sampling module 21 can obtain the quadrature axis current sampling values ​​at multiple sampling moments, and average the multiple quadrature axis current sampling values. In some embodiments, the sampling module 21 can obtain the quadrature axis current sampling values ​​at multiple sampling moments, and the identification module 22 averages the multiple quadrature axis current sampling values.

[0102] It should be noted that the present application does not specifically limit the order of step 210, step 230, and step 250. For example, the order of step 210, step 230, and step 250 may be step 210, step 230, and step 250, or may be step 210, step 250, step 230, and so on.

[0103] Step 270: Process the first parameter, the second parameter, and the third parameter according to a first preset relationship to obtain an electrical angle deviation value of the motor object.

[0104] Among them, the first preset relationship is:

[0105]

[0106] Δθ=arctan(E)

[0107] Among them, E represents the evaluation index, Expressed as the mean value of the direct-axis voltage command, Expressed as the mean value of the quadrature axis voltage command, It is represented by the mean value of the quadrature axis current, ω is represented by the electrical angular velocity, R s Expressed as phase resistance, L q The identification module 22 processes the first parameter, the second parameter and the third parameter according to the first preset relationship, and after obtaining the electrical angle deviation value of the motor object 14, the electrical angle deviation of the rotor of the motor object 14 can be obtained, so that the servo system 100 can obtain the actual electrical angle corresponding to the actual position of the rotor according to the electrical angle deviation of the rotor, thereby facilitating the servo system 100 to reduce or eliminate the deviation between the theoretical electrical angle of the rotor used by the control module 11 for signal processing and the actual electrical angle corresponding to the actual position of the rotor, thereby improving the control accuracy of the control module 11 on the position of the rotor, thereby improving the working efficiency of the motor object 14, and improving the working stability of the control module 11 and the motor object 14.

[0108] Step 290: Calculate a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value.

[0109] Step 2110, obtaining the electrical angle feedback value of the motor object.

[0110] Step 2130, obtaining an electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle feedback value.

[0111] Among them, after step 2130, the electrical angle deviation identification and compensation method may also include: sending the electrical angle compensation value to the coordinate transformation module. The coordinate transformation module 13 is used to perform coordinate transformation on the electrical angle compensation value, and send the electrical angle compensation value after coordinate transformation to the control module 11. The control module 11 is used to compensate the electrical angle of the motor object 14 according to the electrical angle compensation value after coordinate transformation, so as to reduce or eliminate the deviation between the theoretical electrical angle of the rotor and the actual electrical angle corresponding to the actual position of the rotor, improve the control accuracy of the control module 11 on the position of the rotor, and improve the working efficiency of the motor object 14.

[0112] See also Figure 5 In some embodiments, before step 290, the electrical angle deviation identification and compensation method further includes: determining whether the electrical angle deviation value is within an allowable range, and when it is determined that the electrical angle deviation value exceeds the allowable range, executing step 290: calculating a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value. When it is determined that the electrical angle deviation value is within the allowable range, executing step 210.

[0113] The step of "determining whether the electrical angle deviation value is within an allowable range, and when it is determined that the electrical angle deviation value exceeds the allowable range, calculating a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value" specifically includes:

[0114] Step 281, obtain the electrical angular velocities of the motor object during j steady-state operation and the second parameter and the third parameter corresponding to the j electrical angular velocities, and determine n different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities.

[0115] Wherein, 3≤n≤j. Exemplarily, the value of n can be but not limited to 3, 4, 5, 6, 8, 10, 15. Step 281 includes determining whether the electrical angular velocity at the rear is repeated with the electrical angular velocity at the front, and if it is determined that the electrical angular velocity at the rear is repeated with the electrical angular velocity at the front, deleting the electrical angular velocity at the front or deleting the electrical angular velocity at the rear. Wherein, when there is no repetition between all the sampled electrical angular velocities, j is equal to n, and when there is repetition between the sampled electrical angular velocities, j is greater than n. Wherein, each of the n electrical angular velocities is different, and the n electrical angular velocities respectively correspond to the electrical angular velocities of the motor object 14 when it is in a speed closed-loop working state and is in steady-state operation under n different electrical angular velocity control instructions.

[0116] Among the j electrical angular velocities, each electrical angular velocity may be an average value of electrical angular velocity values ​​at multiple sampling moments in a certain speed steady state of the motor object 14, or may be an electrical angular velocity value at a certain sampling moment in a certain speed steady state of the motor object 14. The electrical angular velocity value is a speed setting value of the motor object 14.

[0117] In this embodiment, among the second parameters and the third parameters corresponding to the j electrical angular velocities, corresponding to each electrical angular velocity, the direct-axis voltage command mean value is the average value of a plurality of direct-axis voltage sampling values ​​of the motor object 14 at a certain speed steady state, the quadrature-axis voltage command mean value is the average value of a plurality of quadrature-axis voltage sampling values ​​of the motor object 14 at a certain speed steady state, and the quadrature-axis current value is the average value of a plurality of quadrature-axis current sampling values ​​of the motor object 14 at a certain speed steady state. Exemplarily, corresponding to each electrical angular velocity, the sampling module 21 can sample a plurality of electrical angular velocity values, a plurality of direct-axis voltage sampling values, a plurality of quadrature-axis voltage sampling values, and a plurality of quadrature-axis current sampling values ​​when the motor object 14 is in a certain speed steady state.

[0118] Step 283: Determine n electrical angle deviation values ​​corresponding to n electrical angular velocities according to the first preset relationship.

[0119] Step 285: Fit the n electrical angular velocities and the n electrical angle deviation values ​​according to a second preset relationship to obtain the fixed deviation value and the lag delay value.

[0120] The second preset relationship is used to perform linear fitting on n electrical angular velocities and n electrical angle deviation values. The second preset relationship can be one of the least squares method, the dichotomy method, and the gradient descent method. In some embodiments, the second preset relationship can also be other linear fitting methods. Exemplarily, the second preset relationship in this embodiment is the least squares method. The second preset relationship is:

[0121]

[0122] X=(A T A) -1 A T B

[0123]

[0124] Among them, the n electrical angular velocities are represented as: w1, w2, ..., w n , the n electrical angle deviation values ​​are expressed as: Δθ1, Δθ2, …, Δθ n , Δθ e Expressed as a fixed deviation value, t d A represents a first matrix composed of n electrical angular velocities, B represents a second matrix composed of n electrical angle deviation values, and X represents a third matrix composed of fixed deviation values ​​and hysteresis delay values.

[0125] See also Figure 6 In some embodiments, after step 285, the electrical angle deviation identification and compensation method further includes:

[0126] Step 2861, obtaining a phase difference value obtained by subtracting the product of each electrical angular velocity and the lag delay value from the fixed deviation value.

[0127] Step 2862, obtaining the standardized residual between each of the electrical angle deviation values ​​and the corresponding phase difference value.

[0128] Step 2863, determine whether each of the standardized residuals is within the threshold range, or whether the absolute value of each of the standardized residuals is greater than the threshold. If it is determined that the standardized residual exceeds the threshold range, or the absolute value of the standardized residual is greater than the threshold, execute step 2864. If it is determined that the standardized residual is within the threshold range, or the absolute value of the standardized residual is less than or equal to the threshold, return to step 2863. Among them, the standardized residual or the absolute value of the standardized residual can be obtained according to the abnormal judgment relationship. The abnormal judgment relationship is:

[0129] r i =Δθ i -(Δθ e -t d w i )

[0130] |z i |=|r i / σ r |

[0131] Among them, r i It is expressed as the residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, σ rExpressed as the standard deviation of the residual, z i It is expressed as the absolute value of the standardized residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, |z i | is represented by the absolute value of the standardized residual corresponding to the i-th electrical angle deviation value among the n electrical angle deviation values, Δθ i It is expressed as the i-th electrical angle deviation value among n electrical angle deviation values, w i Expressed as the i-th electrical angular velocity among n electrical angular velocities.

[0132] Step 2864: Delete the corresponding electrical angle deviation value from the n electrical angle deviation values, and delete the corresponding electrical angular velocity from the n electrical angular velocities. "Delete the corresponding electrical angle deviation from the n electrical angle deviation values, and delete the corresponding electrical angular velocity from the n electrical angular velocities" specifically means: delete the electrical angle deviation value and electrical angular velocity corresponding to the standardized residual that exceeds the threshold range or the standardized residual whose absolute value is greater than the threshold.

[0133] Step 2865, re-obtaining the new fixed deviation value and the new hysteresis delay value based on the second preset relationship.

[0134] In some embodiments, after deleting the corresponding electrical angle deviation value and the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are less than 3, after step 2864, the electrical angle deviation identification and compensation method further includes: reacquiring a new electrical angular velocity and the second parameter and the third parameter corresponding to the new electrical angular velocity. Step 2865 specifically includes: refitting the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain a new fixed deviation value and a new hysteresis delay value.

[0135] In some embodiments, the step of "reacquiring a new electrical angular velocity and the second parameter and the third parameter corresponding to the new electrical angular velocity" specifically includes: reacquiring a new electrical angular velocity corresponding to the number of deleted electrical angular velocities and the second parameter and the third parameter corresponding to the new electrical angular velocity. Step 2865 specifically includes: determining a new electrical angle deviation value corresponding to the new electrical angular velocity according to the first preset relationship, and fitting the new electrical angular velocity, the remaining electrical angular velocity, the new electrical angle deviation value, and the remaining electrical angle deviation value according to the second preset relationship to obtain a new fixed deviation value and a new hysteresis delay value.

[0136] In some embodiments, the step of "reacquiring a new electrical angular velocity and the second parameter and the third parameter corresponding to the new electrical angular velocity" specifically includes: reacquiring the electrical angular velocity at j sampling moments and the second parameter and the third parameter corresponding to the j electrical angular velocities. After the step of "reacquiring the electrical angular velocity at j sampling moments and the second parameter and the third parameter corresponding to the j electrical angular velocities", return to step 281. After step 2864, step 2865 is not included.

[0137] In some embodiments, after deleting the corresponding electrical angle deviation value and deleting the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are greater than or equal to 3, step 2865 specifically includes: fitting the remaining electrical angular velocity and the remaining electrical angle deviation value according to the second preset relationship to obtain a new fixed deviation value and a new lag delay value.

[0138] In some embodiments, after deleting the corresponding electrical angle deviation value and the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are greater than or equal to 3, after step 2864, the electrical angle deviation identification and compensation method further includes: reacquiring a new electrical angular velocity corresponding to the number of deleted electrical angular velocities and the second parameter and the third parameter corresponding to the new electrical angular velocity. Step 2865 specifically includes: determining a new electrical angle deviation value corresponding to the new electrical angular velocity according to the first preset relationship, and fitting the new electrical angular velocity, the remaining electrical angular velocity, the new electrical angle deviation value, and the remaining electrical angle deviation value according to the second preset relationship to obtain a new fixed deviation value and a new hysteresis delay value.

[0139] In some embodiments, after deleting the corresponding electrical angle deviation value and the corresponding electrical angular velocity, if the number of rows in the first matrix A and the number of rows in the second matrix B are greater than or equal to 3, after step 2864, the electrical angle deviation identification and compensation method further includes: re-obtaining the electrical angular velocities at j sampling moments and the second parameters and the third parameters corresponding to the j electrical angular velocities. After the step of "re-obtaining the electrical angular velocities at j sampling moments and the second parameters and the third parameters corresponding to the j electrical angular velocities", return to step 281, and after step 2864, step 2865 is not included.

[0140] In some embodiments, step 2130 specifically includes: obtaining the electrical angle compensation value according to the fixed deviation value and the electrical angle feedback value. The electrical angle compensation value can be obtained by adding the electrical angle feedback value and the fixed deviation value. In some embodiments, step 2130 specifically includes: obtaining the electrical angle compensation value according to the hysteresis delay value and the electrical angular velocity feedback value. In some embodiments, step 2130 specifically includes: obtaining the electrical angle compensation value according to the fixed deviation value, the hysteresis delay value and the electrical angular velocity feedback value.

[0141] The fixed deviation value is used to characterize the inherent error of the servo system 100. The reasons that cause the servo system 100 to generate the fixed deviation value include but are not limited to phase-seeking error, encoder error, position solution error, etc. The hysteresis delay value is used to characterize the error caused by the time consumption of signal transmission, calculation, etc. in the servo system 100. The reasons that cause the hysteresis delay value in the servo system 100 include but are not limited to signal transmission time consumption, control algorithm calculation time consumption, communication delay, actuator response time consumption, etc.

[0142] See also Figure 7 In some embodiments, step 2130 specifically includes:

[0143] Step 2111, obtaining the electrical angular velocity value of the motor object. Wherein, in some embodiments, before step 2111, step 2110 also includes: filtering the electrical angular velocity value. Wherein, the step of "filtering the electrical angular velocity value" may specifically include: performing any one of Kalman filtering, low-pass filtering, and band-pass filtering on the electrical angular velocity value. In some embodiments, the step of "filtering the electrical angular velocity value" may also be other types of filtering on the electrical angular velocity value, which is not specifically limited in this application.

[0144] Step 2113, obtaining the control period of the servo system.

[0145] Step 2115: Obtain an electrical angle compensation value according to a first preset compensation relationship. The first preset compensation relationship is:

[0146]

[0147] TB=t d / t s

[0148] Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, Expressed as the electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ eExpressed as the fixed deviation value, t d Represented as the hysteresis delay value. In this way, by compensating for the fixed deviation and hysteresis delay of the motor object 14 in combination with the dynamic change of the electrical angular velocity of the motor object 14, the compensation effect of the electrical angle compensation value on the motor object 14 can be improved, and the compensation accuracy can be improved. Among them, step 2115 can specifically be: processing the electrical angle feedback value, the electrical angular velocity value and the control period according to the first preset compensation relationship to obtain the electrical angle compensation value; or it can be: processing the electrical angle feedback value, the filtered electrical angular velocity value and the control period according to the first preset compensation relationship to obtain the electrical angle compensation value.

[0149] See also Figure 8 In some embodiments, step 2110 specifically includes:

[0150] Step 2121, obtaining the electrical angular velocity value of the motor object. Wherein, in some embodiments, before step 2121, step 2110 also includes: filtering the electrical angular velocity value. Wherein, the step of "filtering the electrical angular velocity value" may specifically include: performing any one of Kalman filtering, low-pass filtering, and band-pass filtering on the electrical angular velocity value. In some embodiments, the step of "filtering the electrical angular velocity value" may also be other types of filtering on the electrical angular velocity value, which is not specifically limited in the present application.

[0151] Step 2123, obtaining the electrical angular acceleration value of the motor object. Wherein, in some embodiments, before step 2123, step 2110 also includes: filtering the electrical angular acceleration value. Wherein, the step of "filtering the electrical angular acceleration value" may specifically include: performing any one of Kalman filtering, low-pass filtering, and band-pass filtering on the electrical angular acceleration value. In some embodiments, the step of "filtering the electrical angular acceleration value" may also be other types of filtering on the electrical angular acceleration value, which is not specifically limited in the present application.

[0152] Step 2125, obtaining the control period of the servo system.

[0153] Step 2127, obtaining an electrical angle compensation value according to a second preset compensation relationship, wherein the second preset compensation relationship is:

[0154]

[0155] TB=t d / t s

[0156] Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, and TA(K) represents the electrical angular acceleration value. Expressed as the electrical angle compensation value, t s Represents the control cycle, and TB represents the number of compensation beats. In this way, the fixed deviation and hysteresis delay of the motor object 14 are compensated in combination with the dynamic changes of the electrical angular velocity and electrical angular acceleration of the motor object 14, so as to improve the compensation effect of the electrical angle compensation value on the motor object 14 and improve the compensation accuracy. Among them, step 2127 can be specifically: according to the second preset compensation relationship, the electrical angle feedback value, the electrical angular velocity value after filtering, the electrical angular acceleration value and the control cycle are processed to obtain the electrical angle compensation value; or it can be: according to the second preset compensation relationship, the electrical angle feedback value, the electrical angular velocity value, the electrical angular acceleration value after filtering and the control cycle are processed to obtain the electrical angle compensation value; or it can be: according to the second preset compensation relationship, the electrical angle feedback value, the electrical angular velocity value after filtering, the electrical angular acceleration value after filtering and the control cycle are processed to obtain the electrical angle compensation value.

[0157] See also Fig. 9 In some embodiments, before step 210 and / or before step 281, the method further includes:

[0158] Determine whether the working state of the motor object is in a steady state. If yes, perform at least one of step 210 and step 281. If no, repeat this step.

[0159] The step of “determining whether the working state of the motor object is in a steady state” specifically includes:

[0160] Step 311, obtaining the speed setting value of the motor object when the motor object is in a speed closed loop working state. The number of speed setting values ​​may be, but is not limited to, 3, 4, 5, 6, etc.

[0161] Step 312: Acquire multiple speed feedback values ​​corresponding to the speed setting value.

[0162] Step 313, determine whether the speed difference between each of the speed feedback values ​​and the speed setting value is within the error range, or whether the absolute value of each of the speed difference values ​​is less than or equal to the error threshold. If all of the speed difference values ​​are within the error range, or are less than or equal to the error threshold, it is determined that the working state of the motor object is in a steady state. When it is determined that the working state of the motor object is in a steady state, obtain the first parameter of the motor object, and / or obtain j of the electrical angular velocities and the second parameter and the third parameter corresponding to the j electrical angular velocities, that is, execute step 210, and / or execute step 281. If at least one of the speed difference values ​​exceeds the error range, or at least one of the speed difference values ​​is greater than the error threshold, it is determined that the working state of the motor object is in a non-steady state, and return to step 311.

[0163] Among them, according to the steady-state judgment relationship, it can be judged whether the working state of the motor object 14 is in a steady state. The steady-state judgment relationship is:

[0164] e(k)=V set -V(k)

[0165] if|e(k)|≤∈then flag(k)=1else flag(k)=0

[0166]

[0167] Among them, V set represents the speed setting value of the motor object 14, V(k) represents the speed feedback value of the motor object 14, e(k) represents the speed difference between the speed setting value and the speed feedback value, |e(k)| represents the absolute value of the speed difference between the speed setting value and the speed feedback value, ∈ represents the error threshold, h represents the number of continuous sampling points required for steady-state judgment, and k represents the kth in h. The error threshold and error range can be specifically set according to actual needs, and are not specifically limited in this application. For example, the error threshold can be but not limited to 0.5rpm, 1rpm, 2rpm, and the error range can be but not limited to ±0.5rpm, ±1rpm, ±2rpm.

[0168] Please also read Figure 5 and Fig.10 In some embodiments, step 281 specifically includes:

[0169] Step 8111, obtaining the electrical angular velocity when the working state of the motor object is in a steady state and the second parameter and the third parameter corresponding to the electrical angular velocity. Wherein, determining whether the working state of the motor object 14 is in a steady state can refer to steps 311 to 313, which are not described in detail here. Wherein, the electrical angular velocity of the motor object 14 obtained when the working state is in a steady state can be the electrical angular velocity value at a certain sampling moment, or it can also be the average value of the electrical angular velocity of the motor object 14 at multiple sampling moments under the control of the same electrical angular velocity command value.

[0170] Step 8112, determine whether the electrical angular velocity overlaps with the stored electrical angular velocity. If yes, return to step 8111. If no, execute step 8113.

[0171] Step 8113: Store the electrical angular velocity and the second parameter and the third parameter corresponding to the electrical angular velocity.

[0172] Step 8114, determine whether the number of the stored electrical angular velocities reaches n. If yes, execute step 8115. If no, return to step 8111.

[0173] Step 8115 , end the sampling. Steps 8111 to 8115 correspond to the first working mode of the sampling judgment module 26 .

[0174] Please also read Figure 5 and Fig.11 In some embodiments, step 281 specifically includes:

[0175] Step 8121, obtaining the electrical angular velocities of the motor object during j steady-state operations and the second parameter and the third parameter corresponding to the j electrical angular velocities. When obtaining each electrical angular velocity, whether the working state of the motor object 14 is in a steady state can be determined by referring to steps 311 to 313, which will not be described in detail here. The electrical angular velocity can be the electrical angular velocity value at a certain sampling time when the working state of the motor object 14 is in a certain speed steady state, or the average value of the electrical angular velocities at multiple sampling times.

[0176] Step 8122, determine whether one of the j electrical angular velocities that is not marked overlaps with the remaining electrical angular velocities. If yes, execute step 8123. If no, execute step 8124.

[0177] Step 8123, marking one of the unmarked electrical angular velocity and the electrical angular velocity that repeats the unmarked electrical angular velocity. In some embodiments, if the electrical angular velocity that repeats the unmarked electrical angular velocity has been marked, the mark of the repeated electrical angular velocity can be removed and the unmarked electrical angular velocity can be marked. In some embodiments, the mark of the repeated electrical angular velocity can also be retained.

[0178] Step 8124, marking the unmarked electrical angular velocity.

[0179] Step 8125, determining whether the number of the marked electrical angular velocities reaches n. If yes, executing step 8126. If no, returning to step 8122.

[0180] Step 8126, end sampling, and delete the remaining unmarked electrical angular velocities and the second parameter and the third parameter corresponding to the unmarked electrical angular velocities. Steps 8121 to 8126 correspond to the second working mode of the sampling judgment module 26.

[0181] In some embodiments, step 8112 and / or step 8122 specifically include:

[0182] The difference between the electrical angular velocity acquired later and each electrical angular velocity stored previously is acquired.

[0183] Determine whether each difference is within a preset difference range. Wherein, corresponding to step 8112, when at least one difference is within the preset difference range, determine that there is duplication between the electrical angular velocity and the stored electrical angular velocity corresponding to the difference. When each difference exceeds the preset difference range, determine that there is no duplication between the electrical angular velocity and the stored electrical angular velocity corresponding to the difference. Corresponding to step 8122, when at least one difference is within the preset difference range, determine that there is duplication between the subsequent electrical angular velocity and the previous electrical angular velocity corresponding to the difference. When each difference exceeds the preset difference range, determine that there is no duplication between the subsequent electrical angular velocity and the previous electrical angular velocity corresponding to the difference. Wherein, the preset difference range can be specifically set according to actual needs, and is not specifically limited in this application. For example, the preset difference range can be but is not limited to ±0.5rpm, ±1rpm, ±2rpm.

[0184] See also Fig.12 In the embodiment of the present application, a method for identifying and compensating an electrical angle deviation is also provided. The method for identifying and compensating an electrical angle deviation is applicable to the offline working mode of the electrical angle deviation identifying and compensating device 20. The method for identifying and compensating an electrical angle deviation includes:

[0185] Step 410, obtaining a first parameter when the working state of the motor object is in a steady state. The specific content of step 410 may correspond to step 210, and will not be repeated here.

[0186] Step 420, obtaining a second parameter of the control module when the working state of the motor object is in a steady state. The specific content of step 420 may correspond to step 230, and will not be repeated here.

[0187] Step 430, obtaining a third parameter of the coordinate transformation module when the working state of the motor object is in a steady state. The specific content of step 430 may correspond to step 250, which will not be described in detail here.

[0188] Step 440, processing the first parameter, the second parameter and the third parameter according to a first preset relationship to obtain the electrical angle deviation value of the motor object. The specific content of step 440 may correspond to step 270, which will not be repeated here.

[0189] Step 450 , determining whether the electrical angle deviation value is within the allowable range. If it is determined that the electrical angle deviation value exceeds the allowable range, executing step 460 , otherwise, returning to step 410 .

[0190] Step 460: Obtain n different steady-state electrical angular velocities of the motor object and the second parameter and the third parameter corresponding to the n electrical angular velocities.

[0191] Step 470: Determine n electrical angle deviation values ​​corresponding to n electrical angular velocities according to a first preset relationship.

[0192] Step 480, fitting the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain a fixed deviation value and a hysteresis delay value. The specific contents of steps 460 to 480 may correspond to reference Figure 5 Steps 281 to 285 of Figure 6 Steps 2861 to 2865 in the above will not be repeated here.

[0193] Step 490: Obtain the electrical angular velocity feedback value of the motor object.

[0194] Step 4110, obtaining an electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle deviation value of the electrical angular velocity feedback value. The specific content of step 4110 may correspond to step 2130, which will not be described in detail here.

[0195] See also Fig.13In the embodiment of the present application, an electrical angle deviation identification and compensation method is also provided. The electrical angle deviation identification and compensation method is applicable to the online working mode of the electrical angle deviation identification and compensation device 20. The electrical angle deviation identification and compensation method includes:

[0196] Step 511, determine whether the working state of the motor object is in a steady state. If yes, execute step 512. If no, repeat step 511. The specific content of step 511 may correspond to reference Fig. 9 Steps 311 to 313 in the above are not described in detail here.

[0197] Step 512, obtaining a first parameter when the working state of the motor object is in a steady state. The specific content of step 512 may correspond to step 210, and will not be repeated here.

[0198] Step 513, obtaining a second parameter of the control module when the working state of the motor object is in a steady state. The specific content of step 513 may correspond to step 230, which will not be described in detail here.

[0199] Step 514, obtaining the third parameter of the coordinate transformation module when the working state of the motor object is in a steady state. The specific content of step 514 may correspond to step 250, which will not be described in detail here.

[0200] Step 515, processing the first parameter, the second parameter and the third parameter according to the first preset relationship to obtain the electrical angle deviation value of the motor object. The specific content of step 515 may correspond to step 270, which will not be repeated here.

[0201] Step 516, determining whether the electrical angle deviation value is within the allowable range. If yes, return to step 511, if no, execute step 517.

[0202] Step 517, determine whether the working state of the motor object is in a steady state. If yes, execute step 518. If no, return to step 517. The specific content of step 517 may correspond to reference Fig. 9 Steps 311 to 313 in the above are not described in detail here.

[0203] Step 518, obtaining the electrical angular velocities of the motor object during j steady-state operation and the second parameter and the third parameter corresponding to the j electrical angular velocities, and determining n mutually different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities. The specific content of step 518 may correspond to step 281, which will not be repeated here. In some embodiments, the specific content of step 518 may correspond to step 281. Fig.10Steps 8111 to 8115 in, or corresponding references Fig.11 Steps 8121 to 8126 in the above description will not be repeated here.

[0204] Step 519: Determine the n electrical angle deviation values ​​corresponding to the n electrical angular velocities according to the first preset relationship. The specific content of step 519 may correspond to step 283, which will not be described in detail here.

[0205] Step 520, fitting the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain the fixed deviation value and the hysteresis delay value. The specific content of step 520 may correspond to step 285, which will not be repeated here. In some embodiments, the specific content of step 520 may correspond to step 285. Figure 6 Steps 2861 to 2865 in the above will not be repeated here.

[0206] Step 521, obtaining the electrical angular velocity feedback value of the motor object.

[0207] Step 522, obtaining an electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle deviation value of the electrical angular velocity feedback value. The specific content of step 521 may correspond to step 2130, which will not be described in detail here.

[0208] See also Fig.14 The embodiment of the present application also provides an electrical angle deviation identification and compensation device 600. The electrical angle deviation identification and compensation device 600 includes a memory 610 and a processor 620. The memory 610 is used to store program instructions, and the processor 620 is used to execute any of the above electrical angle deviation identification and compensation methods by running or executing computer programs and / or modules stored in the memory 610, and calling program instructions. For example, the processor 620 is also used to execute Figure 4 Steps 210 to 2130, Figure 5 Steps 281 to 285 in Figure 6 Steps 2861 to 2865, Figure 7 Steps 2111 to 2115, Figure 8 Steps 2121 to 2127, Fig. 9 Steps 311 to 313 in Fig.10 Steps 8111 to 8115 in Fig.11 Steps 8121 to 8126 in Fig.12 Steps 410 to 4110, Fig.13Specifically, the memory 610 stores program codes, and the processor 620 is used to call the program codes in the memory 610 to execute all the steps in the above-mentioned electrical angle deviation identification and compensation method.

[0209] The memory 610 may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system, application programs required for multiple functions, etc.; the data storage area may store data created according to the operating system, data generated by the application programs, etc. In addition, the memory 610 may include a high-speed random access memory, and may also include a non-volatile memory, such as a hard disk, a memory, a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), multiple disk storage devices, flash memory devices, or other volatile solid-state storage devices.

[0210] The processor 620 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.

[0211] It should be understood by those skilled in the art that Fig.14 The electrical angle deviation identification and compensation device 600 is only an example and does not constitute a limitation on the electrical angle deviation identification and compensation device 600. The electrical angle deviation identification and compensation device 600 may include Fig.14 More or fewer components as shown, or a combination of certain components, or different components, for example, the electrical angle deviation identification and compensation device 600 may also include a communication module, a power supply module, etc.

[0212] The embodiment of the present application also provides a computer-readable storage medium, which is used to store instructions. When the instructions are executed by the processor, any of the above electrical angle deviation identification and compensation methods is implemented. The computer-readable storage medium includes but is not limited to a USB flash drive, a mobile hard disk, a magnetic disk, an optical disk, a read-only memory (English: Read-Only Memory, abbreviated: ROM) or a random access memory (English: Random Access Memory, abbreviated: RAM) and other media that can store program codes.

[0213] Please also read Fig.15 , Fig.16 , Fig.17 and Fig.18 , the embodiment of the present application provides an application of an electrical angle deviation identification and compensation method in a servo system 100. In this embodiment, the control mode of the motor object 14 is set to a speed mode. The rated speed of the motor object 14 is configured to be 3000rpm. The power of the motor object 14 is 600W. The phase resistance of the motor object 14 is configured to be 2.036ohm. The quadrature-axis inductance of the motor object 14 is configured to be 0.007h. An absolute encoder is provided in the motor object 14. Among them, since there is no phase-finding error in the motor object of the absolute encoder, in order to simulate the situation where there is a phase-finding error in the motor object 14, in this embodiment, an offset is added to the electrical angle feedback value of the rotor of the motor object 14, so that the electrical angle feedback value has a lag value of 1°, that is, the electrical angle feedback value of the rotor output by the encoder has a fixed deviation of -1° in theory. The input signal received by the control module 11 is configured as a speed step instruction. The delay of the servo system 100 is 107.75us.

[0214] like Fig.15 As shown, Fig.15 The speed time curve in is the input signal received by the control module 11. Wherein, w0 represents the rated speed of the motor object 14. Under the control of the control module 11, the motor object 14 is respectively Steady-state operation at speed setting value w0 s Duration.

[0215] Collect the motor object 14 respectively The average direct-axis voltage command value during steady-state operation at the speed setting value of w0 Quadrature axis voltage command mean Cross-axis current mean And obtain the evaluation index E corresponding to each speed setting value according to the first preset relationship, and obtain the fixed deviation value Δθ according to the second preset relationship e is -1.0578°, and the lag time delay value is t dIt can be seen that the electrical angle deviation identification and compensation method provided in the embodiment of the present application can accurately identify the fixed deviation value and the hysteresis delay value, that is, accurately identify the electrical angle deviation value of the motor object 14.

[0216] exist Fig.16 In FIG. 1 , the solid line represents the fitting result of the electrical angular velocity and the electrical angle deviation value by the electrical angle deviation identification and compensation method provided in the embodiment of the present application; the dotted line represents the electrical angular velocity and the electrical angle deviation value measured by the encoder. Fig.16 It can be concluded from the results shown that the electrical angle deviation value of the motor object 14 obtained by the electrical angle deviation identification and compensation method provided in the embodiment of the present application is close to the electrical angle deviation value measured by the encoder, so that the electrical angle deviation value identified by the electrical angle deviation identification and compensation method provided in the embodiment of the present application can be used to characterize the electrical angle deviation value of the motor object 14. In this way, the electrical angle deviation of the rotor of the motor object 14 can be obtained, so that the servo system 100 can obtain the actual electrical angle corresponding to the actual position of the rotor according to the electrical angle deviation of the rotor, and compensate for the fixed deviation and / or lag delay of the electrical angle of the motor object 14, which is beneficial for the servo system 100 to reduce or eliminate the deviation between the theoretical electrical angle of the rotor used by the control module 11 when performing signal processing and the actual electrical angle corresponding to the actual position of the rotor, improve the control accuracy of the control module 11 on the rotor position, and thereby improve the working efficiency of the motor object 14, and improve the working stability, control performance and voltage utilization of the servo system 100.

[0217] exist Fig.17 In the figure, the solid line represents the measurement result of the electrical angular velocity and the electrical angle deviation value measured by the encoder after the motor object 14 is compensated by the electrical angle compensation value obtained by the electrical angle deviation identification and compensation method provided in the embodiment of the present application; the dotted line represents the measurement result of the electrical angular velocity and the electrical angle deviation value measured by the encoder when the motor object 14 is not compensated. Fig.17 The results shown indicate that, after the motor object 14 is compensated for the electrical angle compensation value obtained by the electrical angle deviation identification and compensation method provided in the embodiment of the present application, the deviation between the theoretical electrical angle of the rotor and the actual electrical angle corresponding to the actual position of the rotor can be reduced or eliminated, thereby improving the control accuracy of the control module 11 over the rotor position and improving the working efficiency of the motor object 14.

[0218] exist Fig.18In the figure, the solid line represents the measurement result of the direct-axis voltage to the quadrature-axis voltage output by the control module 11 after electrical angle compensation in actual operation; the dashed line represents the measurement result of the direct-axis voltage to the quadrature-axis voltage output by the control module 11 without electrical angle compensation in actual operation; and the dot-dash line represents the ideal value of the direct-axis voltage to the quadrature-axis voltage output by the control module 11 under ideal conditions. Fig.18 It can be concluded from the results shown that, after the control module 11 is compensated for the electrical angle compensation value obtained by the electrical angle deviation identification and compensation method provided in the embodiment of the present application, the difference between the direct-axis voltage to the cross-axis voltage output by the control module 11 in actual work and the direct-axis voltage to the cross-axis voltage in the ideal situation can be reduced or eliminated, so that the direct-axis voltage and the cross-axis voltage output by the control module 11 are closer to the ideal value, thereby improving the control accuracy of the control module 11 on the rotor position and improving the working efficiency of the motor object 14.

[0219] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0220] It should be noted that, for the above-mentioned method embodiments, for the sake of simplicity, they are all expressed as a series of action combinations, but those skilled in the art should be aware that this application is not limited by the order of the actions described, because according to this application, some steps may be performed in other orders or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by this application.

[0221] In the several embodiments provided in the present application, it should be understood that the disclosed device can be implemented in other ways. For example, the device embodiments described above are merely illustrative. When the above-mentioned electrical angle deviation identification and compensation method is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present application is essentially or part of the contribution to the prior art or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, a server or a network device, etc., specifically a processor in a computer device) to perform all or part of the steps of the above-mentioned electrical angle deviation identification and compensation method in each embodiment of the present application. Among them, the aforementioned storage medium may include: U disk, mobile hard disk, disk, optical disk, read-only memory (English: Read-Only Memory, abbreviated: ROM) or random access memory (English: Random Access Memory, abbreviated: RAM) and other media that can store program codes.

[0222] The above are only specific implementations of the present application, but the protection scope of the present application is not limited thereto. Any technician familiar with the technical field can easily think of various equivalent modifications or replacements within the technical scope disclosed in the present application, and these modifications or replacements should be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be based on the protection scope of the claims.

Claims

1. An electrical angle deviation identification and compensation device, It is characterized in that The electrical angle deviation identification and compensation device is applied to a servo system, which includes a control module, a drive module, a coordinate transformation module and a motor object, wherein the coordinate transformation module is connected to the motor object and the control module respectively, the coordinate transformation module is used to receive an output signal of the motor object and generate a feedback signal according to the output signal, the control module is connected to the drive module and is used to generate a control signal according to an input signal and the feedback signal received by the control module, and the drive module is connected to the motor object and is used to drive the motor object to work according to the control signal; The electrical angle deviation identification and compensation device is connected to the motor object, the control module and the coordinate transformation module respectively, and the electrical angle deviation identification and compensation device includes: A sampling module, the sampling module is used to obtain a first parameter of the motor object, a second parameter of the control module and a third parameter of the coordinate transformation module when the working state of the motor object is in a steady state; an identification module, the identification module being connected to the sampling module, and the identification module being used to process the first parameter, the second parameter, and the third parameter according to a first preset relationship to obtain an electrical angle deviation value of the motor object, and to calculate a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value; A compensation module, wherein the compensation module is connected to the sampling module and the identification module respectively, the sampling module is also used to obtain the electrical angle feedback value of the motor object, and the compensation module is used to obtain the electrical angle compensation value according to at least one of the fixed deviation value and the lag delay value and the electrical angle feedback value.

2. The electrical angle deviation identification and compensation device according to claim 1, It is characterized in that The first parameter includes the quadrature-axis inductance of the motor object, the phase resistance of the motor object, and the electrical angular velocity of the motor object; the second parameter includes the quadrature-axis voltage command mean value output by the control module and the direct-axis voltage command mean value output by the control module; the third parameter includes the quadrature-axis current mean value output by the coordinate transformation module; The first preset relationship is: Δθ=arctan(E) Among them, E represents the evaluation index, Expressed as the mean value of the direct-axis voltage command, It is expressed as the mean value of the quadrature axis voltage command, is represented by the mean value of the quadrature axis current, ω is represented by the electrical angular velocity, R s Expressed as the phase resistance, L q is represented by the quadrature-axis inductance, and Δθ is represented by the electrical angle deviation value.

3. The electrical angle deviation identification and compensation device according to claim 2, It is characterized in that The identification module is further configured to calculate the fixed deviation value and the hysteresis delay value based on the electrical angle deviation value when it is determined that the electrical angle deviation value exceeds an allowable range.

4. The electrical angle deviation identification and compensation device according to claim 3, It is characterized in that The sampling module is also used to obtain the electrical angular velocities of the motor object during j steady-state operations and the second parameter and the third parameter corresponding to the j electrical angular velocities. The identification module is also used to determine n different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities, and determine the n electrical angle deviation values ​​corresponding to the n electrical angular velocities according to the first preset relationship, and fit the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain the fixed deviation value and the lag delay value, wherein 3≤n≤j.

5. The electrical angle deviation identification and compensation device according to claim 4, It is characterized in that The second preset relationship is: X=(A T A) -1 A T B Wherein, the n electrical angular velocities are respectively expressed as: 1 、w 2 ,…,w n , the n electrical angle deviation values ​​are respectively expressed as: Δθ 1 , Δθ 2 ,…,Δθ n , Δθ e Expressed as the fixed deviation value, t d A represents the lag time delay value, B represents the second matrix composed of n electrical angle deviation values, and X represents the third matrix composed of the fixed deviation value and the lag time delay value.

6. The electrical angle deviation identification and compensation device according to claim 4, It is characterized in that The electrical angle deviation identification and compensation device also includes an abnormality judgment module, which is connected to the sampling module and the identification module respectively. The abnormality judgment module is used to obtain the phase difference value after subtracting the product of each electrical angular velocity and the lag delay value from the fixed deviation value, and obtain the standardized residual of each electrical angle deviation value and the corresponding phase difference value, and judge whether each standardized residual is within a threshold range, or whether the absolute value of each standardized residual is greater than a threshold. The identification module is also used to delete the corresponding electrical angle deviation from the n electrical angle deviation values, delete the corresponding electrical angular velocity from the n electrical angular velocities, and re-obtain the new fixed deviation value and the new lag delay value according to the second preset relationship when it is determined that the standardized residual exceeds the threshold range or the absolute value of the standardized residual is greater than the threshold.

7. The electrical angle deviation identification and compensation device according to claim 1 or 4, It is characterized in that The electrical angle deviation identification and compensation device also includes a steady-state judgment module, which is connected to the sampling module and the identification module respectively. The sampling module is also used to obtain the speed setting value of the motor object and multiple speed feedback values ​​corresponding to the speed setting value when the motor object is in a speed closed-loop working state. The steady-state judgment module is used to judge whether the speed difference between each speed feedback value and the speed setting value is within an error range, or whether the absolute value of the speed difference is less than an error threshold. If all the speed differences are within the error range, or are less than the error threshold, the steady-state judgment module determines that the working state of the motor object is in a steady state.

8. The electrical angle deviation identification and compensation device according to claim 4, It is characterized in that The electrical angle deviation identification and compensation device also includes a sampling judgment module, which is connected to the sampling module and the identification module respectively. The sampling judgment module is used to judge whether the subsequent electrical angular velocity among the j electrical angular velocities is repeated with the previous electrical angular velocity. The identification module is also used to delete the previous electrical angular velocity or the subsequent electrical angular velocity when it is determined that the subsequent electrical angular velocity is repeated with the previous electrical angular velocity.

9. The electrical angle deviation identification and compensation device according to claim 1 or 5, It is characterized in that The sampling module is further used to obtain the electrical angular velocity value of the motor object and the control period of the servo system, and the compensation module is used to process the electrical angle feedback value, the electrical angular velocity value and the control period according to a first preset compensation relationship to obtain the electrical angle compensation value, wherein the first preset compensation relationship is: TB=t d / t s Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, Expressed as the electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ e Expressed as the fixed deviation value, t d Represented as the hysteresis delay value.

10. The electrical angle deviation identification and compensation device according to claim 1 or 5, It is characterized in that The sampling module is further used to obtain the electrical angular velocity value of the motor object, the electrical angular acceleration value of the motor object and the control period of the servo system, and the compensation module is used to process the electrical angle feedback value, the electrical angular velocity value, the electrical angular acceleration value and the control period according to a second preset compensation relationship to obtain the electrical angle compensation value, and the second preset compensation relationship is: TB=t d / t s Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, and TA(K) represents the electrical angular acceleration value. Expressed as the electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ e Expressed as the fixed deviation value, t d Represented as the hysteresis delay value.

11. The electrical angle deviation identification and compensation device according to claim 10, It is characterized in that The electrical angle deviation identification and compensation device also includes a filtering module, which is connected to the sampling module and the identification module respectively, and is used to filter the electrical angular velocity value and / or the electrical angular acceleration value. The compensation module is also used to obtain the electrical angle compensation value based on the electrical angular velocity value after filtering and / or the electrical angular acceleration value after filtering.

12. A servo system, It is characterized in that The servo system includes the electrical angle deviation identification and compensation device as described in any one of claims 1-11.

13. A method for identifying and compensating electrical angle deviation, It is characterized in that The electrical angle deviation identification and compensation method is applied to the electrical angle deviation identification and compensation device according to any one of claims 1 to 11, or applied to the servo system according to claim 12, and the electrical angle deviation identification and compensation method includes: Obtaining a first parameter when the working state of the motor object is in a steady state; Acquire a second parameter of the control module when the working state of the motor object is in a steady state; Acquire a third parameter of the coordinate transformation module when the working state of the motor object is in a steady state; Processing the first parameter, the second parameter and the third parameter according to a first preset relationship to obtain an electrical angle deviation value of the motor object; A fixed deviation value and a hysteresis delay value are calculated based on the electrical angle deviation value; Obtaining an electrical angle feedback value of the motor object; An electrical angle compensation value is obtained according to at least one of the fixed offset value and the hysteresis delay value and the electrical angle feedback value.

14. The electrical angle deviation identification and compensation method according to claim 13, It is characterized in that The first parameter includes the quadrature-axis inductance of the motor object, the phase resistance of the motor object, and the electrical angular velocity of the motor object; the second parameter includes the quadrature-axis voltage command mean value output by the control module and the direct-axis voltage command mean value output by the control module; the third parameter includes the quadrature-axis current mean value output by the coordinate transformation module; The first preset relationship is: Δθ=arctan(E) Among them, E represents the evaluation index, Expressed as the mean value of the direct-axis voltage command, It is expressed as the mean value of the quadrature axis voltage command, is represented by the mean value of the quadrature axis current, ω is represented by the electrical angular velocity, R s Expressed as the phase resistance, L q is represented by the quadrature-axis inductance, and Δθ is represented by the electrical angle deviation value.

15. The electrical angle deviation identification and compensation method according to claim 14, It is characterized in that The step of calculating the fixed deviation value and the hysteresis delay value based on the electrical angle deviation value includes: Determine whether the electrical angle deviation value is within an allowable range, and when it is determined that the electrical angle deviation value exceeds the allowable range, calculate a fixed deviation value and a hysteresis delay value based on the electrical angle deviation value.

16. The electrical angle deviation identification and compensation method according to claim 15, It is characterized in that The step of calculating the fixed deviation value and the hysteresis delay value based on the electrical angle deviation value includes: Obtaining j electrical angular velocities of the motor object during steady-state operation and the second parameter and the third parameter corresponding to the j electrical angular velocities, and determining n mutually different electrical angular velocities and the second parameter and the third parameter corresponding to the n electrical angular velocities from the j electrical angular velocities, wherein 3≤n≤j; Determine n electrical angle deviation values ​​corresponding to n electrical angular velocities according to the first preset relationship; The n electrical angular velocities and the n electrical angle deviation values ​​are fitted according to a second preset relationship to obtain the fixed deviation value and the lag delay value.

17. The electrical angle deviation identification and compensation method according to claim 16, It is characterized in that The second preset relationship is: X=(A T A) -1 A T B Wherein, the n electrical angular velocities are respectively expressed as: 1 、w 2 ,…,w n , the n electrical angle deviation values ​​are respectively expressed as: Δθ 1 , Δθ 2 ,…,Δθ n , Δθ e Expressed as the fixed deviation value, t d A represents the lag time delay value, B represents the second matrix composed of n electrical angle deviation values, and X represents the third matrix composed of the fixed deviation value and the lag time delay value.

18. The electrical angle deviation identification and compensation method according to claim 16, It is characterized in that After fitting the n electrical angular velocities and the n electrical angle deviation values ​​according to the second preset relationship to obtain the fixed deviation value and the hysteresis delay value, the method further includes: Obtaining a phase difference value obtained by subtracting a product of each of the electrical angular velocities and the hysteresis time delay value from the fixed deviation value; Obtaining a standardized residual between each of the electrical angle deviation values ​​and the corresponding phase difference value; Determining whether each of the standardized residuals is within a threshold range, or whether the absolute value of each of the standardized residuals is greater than a threshold, and when it is determined that the standardized residual exceeds the threshold range, or the absolute value of the standardized residual is greater than the threshold, deleting the corresponding electrical angle deviation from the n electrical angle deviation values, and deleting the corresponding electrical angular velocity from the n electrical angular velocities; A new fixed deviation value and a new hysteresis delay value are obtained again according to the second preset relationship.

19. The electrical angle deviation identification and compensation method according to claim 13 or 16, It is characterized in that The method further comprises: Acquire a speed setting value of the motor object when the motor object is in a speed closed-loop working state; Acquire multiple speed feedback values ​​corresponding to the speed setting value; Determine whether the speed difference between each of the speed feedback values ​​and the speed setting value is within an error range, or whether the absolute value of each of the speed difference values ​​is less than or equal to an error threshold; if all of the speed difference values ​​are within the error range, or are less than or equal to the error threshold, determine that the working state of the motor object is in a steady state; when it is determined that the working state of the motor object is in a steady state, obtain a first signal of the motor object, and / or obtain j of the electrical angular velocities.

20. The electrical angle deviation identification and compensation method according to claim 16, It is characterized in that The step of determining n mutually different electrical angular velocities from the j electrical angular velocities comprises: Determine whether the subsequent electrical angular velocity overlaps with the preceding electrical angular velocity, and when it is determined that the subsequent electrical angular velocity overlaps with the preceding electrical angular velocity, delete the preceding electrical angular velocity or delete the subsequent electrical angular velocity.

21. The electrical angle deviation identification and compensation method according to claim 13 or 17, It is characterized in that The step of obtaining an electrical angle compensation value according to at least one of the fixed deviation value and the hysteresis delay value and the electrical angle feedback value comprises: Obtaining the electrical angular velocity value of the motor object; Acquiring a control period of the servo system; The electrical angle compensation value is obtained according to a first preset compensation relationship, wherein the first preset compensation relationship is: TB=t d / t s Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, Expressed as the electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ e Expressed as the fixed deviation value, t d Represented as the hysteresis delay value.

22. The electrical angle deviation identification and compensation method according to claim 13 or 17, It is characterized in that The obtaining of the electrical angle compensation value according to the electrical angle feedback value and the electrical angle deviation value comprises: Obtaining the electrical angular velocity value of the motor object; Obtaining the electrical angular acceleration value of the motor object; Acquiring a control period of the servo system; The electrical angle compensation value is obtained according to the second preset compensation relationship, where the second preset compensation relationship is: TB=t d / t s Wherein, θ(K) represents the electrical angle feedback value, V(K) represents the electrical angular velocity value, and TA(K) represents the electrical angular acceleration value. Expressed as the electrical angle compensation value, t s is represented by the control cycle, TB is represented by the compensation beat number, Δθ e Expressed as the fixed deviation value, t d Represented as the hysteresis delay value.

23. The electrical angle deviation identification and compensation method according to claim 22, It is characterized in that Before obtaining the electrical angle compensation value according to the second preset compensation relationship, the method further includes: The electrical angular velocity value and / or the electrical angular acceleration value are filtered.

24. An electrical angle deviation identification and compensation device, It is characterized in that The electrical angle deviation identification and compensation device includes a memory and a processor, the memory is used to store program instructions, and the processor is used to call the program instructions to execute the electrical angle deviation identification and compensation method as described in any one of claims 13-23.

25. A computer-readable storage medium, It is characterized in that The computer-readable storage medium is used to store instructions, and when the instructions are executed, the electrical angle deviation identification and compensation method as described in any one of claims 13-23 is implemented.