High-precision closed-loop servo system
By combining multi-pole magnetoelectric encoders and Hall elements, the manufacturing difficulties and signal overlap problems caused by the increase in the number of pole pairs of magnetoelectric encoders are solved, achieving high-precision angle and position detection, which is suitable for large and medium-sized servo systems.
Patent Information
- Application Number
- CN202311303107.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-10-10
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2043-10-10
AI Technical Summary
The existing magneto-electric encoders face difficulties in manufacturing and the overlapping of detection signals after increasing the number of pole pairs, which prevents the accuracy of the servo control system from being improved.
A multi-pole magneto-electric encoder is used. It combines multiple pairs of magnets and a single pair of magnetic conductors arranged coaxially, along with three sets of Hall elements and a magnetic weakening assembly, to achieve high-precision angle detection. The detection signal collected by the Hall elements corresponds one-to-one with the number of teeth in the tooth profile. The added multiple pairs of magnets use the original magnets to calibrate the rotation angle.
It significantly improves the measurement accuracy of magneto-electric encoders and the positioning accuracy of servo systems, and is suitable for angle detection and position detection in large and medium-sized servo systems.
Smart Images

Figure CN117200627B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of servo control technology, and more specifically to a high-precision closed-loop servo system. Background Technology
[0002] A servo control system is an automatic control system typically used to control motors and other actuators. It detects changes in physical quantities through sensors, then performs calculations and controls to ensure the output signal matches the input signal to a desired value, thereby achieving precise control of the actuator's motion. Servo control systems can be categorized into position control, speed control, and torque control based on their control methods. Position control refers to the process of the control system controlling the actuator to reach a target position; speed control refers to the precise control of the actuator's speed; and torque control refers to the control system controlling the magnitude and direction of the actuator's output torque. With the upgrading of the manufacturing industry, the demand for lean manufacturing equipment in downstream sectors is increasing. Lean equipment requires precise control of motion elements such as displacement, speed, and torque, all of which necessitate the use of high-precision closed-loop servo systems.
[0003] In servo control systems, the accuracy of the encoder directly affects the system's speed control and positioning accuracy. Currently, photoelectric encoders are widely used; mounted on a rotating shaft, they transmit angle information to the controller via cables. However, photoelectric encoders still have some insurmountable drawbacks. For example, the code disk of a photoelectric encoder is made of glass with very thin etched lines deposited on it. While its thermal stability and accuracy meet measurement requirements, photoelectric encoders have low resistance to vibration and shock, making them unsuitable for harsh environments such as dust and condensation. Furthermore, their structure and positioning assembly are complex. High assembly precision must be maintained during production, which directly affects production efficiency and ultimately, product cost.
[0004] To overcome the shortcomings of the aforementioned encoders, single-pole or two-ring multi-pole magnetoelectric encoders have emerged for servo control systems. These encoders include a magnet, a magnetic sensing element, and a signal processing circuit. The magnet rotates with the servo motor shaft, generating a changing magnetic field. The magnetic sensing element senses this changing magnetic field and converts the magnetic signal into an electrical signal, which is then output to the signal processing circuit. The signal processing circuit processes this electrical signal into an angle signal for output.
[0005] As the control precision of lean equipment increases, the resolution requirements for magnetoelectric encoders also become higher. To increase encoder resolution, the number of pole pairs is usually increased. However, in practical applications, when the number of pole pairs in a two-ring multi-pole magnetoelectric encoder increases to a certain extent, on the one hand, the thickness of a single pole pair will be drastically reduced to less than 1mm, which is not only detrimental to the bonding of pole pairs, but also causes the multi-pole magnets to be brittle and prone to breakage during the bonding process. On the other hand, due to the influence of errors and noise, the detection signals collected by the magnetic sensing element will completely overlap within a certain angle range. This will make it impossible to obtain the absolute angle of the magnetoelectric encoder, and thus fail to meet the precision control requirements of the servo control system. Summary of the Invention
[0006] Therefore, the purpose of this invention is to provide a high-precision closed-loop servo system, which aims to overcome the difficulty in manufacturing multi-pole magnets due to the increase in the number of pole pairs, and at the same time solve the problem that the detection signals collected by the magnetic sensing element completely overlap in a certain range due to the increase in the number of pole pairs, resulting in the inability to improve the accuracy of the servo control system.
[0007] To achieve the above-mentioned objectives, the technical solution adopted by the present invention is as follows:
[0008] The high-precision closed-loop servo system provided by this invention includes a servo motor;
[0009] A multi-pole magneto-electric encoder is coaxially mounted with the servo motor and outputs high-precision and / or ultra-high-precision absolute angles corresponding to the servo motor's speed range. The multi-pole magneto-electric encoder includes a second multi-pole magnet, a first multi-pole magnet, and a single-pole magnetic conductor assembly and a circuit board, all coaxially arranged. The first multi-pole magnet has m pairs of magnetic poles, where 3 ≤ m < 23; the second multi-pole magnet has n pairs of magnetic poles, where 3 ≤ n < 23; and m is greater than n and is a coprime natural number. The single-pole magnetic conductor assembly includes a first annular magnetic conductor, a single-pole annular magnet, and a second annular magnetic conductor, all coaxially and tightly fitted together. The outer ring diameters of the first and second annular magnetic conductors are larger than the outer ring diameter of the single-pole annular magnet. The first annular magnetic conductor has a first toothed portion on one of its axial end faces, and the second annular magnetic conductor has a second toothed portion completely opposite to the first toothed portion. The first and second toothed portions form an annular opening region. In this structure, the single-pole magnetic conductor assembly achieves a nearly closed overall shape in its radial cross-section. The opening direction of the opening region is consistent with the radial direction of the single-pole annular magnet, and P teeth are correspondingly formed on both the first and second toothed portions, with p ≥ 100. Furthermore, the circuit board includes:
[0010] The first group of Hall elements, including a first linear Hall sensor and a second linear Hall sensor, is arranged adjacent to the first multiple pairs of pole magnets and outputs a first group of detection signals based on the magnetic pole signals of the first multiple pairs of pole magnets.
[0011] The second group of Hall elements, including the third linear Hall sensor and the fourth linear Hall sensor, is arranged adjacent to the second multiple pairs of pole magnets and outputs the second group of detection signals according to the magnetic pole signals of the second multiple pairs of pole magnets.
[0012] A magnetic weakening assembly includes a third magnetic conductor, a first single-pole magnet, and a fourth magnetic conductor that are coaxially and tightly fitted together. The magnetic weakening assembly is disposed between a first toothed portion and a second toothed portion, wherein the magnetic field direction of the first single-pole magnet is opposite to the magnetic field direction of the single-pole ring magnet.
[0013] The third group of Hall elements includes a fifth linear Hall sensor, a sixth linear Hall sensor, and a seventh linear Hall sensor, and is disposed between the second toothed portion and the fourth magnetic conductor, and outputs a corrected third group of detection signals based on the magnetic pole signals of the single pair of magnetic conductor assembly.
[0014] The servo controller includes a control unit and a current sensor. The control unit receives servo motor shaft angle information fed back by multiple pairs of pole magneto-electric encoders and receives current signals collected by the current sensor. After processing, the servo controller issues working commands to control the servo motor.
[0015] The servo driver receives control commands from the servo controller and outputs drive signals for the servo motor according to the load requirements of the servo motor.
[0016] The actuator is connected to the servo motor, and the servo motor drives the actuator to achieve precise control over its motion state.
[0017] Furthermore, the multi-pole magneto-electric encoder selects the high-precision and / or ultra-high-precision absolute angle within the output servo motor speed range using the following formula:
[0018]
[0019]
[0020]
[0021] In the formula, θ3 is the final absolute angle output by the multi-pole magneto-electric encoder; θ1 is the high-precision absolute angle determined by the first and second multi-pole magnets; θ2 is the ultra-high-precision absolute angle determined by combining the obtained high-precision absolute angle θ1 with the single-pole magnet assembly; ω is the current speed of the servo motor; ω0 is 0.8 times the maximum speed allowed when the multi-pole magneto-electric encoder outputs the ultra-high-precision absolute angle; ω1 is 1.2 times the maximum speed allowed when the multi-pole magneto-electric encoder outputs the ultra-high-precision absolute angle; T represents the control cycle of the control command, and k represents the kth control cycle.
[0022] Furthermore, the servo motor is a permanent magnet synchronous servo motor.
[0023] Furthermore, m and n are prime numbers and mn < 23 × 19.
[0024] Furthermore, the first set of detection signals includes: a first detection signal and a second detection signal output by a first linear Hall sensor and a second linear Hall sensor based on the magnetic pole signals of the first multiple pairs of magnetic poles; the first detection signal and the second detection signal are 90 degrees out of phase.
[0025] The second set of detection signals includes: a third detection signal and a fourth detection signal output by a third linear Hall sensor and a fourth linear Hall sensor based on the magnetic pole signals of the second multi-pair magnet; the third detection signal and the fourth detection signal are 90 degrees out of phase.
[0026] Furthermore, the modified third set of detection signals includes: d-axis and q-axis detection signals output by the fifth, sixth, and seventh linear Hall sensors based on the magnetic pole signals of the single-pair magnetic conductor assembly; wherein, after acquiring the magnetic pole signals of the single-pair magnetic conductor assembly, the fifth, sixth, and seventh linear Hall sensors obtain original three-phase Hall signals with a phase difference of 120 degrees, which are the fifth, sixth, and seventh detection signals; then, after zero-point drift processing of the obtained original three-phase Hall signals, d-axis and q-axis detection signals with a phase difference of 90 degrees are output.
[0027] Preferably, the first linear Hall sensor, the third linear Hall sensor, and the fifth linear Hall sensor are aligned at one end.
[0028] Preferably, the first multiple pairs of pole magnets are located between the single pair of pole conductor assembly and the second multiple pairs of pole magnets, and there is an angular difference between the initial pole installation positions of the first multiple pairs of pole magnets and the second multiple pairs of pole magnets.
[0029] Preferably, the magnetization directions of the first multiple pairs of pole magnets and the second multiple pairs of pole magnets are consistent with the radial or axial direction of the servo motor shaft; the magnetization direction of the single pair of pole magnet assembly is consistent with the radial or axial direction of the servo motor shaft.
[0030] Preferably, the actuator is any one of a lead screw, guide rail, reducer, two-dimensional rotary table, or CNC operating platform.
[0031] The beneficial effects of this invention are as follows: In this invention, the axial end face of the first annular magnetic conductor in the single-pole magnetic conductor assembly is configured as a first toothed portion, and a second annular magnetic conductor is configured with a second toothed portion completely opposite to the first toothed portion, while maintaining an opening between them. When the single-pole magnetic conductor assembly rotates coaxially for one revolution, the number of cycles in the detection signal collected by the Hall element corresponds one-to-one with the number of teeth in the first or second toothed portion. That is, both the first and second toothed portions, each corresponding to having P teeth, will obtain a detection signal containing P cycles. This perfectly matches the detection signal collected by the Hall element of a multi-pole magnetic conductor with P pole pairs. At this time, the single-pole magnetic conductor assembly can be equivalent to a multi-pole magnetic conductor with P pole pairs.
[0032] Furthermore, the multi-pole magnetoelectric encoder used in the high-precision closed-loop servo system provided by this invention adds an axially multi-pole magnet with a much larger number of pole pairs than the original two-ring multi-pole magnet. Due to the increase in the number of pole pairs, it is difficult to manufacture and bond the pole pairs in the multi-pole magnet. This invention uses a single-pole magnetic conductor assembly to perfectly avoid this defect. That is, by machining, a first tooth profile with P teeth can be easily machined on the first annular magnetic conductor, and a second tooth profile with P teeth can be machined on the second annular magnetic conductor. The teeth on the first tooth profile and the teeth on the second tooth profile are matched one-to-one. In this way, the number of pole pairs of the added multi-pole magnet is greatly increased. The actual rotation angle of the added multi-pole magnet is calibrated by using the mechanical angle with a certain accuracy obtained from the original two-ring multi-pole magnet, thereby greatly improving the measurement accuracy of the magnetoelectric encoder, and correspondingly greatly improving the positioning accuracy and angle control accuracy of the servo system. The high-precision closed-loop servo system provided by this invention is particularly suitable for angle detection and position detection scenarios in large and medium-sized servo systems. Attached Figure Description
[0033] To more clearly illustrate the technical solutions in the embodiments of the present invention or the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.
[0034] Figure 1 This diagram illustrates the structural block diagram of a high-precision closed-loop servo system according to an embodiment of this application.
[0035] Figure 2 A cross-sectional view of a multi-pole magnetic encoder according to an embodiment of this application is shown;
[0036] Figure 3 A perspective view of a multi-pole magnetic encoder according to an embodiment of this application is shown;
[0037] Figure 4 This document shows a flowchart of the absolute angle detection method for a multi-pole magnetoelectric encoder according to an embodiment of this application.
[0038] Figure 5 This invention illustrates the signal detection principle of two linear Hall sensors in an embodiment of this application.
[0039] Figure 6 This illustration shows a schematic diagram of two linear Hall elements detecting signals in an embodiment of this application.
[0040] Figure 7 This invention illustrates the signal detection principle of three linear Hall sensors in an embodiment of this application.
[0041] Figure 8 This diagram illustrates the signal detection of three linear Hall sensors in an embodiment of this application without the addition of a magnetic weakening assembly.
[0042] Figure 9 This diagram illustrates the zero-crossing point of the signals detected by the three linear Hall sensors when a magnetic weakening assembly is added in an embodiment of this application.
[0043] Figure 10 This diagram illustrates the principle of eliminating zero-point drift using three Hall signals in an embodiment of this application.
[0044] Figure 11 A schematic diagram illustrating the principle of synthesizing two-phase Hall signals in an embodiment of this application is shown;
[0045] Figure 12 Show Figure 2-3 There is an angular difference θ between the initial magnetic pole installation positions of the second multi-pole magnet and the first multi-pole magnet. x A schematic diagram;
[0046] Figure 13 This diagram illustrates the number of magnetic pole position feature values in an embodiment of this application.
[0047] Figure 14 This is a linear schematic diagram illustrating the angle switching selection output relationship of the absolute angle of multiple pairs of pole magneto-electric encoders in an embodiment of this application;
[0048] Figure 15This document shows a flowchart of a high-precision closed-loop servo system control method in an embodiment of this application.
[0049] Figure 16 This shows a first sub-flowchart of the high-precision closed-loop servo system control method in an embodiment of this application;
[0050] Figure 17 The second sub-flowchart of the high-precision closed-loop servo system control method in this application embodiment is shown. Detailed Implementation
[0051] Exemplary embodiments will now be described more fully with reference to the accompanying drawings. However, these exemplary embodiments can be implemented in many forms and should not be construed as limited to the embodiments set forth herein. These embodiments are provided so that the invention will be more comprehensive and complete, and that the concept of the exemplary embodiments will be fully conveyed to those skilled in the art. The same reference numerals in the drawings denote the same or similar parts, and therefore repeated descriptions of them will be omitted.
[0052] Furthermore, the described features, structures, or characteristics may be combined in any suitable manner in one or more embodiments. Numerous specific details are provided in the following description to give a thorough understanding of embodiments of the invention.
[0053] It should be understood that while the terms first, second, third, etc., may be used in this document to describe various components, these components should not be limited by these terms. These terms are used only for distinction. As used herein, the term "and / or" includes any and all combinations of any one or more of the listed items.
[0054] Those skilled in the art will understand that the accompanying drawings are merely schematic diagrams illustrating exemplary embodiments. The modules or processes shown in the drawings are not necessarily essential for implementing the present invention and therefore should not be used to limit the scope of protection of the present invention.
[0055] As the control precision of lean equipment increases, the resolution requirements for magnetoelectric encoders also become higher. To increase encoder resolution, the number of pole pairs is usually increased. However, in practical applications, when the number of pole pairs in a two-ring multi-pole magnetoelectric encoder increases to a certain extent, on the one hand, the thickness of a single pole pair will be drastically reduced to less than 1mm, which is not only detrimental to the bonding of pole pairs, but also causes the multi-pole magnets to be brittle and prone to breakage during the bonding process. On the other hand, due to the influence of errors and noise, the detection signals collected by the magnetic sensing element will completely overlap within a certain angle range. This will make it impossible to obtain the absolute angle of the magnetoelectric encoder, and thus fail to meet the precision control requirements of the servo control system.
[0056] To address the aforementioned problems, this application provides a multi-pole magnetoelectric encoder comprising a single-pole magnetic conductor assembly. In this invention, an axial end face of the first annular magnetic conductor in the single-pole magnetic conductor assembly is configured as a first toothed portion, and a second annular magnetic conductor has a second toothed portion completely opposite to the first toothed portion, with an opening between them. When the single-pole magnetic conductor assembly rotates coaxially for one revolution, the number of cycles in the detection signal acquired by the Hall element corresponds one-to-one with the number of teeth in the first or second toothed portion. That is, if both the first and second toothed portions have P teeth, a detection signal containing P cycles will be obtained, which perfectly matches the detection signal acquired by a multi-pole magnet with P pole pairs using a Hall element. Therefore, the single-pole magnetic conductor assembly can be considered equivalent to a multi-pole magnet with P pole pairs.
[0057] Based on this, this application provides a high-precision automatic control system. The multi-pole magnetoelectric encoder in this high-precision automatic control system employs three sets of multi-pole magnets arranged coaxially, wherein the additional multi-pole magnets are the aforementioned single-pole magnetic conductor assembly. The core of this invention is to axially add a multi-pole magnet with a much larger number of pole pairs than the original two-ring multi-pole magnets. The actual rotation angle of the added multi-pole magnet is calibrated using the mechanical angle with a certain accuracy obtained from the original two-ring multi-pole magnets, thereby significantly improving the measurement accuracy of the magnetoelectric encoder, and correspondingly, greatly improving the positioning accuracy and angle control accuracy of the servo control system. The high-precision closed-loop servo system provided by this invention is particularly suitable for angle detection and position detection scenarios in large and medium-sized servo systems. The technical solution of this application will be described in detail below with reference to the accompanying drawings.
[0058] Figure 1 This diagram illustrates the structural block diagram of a high-precision closed-loop servo system according to an embodiment of this application.
[0059] like Figure 1 As shown, the high-precision closed-loop servo system includes: a servo controller, a servo driver, a multi-pole magneto-electric encoder, a servo motor, an actuator, and a host computer.
[0060] The system includes: a multi-pair magnetoelectric encoder, coaxially mounted with the servo motor, which outputs high-precision and / or ultra-high-precision absolute angles corresponding to the servo motor's speed range; a servo controller, comprising a control unit and a current sensor (in this example, the control unit is an MCU chip); the control unit receives servo motor shaft angle information fed back by the multi-pair magnetoelectric encoder and current signals collected by the current sensor, processes the data, and then issues control commands to the servo motor; a servo driver receives the control commands from the servo controller and outputs drive signals to the servo motor according to its load requirements; an actuator connected to the servo motor, which drives the actuator to achieve precise control of its motion; and a host computer that communicates with the controller and sends angle commands from the servo motor to the servo controller.
[0061] According to an example embodiment of this application, the multi-pole magneto-electric encoder includes an encoder magnet structure 100 and a circuit board. The encoder magnet structure 100 includes a second multi-pole magnet 120, a first multi-pole magnet 110, and a single-pole magnetic conductor assembly 130, all coaxially arranged. The circuit board is provided with a first set of Hall elements, a second set of Hall elements, a third set of Hall elements, and a magnetic weakening assembly 150. In this example, the circuit board is not shown in the diagram.
[0062] According to an example embodiment of this application, the servo motor is a permanent magnet synchronous servo motor, comprising a stator, rotor, shaft, magnets, windings, and a series of connecting components. The first multi-pole magnet 110, the second multi-pole magnet 120, the single-pole magnetic conductor assembly 130, and the circuit board operate simultaneously. The first multi-pole magnet 110, the second multi-pole magnet 120, and the single-pole magnetic conductor assembly 130 rotate together with the servo motor shaft. The three sets of Hall elements and the field weakening assembly 150 on the circuit board remain stationary.
[0063] Figure 2 This is a cross-sectional view of a multi-pole magnetic encoder according to an embodiment of this application.
[0064] Figure 3 A perspective view of a multi-pole magnetic encoder according to an embodiment of this application is shown.
[0065] like Figure 2 , Figure 3 As shown, the multi-pole magnetic encoder includes: a first multi-pole magnet 110, a second multi-pole magnet 120, a single-pole magnetic conductor assembly 130, and a magnetic weakening assembly 150, which are coaxially arranged in a first spatial plane.
[0066] The single-pole magnetic conductor assembly 130 includes a first annular magnetic conductor 135, a single-pole annular magnet 134, and a second annular magnetic conductor 136, which are coaxially and tightly fitted together. The outer ring diameters of the first annular magnetic conductor 135 and the second annular magnetic conductor 136 are larger than the outer ring diameter of the single-pole annular magnet 134. The first annular magnetic conductor 135 has a first toothed portion on one of its axial end faces, and the second annular magnetic conductor 136 has a second toothed portion that is completely opposite to the first toothed portion. The first toothed portion and the second toothed portion form an annular opening region. In this structure, the single-pole magnetic conductor assembly 130 achieves a generally closed shape in its radial cross-section. The opening direction of the opening region is consistent with the radial direction of the single-pole annular magnet 134, and P teeth are correspondingly opened on both the first toothed portion and the second toothed portion, where p ≥ 100.
[0067] The magnetic weakening assembly 150 includes a third magnetic conductor 151, a first single-pole magnet 152, and a fourth magnetic conductor 153 that are coaxially and tightly fitted together. The magnetic weakening assembly 150 is located between the first toothed portion and the second toothed portion. It should be noted that the magnetic field direction of the first single-pole magnet 152 is opposite to the magnetic field direction of the single-pole annular magnet 134.
[0068] The first multi-pole magnet 110 includes m pairs of magnetic poles, where 3 ≤ m < 23; the second multi-pole magnet 120 includes n pairs of magnetic poles, where 3 ≤ n < 23, m is greater than n and mn < 23 × 19; the single-pole magnetic conductor assembly 130 includes p pairs of magnetic poles, where p ≥ 100. p can be 100, 200, 300, 400, 500, 600, 700, 800, or even more. The more p values, the higher the accuracy of the final magneto-electric encoder. For example, according to some embodiments, m and n are prime numbers and coprime to each other. Figure 2 , 3 As shown in this embodiment, m is 5, n is 3, and p is 100, but this application is not limited to this.
[0069] According to an example embodiment of this application, a first multi-pole magnet 110 is positioned between a single-pole magnetic conductor assembly 130 and a second multi-pole magnet 120. The number of pole pairs m of the first multi-pole magnet 110 is greater than the number of pole pairs n of the second multi-pole magnet 120. This is because the diameter of the first multi-pole magnet 110 is larger than the diameter of the second multi-pole magnet 120, and to ensure uniform magnet size, the number of pole pairs in the first multi-pole magnet 110 is greater than the number of pole pairs in the second multi-pole magnet 120.
[0070] This application defines the number of pole pairs m of the first multi-pole magnet 110 and the number of pole pairs n of the second multi-pole magnet 120 in order to obtain an effective detection signal in practical applications and avoid the detection signals from overlapping within a certain angle range.
[0071] According to some embodiments of this application, the magnetization direction of the first multi-pole magnet 110 can be aligned with the radial or axial direction of the servo motor shaft. Figure 2 , 3 In the illustrated embodiment, the magnetization direction of the first pair of pole magnets 110 is set to the axial direction. The magnetization direction of the second pair of pole magnets 120 may also be consistent with the radial or axial direction of the servo motor shaft. Figure 2 , 3 In the illustrated embodiment, the magnetization direction of the second multi-pole magnet 120 is set to the axial direction. Similarly, the magnetization direction of the single-pole magnet assembly 130 can also be consistent with the radial or axial direction of the servo motor shaft. Figure 2 , 3 In the illustrated embodiment, the magnetization direction of the single-pole magnet assembly 130 is set to the axial direction. This application does not limit the magnetization direction.
[0072] Both the first multi-pole magnet 110 and the second multi-pole magnet 120 can be formed by bonding multiple magnetic pole pairs, but are not limited thereto. According to the embodiments of this application, the magnets can be made of neodymium iron boron permanent magnet material and can be directly attached to the rotating shaft or fixed to the rotating shaft. When installing and fixing, there is an angle difference between the initial magnetic poles of the first multi-pole magnet 110 and the second multi-pole magnet 120.
[0073] like Figure 2 , 3 As shown, the multi-pole magnetic encoder also includes a first group of Hall elements, a second group of Hall elements, and a third group of Hall elements, used to detect the magnetic signals generated by the multi-pole magnets.
[0074] The first set of Hall elements, including a first linear Hall sensor 111 and a second linear Hall sensor 112, is disposed adjacent to the first plurality of pole magnets 110 and outputs a first set of detection signals based on the magnetic pole signals of the first plurality of pole magnets 110. The output signals of the first linear Hall sensor 111 and the second linear Hall sensor 112 are 90 degrees out of phase.
[0075] The second set of Hall elements, including a third linear Hall sensor 121 and a fourth linear Hall sensor 122, is arranged adjacent to the second multi-pair magnet 120 and outputs a second set of detection signals based on the magnetic pole signals of the second multi-pair magnet 120. The output signals of the third linear Hall sensor 121 and the fourth linear Hall sensor 122 are 90 degrees out of phase.
[0076] The third group of Hall elements, including a fifth linear Hall sensor 131, a sixth linear Hall sensor 132, and a seventh linear Hall sensor 133, is disposed between the second toothed portion and the fourth magnetic conductor 153, and outputs a corrected third group of detection signals based on the magnetic pole signals of the single-pole magnetic conductor assembly 130. The output signals of the fifth linear Hall sensor 131, the sixth linear Hall sensor 132, and the seventh linear Hall sensor 133 are 120 degrees out of phase.
[0077] After the single-pole magnetic conductor assembly 130 rotates once around its axis, the third set of Hall elements will collect three types of raw detection signals. The number of cycles in each raw detection signal is exactly the same as the number of teeth in the first toothed portion of the first annular magnetic conductor 135 or the second toothed portion of the second annular magnetic conductor 136. That is, the number of teeth P in the first toothed portion or the second toothed portion matches the number of cycles in the detection signal. Therefore, the single-pole magnetic conductor assembly 130, which has P teeth in both the first annular magnetic conductor 135 and the second annular magnetic conductor 136, can be considered as a multi-pole magnetic conductor with P pole pairs.
[0078] It is particularly noteworthy that a magnetic weakening assembly 150 has been added in this application. If the magnetic weakening assembly 150 is not added, i.e., if the third set of Hall elements is placed between the first and second toothed portions, the detection signal collected by the third set of Hall elements for the single-pair magnetic conductor assembly 130 is as follows: Figure 8 As shown. Figure 8 The detection signals shown are all positive voltage signals that do not cross zero.
[0079] The purpose of adding this magnetic weakening assembly 150 in this invention is to change the magnetic pole signal of the single-pole magnetic conductor assembly 130 by adjusting the opposite magnetic field direction in the magnetic weakening assembly 150 in conjunction with adjusting the magnetic field strength of the first single-pole magnet 152. Ultimately, this achieves a zero-crossing voltage signal with both positive and negative phases collected by the third set of Hall elements, thereby maximizing the full-amplitude characteristics and acquisition accuracy of the linear Hall sensor. By setting the magnetic weakening assembly 150, the third set of Hall elements targets the single-pole magnetic conductor assembly 130 and transmits the collected detection signal as follows: Figure 9 As shown. This is also the significance of providing a weak magnetic assembly 150 between the first toothed portion and the second toothed portion in the single-pole magnetic conductor assembly 130 of the present invention.
[0080] Based on the tooth structure, we know that each tooth has a tooth tip and a tooth recess. The distance between the tooth tip and tooth recess of the first tooth section and the corresponding tooth tip and tooth recess of the second tooth section can reflect the change in magnetic field strength. That is, according to the characteristics of the magnetic field, when the distance between the two tooth tips is significantly smaller than the distance between the two tooth recesses, the magnetic field strength between the two tooth tips is significantly greater than the magnetic field strength between the two tooth recesses.
[0081] According to some embodiments, in the encoder structure described above, the first linear Hall sensor 111, the third linear Hall sensor 121, and the fifth linear Hall sensor 131 are aligned at one end.
[0082] Figure 4 The flowchart of the absolute angle detection method of a multi-pole magnetoelectric encoder according to an embodiment of this application is shown.
[0083] This application also provides a method for detecting the absolute angle of the above-mentioned multi-pole magnetic encoder, such as... Figure 4 As shown, it includes:
[0084] In step S410, the first group of detection signals, the second group of detection signals, and the corrected third group of detection signals are obtained through the first group of Hall elements, the second group of Hall elements, and the third group of Hall elements, respectively.
[0085] The multi-pole magneto-electric encoder provided in this application includes a second multi-pole magnet 120, a first multi-pole magnet 110, and a single-pole magnetic conductor assembly 130, which are coaxially and sequentially mounted on a rotating shaft. The second multi-pole magnet 120 and the first multi-pole magnet 110 have coprime pole pairs. The three sets of magnets are isolated to prevent magnetic field coupling. The magnetic field around the three sets of multi-pole magnets exhibits a sinusoidal distribution in the circumferential direction.
[0086] The first group of Hall elements and the two linear Hall sensors in the second group of Hall elements, which are respectively arranged corresponding to the first multi-pair magnet 110 and the second multi-pair magnet 120, are arranged at an angle of 90° electrical angle. The following is in conjunction with... Figure 5 , 6 This paper introduces the principle of using two linear Hall sensors to detect the magnetic signals of the second multi-pole magnet 120 or the first multi-pole magnet 110.
[0087] Figure 5 The diagram illustrates the signal detection principle of two linear Hall sensors in an embodiment of this application.
[0088] Figure 6 This diagram illustrates the detection signals of two linear Hall elements in an embodiment of this application.
[0089] As a magnet rotates one revolution along its axis, the magnetic field at any point in space changes systematically. This change can be converted into sine and cosine electrical signals using two linear Hall sensors with an electrical angle difference of 90°. The frequency of these signals is the same as the frequency of the magnetic pole rotation. For example... Figure 5 , 6 As shown, for the second multi-pole magnet 120 with three pole pairs, when the magnet rotates one revolution, the third linear Hall sensor 121 and the fourth linear Hall sensor 122 detect three cycles of sine and cosine signals, i.e., a set of detection signals. The first set of detection signals can be obtained through the first set of Hall elements set in the first multi-pole magnet 110. The second set of detection signals can be obtained through the second set of Hall elements set in the second multi-pole magnet 120.
[0090] In practice, two Hall effect sensors are often arranged at an electrical angle of 90°. However, this two-Hall arrangement struggles to eliminate errors caused by machining or assembly, and it also fails to suppress harmonic errors present in the magnetic field. Increasing the number of Hall effect sensors or symmetrically arranging them primarily reduces mechanical errors through symmetrical cancellation, while also offsetting harmonic components. Therefore, this application employs a three-Hall arrangement on the single-pair magnetic conductor assembly 130, achieving high calculation accuracy when the electrical angle of the three Hall effect sensors is 120°.
[0091] The third group of Hall elements is arranged adjacent to the single-pair magnetic conductor assembly 130, and the three linear Hall sensors are arranged at intervals of 120° electrical angle. The following section combines... Figure 7-11 This paper introduces the principle of detecting magnetic signals of a single-pair magnetic conductor assembly 130 using three linear Hall sensors.
[0092] Figure 7 The diagram illustrates the signal detection principle of three linear Hall sensors in an embodiment of this application.
[0093] Figure 8 This diagram illustrates the signal detection of three linear Hall sensors in an embodiment of this application without the addition of a magnetic weakening assembly.
[0094] Figure 9 This diagram illustrates the zero-crossing point of the signals detected by the three linear Hall sensors when a weak magnetic assembly is added in an embodiment of this application.
[0095] Figure 10 This diagram illustrates the principle of eliminating zero-point drift using three Hall signals in an embodiment of this application.
[0096] Figure 11 The schematic diagram of synthesizing two-phase Hall signals in the embodiments of this application is shown.
[0097] Based on the above principle, it is easy to see that this magnetic field change can also be converted into sine and cosine electrical signals using three linear Hall sensors with electrical angles differing by 120°. For example... Figure 7 , 9 As shown, for a single-pole magnetic conductor assembly 130 with six pole pairs, after one rotation of the magnet, the fifth linear Hall sensor 131, the sixth linear Hall sensor 132, and the seventh linear Hall sensor 133 respectively detect six cycles of sine and cosine signals, i.e., the original three-phase Hall signals. The original three-phase Hall signals here... Figure 10 The signals are represented by U1, U2, and U3 respectively, with U1 corresponding to the detection signal of the fifth linear Hall sensor 131; U2 corresponding to the detection signal of the sixth linear Hall sensor 132; and U3 corresponding to the detection signal of the seventh linear Hall sensor 133.
[0098] Due to issues with Hall effect placement and mechanical assembly, the original three-phase Hall signals U1, U2, and U3 are superimposed with some error signals, affecting the component U of the synthesized two-phase 90° phase difference. d U q At that time, there is a high probability that the zero point will drift.
[0099] Therefore, it is necessary to perform zero-point drift processing on the acquired raw three-phase Hall signals, such as... Figure 10 As shown, the specific calculation is performed according to the following formula:
[0100]
[0101] In the formula, U1, U2, and U3 are the original three-phase Hall signals; U shift U′ represents the signal drift. ′ U′2 and U′3 are the three-phase Hall voltage signals after removing the drift.
[0102] Then, the three-phase Hall voltage signals, after removing zero-point drift, are synthesized into a two-phase U with a 90° phase difference. d U q Signals, such as Figure 11 As shown, the conversion is performed using the following formula:
[0103]
[0104] In the formula, α is the angle between the electrical angle of the detection signal of any linear Hall sensor in the third group of Hall elements and the horizontal direction, and U d U q The output two-phase Hall voltage signals are the corrected third set of detection signals.
[0105] At this point, the third set of detection signals with a corrected two-phase phase difference of 90° can be approximated as sine and cosine detection signals acquired by two linear Hall sensors. For the convenience of subsequent textual explanation, this application approximates the third set of Hall elements as two linear Hall sensors arranged at an electrical angle of 90°.
[0106] Of course, the second multi-pair magnet 120 and the first multi-pair magnet 110 of this application can also be arranged in the form of a three-Hall sensor to improve the measurement accuracy, and then the above formula can be used to convert the acquired detection signal into a detection signal with a two-phase phase difference of 90°.
[0107] In step S420, angle calculations are performed on the first group of detection signals, the second group of detection signals, and the corrected third group of detection signals to obtain the first electrical angle value, the second electrical angle value, and the third electrical angle value, respectively.
[0108] After obtaining sine and cosine signals using a linear Hall sensor, a digital voltage value with a certain number of bits can be obtained through an A / D conversion circuit. That is, the first, second, or corrected third set of detection signals are converted to digital values using an A / D converter to obtain the first, second, or third set of voltage values. While the digital voltage value at this point is related to the encoder's measured angle, it is not the encoder's measured angle value and requires angle calculation.
[0109] For each pair of magnetic poles, the two linear Hall sensors are spatially 90° apart, causing their output sine and cosine signals to be 90° out of phase. The signal with the leading phase can be considered a sine signal, and the signal with the lagging phase a cosine signal. Dividing the sine signal by the cosine signal yields the tangent of the signal at that point. Then, performing an arctangent operation on this tangent yields the electrical angle value at that point.
[0110] Since the tangent function's interval is [-90°, 90°], directly calculating the angle using the above process will lead to an error in the angle calculation interval. Therefore, it is necessary to solve the interval error problem by dividing the intervals, that is, obtaining the electrical angle interval of the first group of detection signals, the second group of detection signals, or the corrected third group of detection signals based on the sign and magnitude of the voltage values in the first group of voltage values, the second group of voltage values, or the corrected third group of voltage values.
[0111] Taking the angle calculation of a set of magnetic poles as an example, the 360° of this set of magnetic poles can be divided into 8 equal-length intervals at 45° intervals. By judging the magnitude and sign of the voltage values detected by the two linear Hall elements, the position of the Hall signal at this time can be determined. The implementation principle of the interval arctangent algorithm is shown in Table 1 below. VA and VB are linear Hall detection signals with a 90° phase difference.
[0112] Table 1. Division of Angle Intervals
[0113]
[0114] By dividing the angle range as described above, the signal acquired by the Hall element can be converted into an angle signal, and the converted electrical angle range is [0°, 360°].
[0115] For the multi-pole magneto-electric encoder of this application, the angle range of the first, second, and corrected third detection signals can be obtained based on the sign and magnitude of the voltage values in the first, second, and third sets of voltage values. According to this angle range, the first, second, and third electrical angle values can be obtained by applying the arctangent algorithm to the first, second, or third sets of voltage values as shown in Table 1. Here, the electrical angle value refers to the electrical angle value of a single pair of magnetic poles in a single cycle, or simply the single-cycle electrical angle value.
[0116] During angle measurement, three sets of multi-pole magnets rotate simultaneously with the shaft, while the linear Hall element remains stationary to receive the changing magnetic field signal generated by the rotating poles. The induced signal from the linear Hall element is processed using the aforementioned arctangent lookup table method to obtain the electrical angle value of a single pair of magnetic poles of the measured magnet. After determining the electrical angle value of a single cycle, the magnetic pole interval in which the electrical angle value of that single cycle is located is determined, and finally, the tooth count interval on the single-pole magnetic conductor assembly 130 is determined, in order to finally obtain the absolute angle value detected by the multi-pole magneto-electric encoder.
[0117] In the absolute angle detection method for the multi-pole magneto-electric encoder provided in this application, firstly, an initial mechanical angle with a certain accuracy is determined based on two sets of detection signals from the second multi-pole magnet 120 and the first multi-pole magnet 110. Then, this initial mechanical angle is used to calibrate which specific tooth count interval of the single-pole magnet assembly 130 is currently located within the single-cycle electrical angle value of the single-pole magnet assembly 130. Finally, the mechanical angle of the multi-pole magneto-electric encoder is calculated using the formula for calculating the mechanical angle value. The mechanical angle mentioned in this application is also referred to as the absolute angle.
[0118] Next, this application will describe in detail how to obtain an initial mechanical angle with a certain accuracy.
[0119] In this application, the initial mechanical angle can be calculated according to the following formula:
[0120] θ _single =N m ×360° / m+θ m / m formula (3) where, N m ∈[0, m-1] or
[0121] θ _single =(N m -1)×360° / m+θ m / m formula (4) where, N m ∈[1, m]
[0122] In the formula, θ _single Let θ be the initial mechanical angle. m N is the single-cycle electrical angle value measured by the linear Hall sensor on the first multi-pole magnet 110. m For θ m The first magnetic pole region in which it is located; m is the number of magnetic pole pairs of the first multi-pole magnet 110. Here, θ m It is also known as the first electrical angle value.
[0123] for Figure 2-3 The encoder shown has an angular difference θ between the initial pole mounting positions of the second multi-pole magnet 120 and the first multi-pole magnet 110. x ,like Figure 12 As shown, the initial mechanical angle can also be expressed as:
[0124] θ _single =N n ×360° / n+θ n / n+θ x Formula (5) where N n ∈[0, n-1] or
[0125] θ _single =(N n -1)×360° / n+θ n / n+θ x Formula (6) where N n ∈[1, n]
[0126] In the formula, θ _single Let θ be the initial mechanical angle. n N is the single-cycle electrical angle value measured by the linear Hall sensor on the second multi-pole magnet 120. n For θ n The second magnetic pole region in which it is located; n is the number of magnetic pole pairs of the second multi-pole magnet 120. θ nIt is also known as the second electrical angle value.
[0127] Therefore, once the first or second electrical angle value has been obtained, as long as the corresponding magnetic pole range is determined, the initial mechanical angle value can be calculated according to the above formulas (3) to (6).
[0128] In step S430, the first magnetic pole interval corresponding to the first electrical angle value is determined based on the number of magnetic pole pairs m of the first multi-pole magnet 110, the number of magnetic pole pairs n of the second multi-pole magnet 120, the first electrical angle value, and the second electrical angle value.
[0129] When the linear Hall sensor on the first multi-pole magnet 110 measures the same single-cycle electrical angle value twice, the corresponding single-cycle electrical angle values measured by the linear Hall sensor on the second multi-pole magnet 120 are different. Thus, it is possible to distinguish the number of magnetic pole pairs, i.e., the magnetic pole interval, where the single-cycle electrical angle of the first multi-pole magnet 110 is currently located.
[0130] For the encoder magnet structure 100 provided in this application, when the greatest common divisor of the number of pole pairs m and n of the first multi-pole magnet 110 and the second multi-pole magnet 120 is 1, i.e., coprime, each pole pair of the first multi-pole magnet 110 has a corresponding non-repeating pole portion of the second multi-pole magnet 120. This will be proven by contradiction below.
[0131] Suppose there exists a positive integer N m1 N m2 N n1 N n2 N m1 ≠N m2 This makes the following equation true:
[0132] (N m1 -1)×360° / m+θ m / m=(N n1 -1)×360° / n+θ n / n+θ x
[0133] (N m2 -1)×360° / m+θ m / m=(N n2 -1)×360° / n+θ n / n+θ x Formula (7)
[0134] Where, θ m N is the single-cycle electrical angle value measured by the linear Hall sensor on the first multi-pole magnet 110. m1 N m2 ∈[1, m], where θ is measured twice.m The corresponding first magnetic pole region; θ n N is the single-cycle electrical angle value measured by the linear Hall sensor on the second multi-pole magnet 120. n1 N n2 ∈[1, n], where θ is measured twice. n The corresponding second magnetic pole region; θ x This represents the difference in installation angle between the starting points of a pair of magnetic poles in the two sets of magnets.
[0135] Subtracting the two equations in formula (7), we get:
[0136]
[0137] Since m and n are coprime, and N m1 -N m2 Since ∈[1, m-1], formula (8) is never true, that is, formula (7) is never true.
[0138] From formula (8), we can further obtain:
[0139]
[0140] Formula (9) for any distinct N m and its corresponding N n The following statements are incorrect. That is, for different magnetic pole pairs in the first multi-pole magnet 110 and the corresponding magnetic pole pairs in the second multi-pole magnet 120, formula (9) is not valid. It can be proven that when the linear Hall sensor on the first multi-pole magnet 110 measures the same single-cycle electrical angle value, the two single-cycle electrical angle values measured by the linear Hall sensor on the corresponding second multi-pole magnet 120 are different. In this way, the magnetic pole interval where the first electrical angle value is currently located can be distinguished by the positional relationship between the first multi-pole magnet 110 and the second multi-pole magnet 120.
[0141] By combining equations (3) and (5), we can obtain:
[0142]
[0143] As can be seen, the value on the right side of the expression is a single-cycle electrical angle value that does not contain the current sampling point. Its magnitude depends only on the magnetic pole interval numbers of the second multi-pole magnet 120 and the first multi-pole magnet 110, within the magnetic pole interval number group (N). m N n When the value is fixed, its value is a constant, which is the characteristic value of the mapped interval number group.
[0144] set up This is defined as the characteristic value of the magnetic pole position. As can be seen from formula (10), the characteristic value of the magnetic pole position remains unchanged when the number of pole pairs of the first multi-pole magnet 110 and the second multi-pole magnet 120 remains constant. When at least one of them changes, the characteristic value of the magnetic pole position will also change; otherwise, equation (9) holds, contradicting the premise that the number of pole pairs is coprime. Therefore, the magnetic pole range of the current electrical angle can be determined by calculating the characteristic value of the magnetic pole position.
[0145] When θ x When ≠0, meaning that the starting points of a certain pair of magnetic poles of the second multi-pole magnet 120 and the first multi-pole magnet 110 do not coincide, and cannot be made to coincide by changing the starting points of the coordinates, the characteristic value λ of the magnetic pole position has m+n different values. For example... Figure 13 As shown.
[0146] Figure 13 This diagram illustrates the number of magnetic pole position feature values in an embodiment of this application.
[0147] Figure 13 In the diagram, the first multi-pole magnet 110 has m pole pairs, where m is 5. Therefore, 5 boxes are used to represent the planar unfolded diagram of the 5 pairs of magnetic poles. The second multi-pole magnet 120 has n pole pairs, where n is 3. After unfolding it in planar shape, it is equivalent to introducing 3 vertical lines into the 5 boxes. Since θx≠0, a total of m+n+1 lines will be divided into m+n parts. That is, for encoders with 5 pairs of magnetic poles and encoders with 3 pairs of magnetic poles, there are 8 different values for the position feature value. Similarly, for encoders with 23 pairs of magnetic poles and encoders with 19 pairs of magnetic poles, there are 42 different values for the magnetic pole position feature value.
[0148] After the second pair of multiple pole magnets 120 and the first pair of multiple pole magnets 110 are installed, θ x The value of is already determined, so the m+n different values are fixed. Based on the number of pole pairs m of the first multi-pole magnet 110 and the number of pole pairs n of the second multi-pole magnet 120, as well as the first electrical angle value and the second electrical angle value, the characteristic values of the magnetic pole positions corresponding to the first multi-pole magnet 110 can be determined. Figure 12 Taking the multi-pole magneto-electric encoder structure shown as an example, θ x When the angle is 40° and the rotation direction of the magnet is clockwise, the characteristic values of the magnetic pole positions obtained by calibration and the corresponding magnetic pole intervals on the first multi-pole magnet 110 are shown in Table 2.
[0149] Table 2 shows the correspondence between λ values and the magnetic pole regions of the first multi-pole magnet.
[0150]
[0151] By using the correspondence between λ and magnetic pole intervals in Table 2, the magnetic pole position can be identified. That is, based on the magnetic pole position characteristic value, the first magnetic pole interval where the first electrical angle value is currently located can be calculated.
[0152] In step S440, the initial mechanical angle θ formed by the first multiple pole magnets 110 and the second multiple pole magnets 120 is determined based on the first magnetic pole interval, the number of pole pairs m of the first multiple pole magnets 110, and the first electrical angle value. _single .
[0153] After determining the first electrical angle value and the first magnetic pole range in which the electrical angle value is located, the initial mechanical angle formed by the first multi-pole magnet 110 and the second multi-pole magnet 120 can be obtained according to formula (3).
[0154] In step S450, the tooth count range in which the third electrical angle value is currently located is calibrated based on the initial mechanical angle.
[0155] Once the initial mechanical angle is obtained, it can be used to calibrate the tooth count range where the third electrical angle value of the single-pole magnetic conductor assembly 130 is currently located.
[0156] In this application, the tooth number interval N p The following correspondence exists between the initial mechanical angle and the initial mechanical angle:
[0157] N p =INT(θ) _single ×p / 360), N p ∈[0, p-1]
[0158] Therefore, an index table is established to correspond to the initial machine angle and the tooth count interval. The first column of the index table is the value of the initial machine angle, and the second column is the interval number of the tooth count interval corresponding to the initial machine angle. Since the initial machine angle is an absolute angle with a value range of [0°, 360°], the first row of the first column is the number 0, and the last row of the first column is the number 360.
[0159] For example, assuming the number of teeth P of the single-pole magnetic assembly 130 is 5, the initial mechanical angles and corresponding tooth number ranges obtained through calibration are shown in Table 3.
[0160] Table 3. Index of the Relationship between Initial Mechanical Angle and Tooth Number Range in Single-Pole Magnet Assembly
[0161] <![CDATA[Initial mechanical angle θ _single > Tooth count interval P 0 0 1 0 2 0 3 … … 3 358 3 359 4 360 4
[0162] Therefore, once the initial mechanical angle is determined, the range of tooth counts can be obtained by looking up the table. However, it is important to note that when creating the table, the row number of the column for the initial mechanical angle should be set to be much larger than the number of pole pairs (i.e., the number of teeth P) of the single-pole magnetic conductor assembly 130. This will significantly improve the accuracy of the magneto-electric encoder.
[0163] For example, in Table 3, the column for initial mechanical angle has 360 rows, while the number of teeth P of the single-pole magnetic assembly 130 is only 5, which is much greater than the requirement of the number of teeth P of the single-pole magnetic assembly 130.
[0164] Assuming the number of teeth P of the single-pole magnetic assembly 130 is 360, the number of rows in the column for the initial mechanical angle can be set to 360, meaning each degree of the initial mechanical angle corresponds to a range of teeth in the single-pole magnetic assembly 130. Similarly, the number of rows in the column for the initial mechanical angle can be set to 3600, so every 0.1 degree of the initial mechanical angle corresponds to a range of teeth in the single-pole magnetic assembly 130. This improves the accuracy of the magneto-electric encoder by 10 times. Correspondingly, the accuracy can also be improved by 20 times, 30 times, or even 100 times or more. This is the significance of having a number of rows much greater than the number of pole pairs.
[0165] In step S460, using the determined tooth count range, the number of pole pairs p of the single-pole magnetic conductor assembly 130 and the third electrical angle value are determined according to the following formula to obtain the absolute angle of the multi-pole magnetic encoder:
[0166] θ=N p ×360° / p+θ p / p
[0167] In the formula, θ is the absolute angle output by the multi-pole magneto-electric encoder, and N p The third electrical angle value θ p The current magnetic pole zone number, N p ∈[0, p-1].
[0168] Based on the above, it can be seen that the multi-pole magnetic encoder can output two levels of absolute angle precision, namely θ1 and θ2, where θ1 is the high-precision absolute angle θ determined by the first multi-pole magnet 110 and the second multi-pole magnet 120. _single At this time, θ1 = θ _singleθ2 is the ultra-high precision absolute angle θ determined by combining the obtained high-precision absolute angle θ1 with the single-pole magnetic conductor assembly 130. At this time, θ2 = θ. However, in the actual application of multi-pole magnetoelectric encoders combined with servo motors, the detection accuracy of multi-pole magnetoelectric encoders is limited by the maximum speed of the servo motor. For example, if the maximum speed allowed by the multi-pole magnetoelectric encoder is 8000 rpm, when the maximum speed of the servo motor is 6400 rpm, the multi-pole magnetoelectric encoder can maintain its ultra-high precision absolute angle output capability, that is, output θ2. When the maximum speed of the servo motor is greater than 9600 rpm, the electrical signal frequency of the multi-pole magnetoelectric encoder will not be able to follow the maximum speed of the servo motor, thus causing the output θ2 to fail.
[0169] Therefore, due to the limitation on the maximum speed of the servo motor, the absolute angle output by the multi-pole magneto-electric encoder will have the following angle switching output relationship between θ1 and θ2:
[0170]
[0171] In the formula, θ3 is the absolute angle of the final output of the multi-pole magneto-electric encoder;
[0172] ω is the current maximum speed of the servo motor;
[0173] ω0 is 0.8 times the maximum speed allowed by the ultra-high precision absolute angle output of a multi-pole magneto-electric encoder, that is: Where T represents the control cycle of the control command, and k represents the kth control cycle;
[0174] ω1 is 1.2 times the maximum speed allowed by the ultra-high precision absolute angle output of a multi-pole magnetic encoder, that is: Where T represents the control cycle of the control command, and k represents the kth control cycle;
[0175] Furthermore, in order to understand the aforementioned angle switching selection output relationship of absolute angles, this application also provides, for example... Figure 14 The linear diagram shown, combined with formula (11) and Figure 14 It can be known that:
[0176] When ω is less than or equal to ω0, the absolute angle θ3 = θ2 is finally output by the multi-pole magnetic encoder.
[0177] When ω is greater than ω0 and less than ω1 at the same time, the absolute angle θ3 of the final output of the multi-pole magnetic encoder will be combined with θ2 and θ1 to take values simultaneously.
[0178] When ω is greater than or equal to ω1, the absolute angle θ3 = θ1 is finally output by the multi-pole magnetic encoder.
[0179] Therefore, based on the above, the final absolute angle output by the multi-pole magneto-electric encoder can be obtained. Then, combined with the working principle of the servo system, precise control of the servo system can be achieved.
[0180] Figure 1 This diagram illustrates the structural block diagram of a high-precision closed-loop servo system according to an embodiment of this application.
[0181] like Figure 1 As shown, during operation, the high-precision closed-loop servo system uses multiple pairs of pole magneto-electric encoders to detect the rotation angle of the servo motor shaft, obtaining the angle or position of the motor shaft rotation. The current signal collected by the current sensor is transmitted to the control unit, which processes and calculates the output of six PWM signals to drive the IPM inverter circuit. The controller then outputs a three-phase voltage signal, i.e., a working command, to drive the servo motor. Upon receiving this working command, the servo driver outputs a drive signal matching the servo motor's load requirements. The servo motor, upon receiving this drive signal, drives the actuator to achieve precise control. In this example, the actuator can be any of the following: a lead screw, a guide rail, a reducer, a two-dimensional rotary table, or a CNC operating platform.
[0182] Figure 15 A flowchart of a high-precision closed-loop servo system control method in an embodiment of this application is shown.
[0183] like Figure 15 As shown, the control method for a high-precision closed-loop servo system includes:
[0184] S1: The current sensor collects the input current signal of the servo motor;
[0185] S2: A multi-pole magneto-electric encoder detects and outputs the angle information of the servo motor;
[0186] S3: The controller receives data, processes the data, and then outputs a voltage signal for the servo motor to operate.
[0187] S4: The servo driver receives the operating voltage signal from the servo controller and outputs the drive signal for the servo motor according to the load requirements of the servo motor.
[0188] S5: The servo motor receives drive signals and drives the actuator to move, achieving precise control of its motion state.
[0189] Figure 16 The first sub-flowchart of the high-precision closed-loop servo system control method in the embodiments of this application is shown.
[0190] like Figure 16 As shown, the multi-pole magnetic encoder detects and outputs the angle information S2 of the servo motor, including:
[0191] S21: Information on the rotating magnetic field generated by the magnet driven by the servo motor is collected through three sets of linear Hall elements;
[0192] S22: Signal amplification and conversion are performed through an amplifier and an A / D converter;
[0193] S23: Output the actual angle information of the servo motor rotation through table lookup and calculation program.
[0194] Figure 17 The second sub-flowchart of the high-precision closed-loop servo system control method in this application embodiment is shown.
[0195] like Figure 17 As shown, the controller receives data, processes the data, and outputs a voltage signal S3 for the servo motor, including:
[0196] S31: Receives the current signal detected by the current sensor, and outputs a digital current signal after A / D sampling;
[0197] S32: Receives and outputs the actual angle information of the servo motor rotation from the multi-pole magnetic encoder;
[0198] S33: Receives command signals from the host computer and rotation angle information of the servo motor shaft, calculates and outputs current commands;
[0199] S34: Receives current commands and digital current signals, calculates and outputs the duty cycle control signal of the three-phase voltage;
[0200] S35: Receives the three-phase voltage duty cycle control signal, generates a six-channel PWM signal, drives the IPM inverter circuit to work, and thus the controller outputs the working command to drive the servo motor.
[0201] Finally, it should be noted that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art can still modify the technical solutions described in the foregoing embodiments or make equivalent substitutions for some of the technical features. Any modifications, equivalent substitutions, improvements, etc., made within the spirit and principles of the present invention should be included within the protection scope of the present invention.
Claims
1. A high-precision closed-loop servo system, characterized in that: Including servo motors; A multi-pole magneto-electric encoder is coaxially mounted with the servo motor and outputs high-precision and / or ultra-high-precision absolute angles corresponding to the servo motor's speed range. The multi-pole magneto-electric encoder includes a second multi-pole magnet, a first multi-pole magnet, and a single-pole magnetic conductor assembly and a circuit board, all coaxially arranged. The first multi-pole magnet has m pairs of magnetic poles, where 3 ≤ m < 23; the second multi-pole magnet has n pairs of magnetic poles, where 3 ≤ n < 23; m is greater than n and is a coprime natural number; the single-pole magnetic conductor assembly includes a first annular magnetic conductor, which is coaxially and tightly fitted together. The circuit board comprises a single-pole annular magnet and a second annular magnetic conductor, wherein the outer ring diameters of the first and second annular magnetic conductors are larger than the outer ring diameter of the single-pole annular magnet. The first annular magnetic conductor has a first toothed portion on one axial end face, and the second annular magnetic conductor has a second toothed portion completely opposite to the first toothed portion. The first and second toothed portions form an annular opening region, wherein the opening direction of the opening region is consistent with the radial direction of the single-pole annular magnet, and P teeth are correspondingly formed on both the first and second toothed portions, where p ≥ 100. Furthermore, the circuit board includes: The first group of Hall elements, including a first linear Hall sensor and a second linear Hall sensor, is arranged adjacent to the first multiple pairs of pole magnets and outputs a first group of detection signals based on the magnetic pole signals of the first multiple pairs of pole magnets. The second group of Hall elements, including the third linear Hall sensor and the fourth linear Hall sensor, is arranged adjacent to the second multiple pairs of pole magnets and outputs the second group of detection signals according to the magnetic pole signals of the second multiple pairs of pole magnets. A magnetic weakening assembly includes a third magnetic conductor, a first single-pole magnet, and a fourth magnetic conductor that are coaxially and tightly fitted together. The magnetic weakening assembly is disposed between a first toothed portion and a second toothed portion, wherein the magnetic field direction of the first single-pole magnet is opposite to the magnetic field direction of the single-pole ring magnet. The third group of Hall elements includes a fifth linear Hall sensor, a sixth linear Hall sensor, and a seventh linear Hall sensor, and is disposed between the second toothed portion and the fourth magnetic conductor, and outputs a corrected third group of detection signals based on the magnetic pole signals of the single pair of magnetic conductor assembly. The servo controller includes a control unit and a current sensor. The control unit receives servo motor shaft angle information fed back by multiple pairs of pole magneto-electric encoders and receives current signals collected by the current sensor. After processing, the servo controller issues working commands to control the servo motor. The servo driver receives control commands from the servo controller and outputs drive signals for the servo motor according to the load requirements of the servo motor. The actuator is connected to the servo motor, and the servo motor drives the actuator to achieve precise control over its motion state.
2. The high-precision closed-loop servo system according to claim 1, characterized in that: The multi-pole magneto-electric encoder selects the absolute angle with high and / or ultra-high precision within the output servo motor speed range using the following formula: In the formula, θ3 is the final absolute angle output by the multi-pole magneto-electric encoder; θ1 is the high-precision absolute angle determined by the first and second multi-pole magnets; θ2 is the ultra-high-precision absolute angle determined by combining the obtained high-precision absolute angle θ1 with the single-pole magnet assembly; ω is the current speed of the servo motor; ω0 is 0.8 times the maximum speed allowed when the multi-pole magneto-electric encoder outputs the ultra-high-precision absolute angle; ω1 is 1.2 times the maximum speed allowed when the multi-pole magneto-electric encoder outputs the ultra-high-precision absolute angle; T represents the control cycle of the control command, and k represents the kth control cycle.
3. The high-precision closed-loop servo system according to claim 1, characterized in that: The servo motor is a permanent magnet synchronous servo motor.
4. The high-precision closed-loop servo system according to claim 1, characterized in that: m and n are prime numbers and mn < 23 × 19.
5. The high-precision closed-loop servo system according to claim 1, characterized in that: The first set of detection signals includes: a first detection signal and a second detection signal output by a first linear Hall sensor and a second linear Hall sensor based on the magnetic pole signals of the first multi-pair magnet; the first detection signal and the second detection signal are 90 degrees out of phase. The second set of detection signals includes: a third detection signal and a fourth detection signal output by a third linear Hall sensor and a fourth linear Hall sensor based on the magnetic pole signals of the second multi-pair magnet; the third detection signal and the fourth detection signal are 90 degrees out of phase.
6. The high-precision closed-loop servo system according to claim 1, characterized in that: The corrected third set of detection signals includes: d-axis and q-axis detection signals output by the fifth, sixth, and seventh linear Hall sensors based on the magnetic pole signals of the single-pair magnetic conductor assembly; wherein, after acquiring the magnetic pole signals of the single-pair magnetic conductor assembly, the fifth, sixth, and seventh linear Hall sensors obtain original three-phase Hall signals with a phase difference of 120 degrees, which are the fifth, sixth, and seventh detection signals; then, after zero-point drift processing of the obtained original three-phase Hall signals, d-axis and q-axis detection signals with a phase difference of 90 degrees are output.
7. The high-precision closed-loop servo system according to claim 1, characterized in that: The first linear Hall sensor, the third linear Hall sensor, and the fifth linear Hall sensor are aligned at one end.
8. The high-precision closed-loop servo system according to claim 1, characterized in that: The first multiple pairs of pole magnets are located between the single pair of pole conductors and the second multiple pairs of pole magnets, and there is an angular difference between the initial pole installation positions of the first multiple pairs of pole magnets and the second multiple pairs of pole magnets.
9. The high-precision closed-loop servo system according to claim 1, characterized in that: The magnetization directions of the first and second pairs of pole magnets are consistent with the radial or axial direction of the servo motor shaft; the magnetization direction of the single-pair magnetic conductor assembly is consistent with the radial or axial direction of the servo motor shaft.
10. The high-precision closed-loop servo system according to claim 1, characterized in that: The actuator can be any one of the following: lead screw, guide rail, reducer, two-dimensional rotary table, or CNC operating platform.
Citation Information
Patent Citations
Magnetic flux switching motor rotor angle detection method and system based on linear Hall
CN113258741A
Drive device for permanent-magnet synchronous machine, torque compensation method for permanent-magnet synchronous machine, and electric vehicle
CN113646204A
