An adaptive suppression system for periodic disturbances of rotors in magnetically suspended rotating joints

By designing a magnetic levitation rotor mode control unit, a translational disturbance adaptive suppression unit and a rotational disturbance adaptive suppression unit in a magnetic levitation rotary joint rotor system, suppression in the prior art is solved by using spectrum analysis and the characteristics of electromagnetic harmonic disturbance torque. The problem of insufficient accuracy has achieved efficient periodic disturbance suppression and control accuracy improvement of the magnetic levitation rotor.

CN115598969BActive Publication Date: 2024-11-29BEIJING INST OF CONTROL ENG
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202211288233.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-10-20
Publication Date
2024-11-29
Estimated Expiration
2042-10-20

AI Technical Summary

Technical Problem

The existing magnetic levitation rotor period disturbance suppression technology has problems such as insufficient suppression accuracy and slow tracking speed of high-frequency disturbances, especially the insufficient ability to suppress high-frequency period disturbances.

Method used

A system including a magnetic levitation rotor mode control unit, a translational disturbance adaptive suppression unit and a rotational disturbance adaptive suppression unit is designed. Through spectrum analysis, the disturbance torque is identified in real time and the frequency characteristics of the electromagnetic harmonic disturbance torque are used for adaptive control. , eliminate disturbed torque and improve control accuracy.

Benefits of technology

It realizes effective suppression of disturbing force of frequency in different periods, improves the suspension control accuracy and stability of the magnetic levitation rotor, and is suitable for self-identification and self-compensation of the motor magnetic field cycle unevenness, significantly improving the control accuracy of the servo system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115598969B_ABST
    Figure CN115598969B_ABST
Patent Text Reader

Abstract

A magnetic suspension rotary joint rotor periodic disturbance adaptive suppression system includes: a magnetic suspension rotor modal control unit, a translational disturbance adaptive suppression unit, a rotational disturbance adaptive suppression unit, and a periodic disturbance evaluation unit; the magnetic suspension rotor modal control unit is used to control the stable suspension of the magnetic suspension rotor. The periodic disturbance evaluation unit sends a command angular velocity to the rotary joint motor to control the magnetic suspension rotor to rotate at a fixed speed, and analyzes the frequency spectrum of the A and B ends of the magnetic suspension rotor as a reference for disturbance torque suppression. The translational / rotational disturbance adaptive suppression unit is added in parallel with the translational / rotational controller in the magnetic suspension rotor modal control unit to adaptively control the disturbance torque with harmonic order N in the translational / rotational mode. Eliminate the Nth harmonic disturbance amount. The present invention is suitable for self-identification and self-compensation of the periodic non-uniformity of the motor magnetic field, thereby suppressing the harmonic disturbance torque of the motor, which can greatly improve the control accuracy of the servo system.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a magnetic suspension rotating joint rotor periodic disturbance adaptive suppression system, which is suitable for adaptively suppressing the periodic disturbance of the magnetic suspension rotating joint rotor and can greatly improve the suspension control accuracy of the magnetic suspension rotor. Background Art

[0002] Compared with traditional mechanical bearing supports, magnetic bearing supports have the characteristics of no contact, no wear, low vibration, and active control. They have broad application prospects in aerospace precision electromechanical products such as magnetic levitation flywheels, magnetic levitation controlled torque gyroscopes, and magnetic levitation rotary joints.

[0003] High-precision voice coil motors are widely used in rotary joints, inertial actuators, pointing mechanisms, turntables, antennas, and other fields. The electromagnetic disturbance torque caused by the non-sinusoidal distortion of the permanent magnet of the voice coil motor and the uneven circumferential magnetic field has a normal disturbance force on the rotor, forming a periodic disturbance on the magnetic suspension rotor.

[0004] Existing magnetic levitation periodic disturbance forces are generally achieved using methods such as disturbance observers and repetitive control. The disturbance observer is not specific to a certain periodic frequency disturbance, and the observer has a slow tracking speed for high-frequency disturbances, resulting in insufficient ability to suppress high-frequency periodic disturbances. Although repetitive control specifically suppresses periodic frequency disturbances, its suppression accuracy is limited by the repetition step size and quality factor. Summary of the invention

[0005] The technical problem solved by the present invention is: to overcome the shortcomings of the prior art and provide a magnetic suspension rotating joint rotor periodic disturbance adaptive suppression system, which can identify the magnitude and direction of the disturbance force and disturbance torque in real time and provide reverse force and torque for offset, thereby improving the suspension control accuracy of the magnetic suspension rotor.

[0006] The technical solution adopted by the present invention is:

[0007] A magnetic suspension rotary joint rotor periodic disturbance adaptive suppression system, comprising: a magnetic suspension rotor modal control unit, a translation disturbance adaptive suppression unit, a rotation disturbance adaptive suppression unit, and a periodic disturbance evaluation unit;

[0008] The magnetic suspension rotor modal control unit includes a position sensor A, a position sensor B, a decentralized attitude quantity->modal attitude quantity conversion module, a translational mode controller, a rotational mode controller, a modal control quantity->decentralized control quantity conversion module, a power amplifier A, a current sensor A, a magnetic bearing A, a power amplifier B, a current sensor B, a magnetic bearing B and a magnetic suspension rotor;

[0009] The periodic disturbance evaluation unit sends a command angular velocity to the rotary joint motor to control the fixed speed rotation of the magnetic suspension rotor, and performs spectrum analysis on the positions of the A and B ends of the magnetic suspension rotor output by the position sensor A and the position sensor B. The disturbance harmonic order N obtained by the spectrum analysis is transmitted to the translational disturbance adaptive suppression unit and the rotational disturbance adaptive suppression unit as a reference for disturbance torque suppression.

[0010] The translation disturbance adaptive suppression unit is added in parallel with the translation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the translation mode to eliminate the Nth harmonic disturbance.

[0011] The rotation disturbance adaptive suppression unit is added in parallel with the rotation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the rotation mode to eliminate the Nth harmonic disturbance.

[0012] Furthermore, in the modal control unit of the magnetic levitation rotor, position sensor A detects the position S_a of the rotor A end, and position sensor B detects the position S_b of the rotor B end, and sends them to the decentralized attitude quantity -> modal attitude quantity conversion module to obtain the translation attitude quantity S_tran and the rotation attitude quantity S_rotate, and sends the translation attitude quantity S_tran to the translation modal controller to obtain the translation control quantity CTR_tran, and sends the rotation attitude quantity S_rotate to the rotation modal controller to obtain the rotation control quantity CTR_rotate, and sends S_rotate and CTR_rotate to the modal control quantity -> decentralized control quantity conversion module to obtain the A end current control quantity and the B end current control quantity, and after passing through the A end power amplifier and the B end power amplifier respectively, the A end winding voltage control quantity and the B end winding voltage control quantity are obtained, which are applied to the magnetic bearing A and the magnetic bearing B respectively to form the A and B end magnetic bearing winding control currents, provide electromagnetic force, and control the magnetic levitation rotor to suspend at the target position.

[0013] Furthermore, assuming that the periodic disturbance evaluation unit sends a control command angular velocity Vel_zl to the rotary joint motor, after spectrum analysis, the disturbance harmonic frequency

[0014]

[0015] Among them, f N is the frequency of the main spectral component, and according to f N The magnitude of the spectrum amplitude at is used to evaluate the magnitude of the harmonic disturbance.

[0016] Furthermore, the disturbance torque with harmonic order N in the translational mode of the translational disturbance adaptive suppression unit is adaptively controlled, specifically:

[0017] The angular position θ measured by the servo control unit is introduced into the translation disturbance adaptive suppression unit;

[0018] Multiply by the disturbance harmonic order N to get Nθ;

[0019] Then perform sine and cosine transform on Nθ to obtain sin(Nθ) and cos(Nθ);

[0020] Phase shift of sin(Nθ) and cos(Nθ) deal with;

[0021] Multiply by the translation attitude quantity S_tran and the gain coefficient A_tran;

[0022] Then perform integration operations respectively;

[0023] The result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) respectively and then added to obtain the adaptive suppression amount of translation disturbance;

[0024] After being added to the translational control quantity CTR_tran, it is sent to the modal control quantity -> distributed control quantity conversion module of the magnetic levitation rotor modal control unit.

[0025] Furthermore, the phase shift of sin(Nθ) and cos(Nθ) is performed. Process, get and Multiply by the translation attitude quantity S_tran and the gain coefficient A_tran, and we get and

[0026] Further, we can get

[0027]

[0028]

[0029] Furthermore, the integration result is multiplied by sin(Nθ) and cos(Nθ) and then added to obtain the adaptive suppression of translation disturbance:

[0030]

[0031] Furthermore, the rotation disturbance adaptive suppression unit performs adaptive control on the disturbance torque with harmonic order N in the rotation mode, specifically:

[0032] The angular position θ measured by the servo control unit is introduced into the rotation disturbance adaptive suppression unit;

[0033] Multiply by the disturbance harmonic order N to get Nθ;

[0034] Then perform sine and cosine transform on Nθ to obtain sin(Nθ) and cos(Nθ);

[0035] Phase shift of sin(Nθ) and cos(Nθ) Process, get and

[0036] Multiply by the rotation attitude S_rotate and the gain coefficient A_rotate;

[0037] Then perform integration operations respectively;

[0038] The result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) respectively and then added to obtain the adaptive suppression amount of translation disturbance;

[0039] After being added to the rotation control quantity CTR_rotate, it is sent to the modal control quantity of the magnetic levitation rotor modal control unit to the distributed control quantity conversion module.

[0040] Further, multiplying the rotation attitude S_rotate and the gain coefficient A_rotate, we get and Perform the integral operation to obtain and

[0041] Furthermore, the result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) and then added to obtain the adaptive suppression of translational disturbance:

[0042]

[0043] The beneficial effects of the present invention compared with the prior art are:

[0044] (1) The present invention utilizes the frequency characteristics of the electromagnetic harmonic disturbance torque itself (the harmonic frequency of the frequency conversion) to perform periodic adaptive control, which can adapt to the situation of disturbance changes.

[0045] (2) The present invention uses a modal control method to perform decoupling control on the translational mode and the rotational mode, and can design adaptive controllers for the translational disturbance force and the rotational disturbance torque respectively, thereby improving control accuracy and stability.

[0046] (3) The present invention can suppress disturbance forces / torques of different periodic frequencies without affecting the stability of the original system.

[0047] (4) The present invention is suitable for self-identification and self-compensation of the periodic non-uniformity of the motor magnetic field, thereby suppressing the motor harmonic disturbance torque, which can greatly improve the control accuracy of the servo system. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] Figure 1 The block diagram for adaptive suppression of periodic disturbances of the rotor of the magnetically suspended rotary joint;

[0049] Figure 2 This is the block diagram of the adaptive suppressor of translational disturbance;

[0050] Figure 3 The block diagram of the rotation disturbance adaptive suppressor is shown in FIG. DETAILED DESCRIPTION

[0051] The present invention is described in detail below with reference to the accompanying drawings.

[0052] like Figure 1 As shown, the present invention discloses a magnetic suspension rotary joint rotor period disturbance adaptive suppression system, comprising four units:

[0053] (1) Magnetic suspension rotor modal control unit

[0054] The magnetic levitation rotor modal control unit performs modal conversion on the rotor positions detected by position sensor A and position sensor B to obtain the rotor modal attitude quantity, performs rotational modal and translational modal control respectively, and then converts them into each power amplifier control quantity to provide control current to the magnetic bearing and control the rotor to return to the target position.

[0055] (2) Periodic disturbance evaluation unit

[0056] The periodic disturbance evaluation unit sends a command angular velocity to the rotary joint motor to control the magnetic suspension rotor to rotate at a fixed speed, and performs spectrum analysis on the positions of the A and B ends of the magnetic suspension rotor output by the position sensor A and the position sensor B. The disturbance harmonic order N obtained by the spectrum analysis is transmitted to the translational disturbance adaptive suppressor and the rotational disturbance adaptive suppressor as a reference for disturbance torque suppression.

[0057] (3) Translational disturbance adaptive suppression unit

[0058] The translation disturbance adaptive suppression unit is added in parallel with the translation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the translation mode to eliminate the Nth harmonic disturbance.

[0059] (4) Rotational disturbance adaptive suppression unit

[0060] The rotation disturbance adaptive suppression unit is added in parallel with the rotation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the rotation mode to eliminate the Nth harmonic disturbance.

[0061] 1. Magnetic suspension rotor modal control unit

[0062] like Figure 1As shown, the magnetic levitation rotor modal control unit includes a position sensor A, a position sensor B, a decentralized attitude quantity -> modal attitude quantity conversion module, a translational mode controller, a rotational mode controller, a modal control quantity -> decentralized control quantity conversion module, a power amplifier A, a current sensor A, a magnetic bearing A, a power amplifier B, a current sensor B, a magnetic bearing B, and a magnetic levitation rotor. Position sensor A detects the position S_a of the rotor A end, and position sensor B detects the position S_b of the rotor B end, and sends them to the decentralized attitude quantity -> modal attitude quantity conversion module to obtain the translation attitude quantity S_tran and the rotation attitude quantity S_rotate. The translation attitude quantity S_tran is sent to the translation controller to obtain the translation control quantity CTR_tran, and the rotation attitude quantity S_rotate is sent to the rotation controller to obtain the rotation control quantity CTR_rotate. S_rotate and CTR_rotate are sent to the modal control quantity -> decentralized control quantity conversion module to obtain the A-end current control quantity and the B-end current control quantity. After passing through the A-end power amplifier and the B-end power amplifier, the A-end winding voltage control quantity and the B-end winding voltage control quantity are obtained, which are applied to the A-end magnetic bearing and the B-end magnetic bearing to form the A-end and B-end magnetic bearing winding control currents, provide electromagnetic force, and control the magnetic suspension rotor to suspend at the target position.

[0063] 2. Periodic disturbance torque evaluation unit

[0064] The periodic disturbance evaluation unit sends a control command angular velocity Vel_zl to the rotary joint motor to control the load to rotate at a constant speed, and performs spectrum analysis on the positions of the A and B ends of the magnetic suspension rotor output by the position sensor A and the position sensor B. According to the frequency f of the main spectrum components, N Calculate the harmonic order of disturbance And according to f N The magnitude of the spectrum amplitude at is used to evaluate the magnitude of the harmonic disturbance. At the same time, the disturbance harmonic order N is sent to the translation disturbance adaptive suppression unit and the rotation disturbance adaptive suppression unit for corresponding processing.

[0065] 3. Translational disturbance adaptive suppression unit

[0066] like Figure 2 As shown, the translation disturbance adaptive suppression unit introduces the angular position θ measured by the servo control unit into the translation disturbance adaptive suppression unit, multiplies it by the disturbance harmonic order N to obtain Nθ, then performs sine-cosine transformation on Nθ to obtain sin(Nθ) and cos(Nθ), and performs phase shift on sin(Nθ) and cos(Nθ) Process, get and Multiply by the translation attitude quantity S_tran and the gain coefficient A_tran, and we get and Then perform integration operations to obtain and Will and After multiplying and adding with sin(Nθ) and cos(Nθ) respectively, the adaptive suppression of translation disturbance is obtained:

[0067] After being added to the translational control quantity CTR_tran, it is sent to the modal control quantity -> distributed control quantity conversion module of the magnetic levitation rotor modal control unit.

[0068] 4. Rotational disturbance adaptive suppression unit

[0069] like Figure 3 As shown, the rotation disturbance adaptive suppression unit introduces the angular position θ measured by the servo control unit into the rotation disturbance adaptive suppression unit, multiplies it by the disturbance harmonic order N, obtains Nθ, then performs sine-cosine transformation on Nθ to obtain sin(Nθ) and cos(Nθ), and performs phase shift on sin(Nθ) and cos(Nθ) Process, get and Multiply the rotation attitude S_rotate and the gain coefficient A_rotate to get and Then perform integration operations to obtain and Will and Multiplying with sin(Nθ) and cos(Nθ) and adding them together, we get the adaptive suppression of translation disturbance:

[0070]

[0071] After being added to the rotation control quantity CTR_rotate, it is sent to the modal control quantity -> distributed control quantity conversion module of the magnetic levitation rotor modal control unit.

[0072] The present invention is suitable for self-identification and self-compensation of the periodic non-uniformity of the motor magnetic field, thereby suppressing the motor harmonic disturbance torque, and can greatly improve the control accuracy of the servo system.

[0073] Although the present invention has been disclosed as above in the form of a preferred embodiment, it is not intended to limit the present invention. Any person skilled in the art may make possible changes and modifications to the technical solution of the present invention by using the methods and technical contents disclosed above without departing from the spirit and scope of the present invention. Therefore, any simple modifications, equivalent changes and modifications made to the above embodiments based on the technical essence of the present invention without departing from the content of the technical solution of the present invention shall fall within the protection scope of the technical solution of the present invention.

Claims

1. A magnetically suspended rotary joint rotor periodic disturbance adaptive suppression system, characterized in that: include: Magnetic suspension rotor modal control unit, translational disturbance adaptive suppression unit, rotational disturbance adaptive suppression unit, periodic disturbance evaluation unit; The magnetic suspension rotor modal control unit performs modal conversion on the rotor positions detected by position sensor A and position sensor B to obtain the rotor modal attitude quantity, performs rotational modal control and translational modal control respectively, and then converts them into various control quantities to provide control current to the magnetic bearing to control the rotor to return to the target position; The periodic disturbance evaluation unit sends a command angular velocity to the rotary joint motor to control the magnetic suspension rotor to rotate at a fixed speed, and performs spectrum analysis on the positions of the A and B ends of the magnetic suspension rotor output by the position sensor A and the position sensor B. The disturbance harmonic order N obtained by the spectrum analysis is transmitted to the translation disturbance adaptive suppression unit and the rotation disturbance adaptive suppression unit as a reference for disturbance torque suppression; The translation disturbance adaptive suppression unit is added in parallel with the translation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the translation mode to eliminate the Nth harmonic disturbance. The rotation disturbance adaptive suppression unit is added in parallel with the rotation controller in the magnetic suspension rotor modal control unit, and adaptively controls the disturbance torque with harmonic order N in the rotation mode to eliminate the Nth harmonic disturbance.

2. According to claim 1, a magnetic suspension rotary joint rotor period disturbance adaptive suppression system is characterized by: The magnetic suspension rotor modal control unit includes a position sensor A, a position sensor B, a decentralized attitude quantity->modal attitude quantity conversion module, a translational mode controller, a rotational mode controller, a modal control quantity->decentralized control quantity conversion module, a power amplifier A, a current sensor A, a magnetic bearing A, a power amplifier B, a current sensor B, a magnetic bearing B and a magnetic suspension rotor; Position sensor A detects the position S_a of the rotor A end, and position sensor B detects the position S_b of the rotor B end, and sends them to the decentralized attitude quantity -> modal attitude quantity conversion module to obtain the translation attitude quantity S_tran and the rotation attitude quantity S_rotate. The translation attitude quantity S_tran is sent to the translation modal controller to obtain the translation control quantity CTR_tran, and the rotation attitude quantity S_rotate is sent to the rotation modal controller to obtain the rotation control quantity CTR_rotate. S_rotate and CTR_rotate are sent to the modal control quantity -> decentralized control quantity conversion module to obtain the A end current control quantity and the B end current control quantity. After passing through the A end power amplifier and the B end power amplifier respectively, the A end winding voltage control quantity and the B end winding voltage control quantity are obtained, which are applied to the magnetic bearing A and the magnetic bearing B respectively to form the A and B end magnetic bearing winding control currents, provide electromagnetic force, and control the magnetic suspension rotor to suspend at the target position.

3. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 2 is characterized by: Assuming that the periodic disturbance evaluation unit sends a control command angular velocity Vel_zl to the rotary joint motor, after spectrum analysis, the disturbance harmonic frequency is Among them, f N is the frequency of the main spectral component, and according to f N The magnitude of the spectrum amplitude at is used to evaluate the magnitude of the harmonic disturbance.

4. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 3 is characterized by: The adaptive control of the disturbance torque with harmonic order N in the translation mode of the translation disturbance adaptive suppression unit is carried out as follows: The angular position θ measured by the servo control unit is introduced into the translation disturbance adaptive suppression unit; Multiply by the disturbance harmonic order N to get Nθ; Then perform sine and cosine transform on Nθ to obtain sin(Nθ) and cos(Nθ); Phase shift of sin(Nθ) and cos(Nθ) deal with; Multiply by the translation attitude quantity S_tran and the gain coefficient A_tran; Then perform integration operations respectively; The result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) respectively and then added to obtain the adaptive suppression amount of translation disturbance; After being added to the translational control quantity CTR_tran, it is sent to the modal control quantity -> distributed control quantity conversion module of the magnetic levitation rotor modal control unit.

5. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 4 is characterized by: Phase shift of sin(Nθ) and cos(Nθ) Process, get and Multiply by the translation attitude quantity S_tran and the gain coefficient A_tran, and we get and 6. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 5 is characterized by: Perform the integral operation to obtain 7. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 6 is characterized by: The adaptive suppression of translation disturbance is obtained by multiplying the integral result with sin(Nθ) and cos(Nθ) and adding them together:

8. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 3 is characterized by: The rotation disturbance adaptive suppression unit performs adaptive control on the disturbance torque with harmonic order N in the rotation mode, specifically: The angular position θ measured by the servo control unit is introduced into the rotation disturbance adaptive suppression unit; Multiply by the disturbance harmonic order N to get Nθ; Then perform sine and cosine transform on Nθ to obtain sin(Nθ) and cos(Nθ); Phase shift of sin(Nθ) and cos(Nθ) Process, get and Multiply by the rotation attitude S_rotate and the gain coefficient A_rotate; Then perform integration operations respectively; The result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) respectively and then added to obtain the adaptive suppression amount of translation disturbance; After being added to the rotation control quantity CTR_rotate, it is sent to the modal control quantity of the magnetic levitation rotor modal control unit to the distributed control quantity conversion module.

9. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 8 is characterized by: Multiply the rotation attitude S_rotate and the gain coefficient A_rotate to get and Perform the integral operation to obtain and 10. The magnetic suspension rotary joint rotor period disturbance adaptive suppression system according to claim 9, characterized in that: The result of the integral operation is multiplied by sin(Nθ) and cos(Nθ) respectively and then added to obtain the adaptive suppression of translation disturbance:

Citation Information

Patent Citations

  • Satellite single-axis measurement and control integrated method based on magnetic levitation control sensitive gyroscope

    CN104777842A

  • Magnetic suspension rotor harmonic current inhibition method of digital controller based on DPSORC

    CN106896726A