CN102009597A - Magnetically suspended control moment gyro gimbal and locking control system - Google Patents
Magnetically suspended control moment gyro gimbal and locking control system Download PDFInfo
- Publication number
- CN102009597A CN102009597A CN 201010535251 CN201010535251A CN102009597A CN 102009597 A CN102009597 A CN 102009597A CN 201010535251 CN201010535251 CN 201010535251 CN 201010535251 A CN201010535251 A CN 201010535251A CN 102009597 A CN102009597 A CN 102009597A
- Authority
- CN
- China
- Prior art keywords
- locking
- motor
- controller
- circuit
- output
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Abstract
The invention discloses a magnetically suspended control moment gyro gimbal and a locking control system. The magnetically suspended control moment gyro gimbal mainly comprises a gimbal moment motor, a locking mechanism, an ultrasonic motor, a locking sensor circuit and a digital signal processor (DSP) and field programmable gate array (FPGA) numerical control device, wherein the DSP and FPGA numerical control device comprises a controller area network (CAN) communication circuit, a command parser, a gimbal controller, a locking/unlocking controller, a gimbal motor power drive circuit, an ultrasonic motor power drive circuit and a gimbal motor sensor circuit; the gimbal controller performs the control of three closed loops and two feed forward according to an angle position, an angle speed, a current command value output by the CAN communication circuit and the command parser and a feedback value output by the gimbal motor sensor circuit to realize high precision and rapid response control of the gimbal moment motor; and the locking/unlocking controller selects the resonance frequency of the ultrasonic motor according to the temperature and an axial displacement value output by the locking sensor circuit and positively and negatively rotates the ultrasonic motor respectively according to locking and unlocking commands so as to lock or unlock the locking mechanism.
Description
Technical field
The present invention relates to a kind of magnetic levitation control moment gyroscope frame and locking control system, be used for the locking of high precision, fast-response control and magnetic suspension control torque gyroscope and separate lock control, be specially adapted to require the accurate Spacecraft Control actuating unit of high control accuracy, fast-response speed, high reliability the magnetic levitation control moment gyroscope frame torque motor.
Background technology
Control moment gyroscope (CMG) is the crucial actuating unit of Large Spacecraft attitude maneuvers such as large-scale satellite, space station.CMG is made up of high-speed rotor system and framework torque motor system, according to the difference of high speed rotor support pattern, divides mechanical CMG and magnetic suspension CMG.Magnetic suspension CMG adopts maglev bearing support pattern to avoid mechanical bearing itself because the wearing and tearing that friction brings with respect to the mechanical control moment gyro of mechanical ball bearing of main shaft supporting, therefore have advantages such as long life, high rotating speed, big moment output, on Large Spacecraft, have broad application prospects.
The application principle of magnetic suspension CMG is that the high-speed magnetic levitation rotor provides moment of momentum, and the framework torque motor rotates to change the moment of momentum direction of magnetic suspension rotor, makes the CMG output torque adjust spacecraft attitude.The angle position control accuracy and the cireular frequency control accuracy of framework torque motor are high more, the direction and the size of magnetic suspension CMG output torque are accurate more, and the response of framework torque motor is fast more, and the speed of response of magnetic suspension CMG output torque is also fast more, thereby the spacecraft attitude controllable velocity is also fast more.Therefore the high precision of position, framework torque motor angle and cireular frequency, fast-response control are its gordian techniquies that must break through.Existing framework torque motor mode is divided into three ring controls and two kinds of modes of two ring controls, two ring modes are cireular frequency ring and electric current loop, owing to there is not the angle position ring, be difficult to the accuracy control of position, implementation framework torque motor angle, thereby can't realize the High Accuracy Control of magnetic suspension CMG output torque direction; Three traditional ring mode speed of response are very slow, can't realize the fast reserve ability of spacecraft, and therefore traditional framework torque motor mode can't satisfy the high precision of position, angle, cireular frequency, the unification of fast-response control.The latching device of magnetic suspension CMG can protect magnetic suspension rotor not by high vibration in the rocket launching process and impact failure; the frictional transmission mechanism of supersonic motor can realize cutting off self-lock tightly; supersonic motor need not powered in the rocket launching process; improved the reliability of system; the latching device of very suitable magnetic suspension CMG; but a large amount of heats that the frictional transmission of supersonic motor produces make the resonance mode of supersonic motor be offset; especially in vacuum environment; heat can't be by distributing streamed; the suffered axle pressure of supersonic motor also can make its resonance mode be offset when locking simultaneously; influenced the normal operation of supersonic motor, thereby even stall can't finish the locking of latching device; release.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the not enough of existing magnetic levitation control moment gyroscope frame control technology and supersonic motor control technology and for magnetic suspension rotor provides protection, a kind of high precision, fast-response, highly reliable magnetic levitation control moment gyroscope frame and locking control system are provided.
Technical solution of the present invention is: a kind of magnetic levitation control moment gyroscope frame and locking control system, it is characterized in that: comprise framework torque motor, catch gear, supersonic motor, lock sensor circuit, DSP+FPGA numerical control device, wherein the DSP+FPGA numerical control device comprises CAN communicating circuit, instruction parser, framework controller, locks and separate lock controller, frame motor power driving circuit, supersonic motor power driving circuit, frame motor sensor circuit; The frame motor sensor circuit comprises rotating transformer exciting and shaft angle decoding circuit, magslip, current sensor, A/D sample circuit; The framework controller comprises angle position ring controller, cireular frequency ring controller and current loop controller.Spaceborne computer is separated query statement and the locking that lock controller transmits given instruction in position, angle and catch gear state by the CAN communicating circuit to framework controller and locking, unlock command, position, angle given instruction input instruction resolver obtains cireular frequency feedforward instruction and current feed-forward instruction, rotating transformer exciting and shaft angle decoding circuit provide excitation power supply for magslip, framework torque motor driven rotary voltage transformer rotates together, magslip is exported four tunnel analog voltage signals relevant with position, framework torque motor angle to rotating transformer exciting and shaft angle decoding circuit, rotating transformer exciting and shaft angle decoding circuit carry out the shaft angle decoding to four tunnel analog voltage signals relevant with position, framework torque motor angle, the digital signal of position, output framework torque motor angle and the analog signal of cireular frequency, the phase current analog signal of current sensor output framework torque motor, the analog signal of cireular frequency and the analog signal of phase current convert the digital signal of cireular frequency and the digital signal of phase current to by the A/D sample circuit, given subtracting each other with the digital signal position, angle inputs to the angle position ring controller and controls computing the position, angle, the digital signal of the output signal of angle position ring controller and cireular frequency feedforward instruction sum and cireular frequency is subtracted each other and is inputed to the cireular frequency ring controller and control computing, the digital signal of the output signal of cireular frequency ring controller and current feed-forward instruction sum and phase current is subtracted each other and is inputed to current loop controller and control computing, the controlling quantity of current loop controller output is the dutyfactor value of pwm pulse, current loop controller output pwm pulse is to the frame motor power driving circuit, and the frame motor power driving circuit amplifies pwm pulse, be reverse into ac voltage signal and drive the rotation of framework torque motor.The lock sensor circuit detects output catch gear state to catch gear and supersonic motor, temperature, lock controller is separated in the voltage signal of longitudinal travel to locking, locking is separated lock controller output catch gear state to the CAN communicating circuit, and according to temperature, longitudinal travel is determined the resonance mode of supersonic motor, the locking of lock controller to the input of CAN communicating circuit is separated in locking, unlock command is judged, if be the locking instruction, square voltage pulse to the supersonic motor driving circuit of then exporting two-way phase difference 90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference 90 degree, drive the supersonic motor forward rotation, thereby finish the locking of catch gear; If be unlock command, square voltage pulse to the supersonic motor driving circuit of then exporting two-way phase difference-90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference-90 degree, drive the supersonic motor backward rotation, thereby finish the release of catch gear.
In addition, described DSP+FPGA numerical control device links to each other with spaceborne computer by the CAN communicating circuit, given arbitrarily, the cireular frequency control accuracy that can carry out position, magnetic suspension control-moment gyro frame servo system angle or cireular frequency and degree of stability test, controlled variable modification, control bandwidth test, critical data realtime graphic demonstration and data storage, lock and separate functions such as lock control, working state of system inquiry, trouble diagnosing and system reset.
Principle of the present invention is: spaceborne computer is separated lock controller transmission given instruction in position, angle and locking by the CAN communicating circuit to framework controller and locking, unlock command, instruction parses cireular frequency feedforward instruction and current feed-forward instruction to instruction parser according to the angle position control, the angle position feed back signal and the cireular frequency feedback signal of rotating transformer exciting and shaft angle decoding circuit output framework torque motor rotor, the phase current feedback signal of current sensor output framework torque motor, the angle position ring controller is carried out closed loop control according to given instruction in position, angle and angle position feed back signal, its output controlling quantity and cireular frequency feedforward instruction sum are as the given value of cireular frequency ring controller, the cireular frequency ring controller carries out closed loop control according to the given value and the cireular frequency feedback signal of cireular frequency ring, its output controlling quantity and current feed-forward instruction sum are as the given value of current loop controller, current loop controller is the PWM dutycycle according to the controlling quantity that its given value and phase current feedback signal carry out closed loop control output, framework controller output pwm pulse, the frame motor power driving circuit amplifies pwm pulse, be reverse into ac voltage signal and drive the rotation of framework torque motor, because position, angle, cireular frequency, the application of electric current three closed loops, improved the control accuracy of position, magnetic levitation control moment gyroscope frame angle and cireular frequency, and cireular frequency, the speed of response of framework torque motor has been accelerated in the application of current feed-forward; Temperature and the longitudinal travel value that lock controller detects supersonic motor separated in locking, because longitudinal travel has reflected the axial pre tightening force of supersonic motor, and temperature and axial pre tightening force influence the resonance mode of supersonic motor, relation according to supersonic motor temperature and longitudinal travel value and resonance mode, the resonant frequency of employing supersonic motor under this temperature and longitudinal travel, can make the supersonic motor cal val still less, move more steady, thereby improved the reliability of catch gear, locking is separated this frequency square-wave voltage signal of lock controller output two-way and is zoomed into the rotation of sinusoidal high-voltage signal driving supersonic motor through the supersonic motor driving circuit, detect the residing state of micro-switch simultaneously, until the locking of finishing catch gear or release.
The present invention's advantage compared with prior art is:
(1) angle of the present invention position ring, cireular frequency ring, electric current loop three closed loop controlling structures have guaranteed the angle location positioning precision and the cireular frequency control accuracy of framework Fu effectively, thereby guaranteed the high precision of magnetic suspension control torque gyroscope output torque direction and size, the given instruction of diagonal position is simultaneously resolved, for cireular frequency ring controller and current loop controller provide cireular frequency feedforward and current feed-forward respectively, accelerate the speed of response of framework control system, accelerated the speed of magnetic suspension control torque gyroscope output torque; The unification that has realized that High Accuracy Control and fast-response are controlled that is used in combination of angle position ring, cireular frequency ring, electric current loop three closed loop controls and cireular frequency, electric current two feedforwards.
(2) spaceborne computer can obtain the state of catch gear and send locking according to demand by the CAN communicating circuit; unlock command; the supersonic motor driving circuit drives supersonic motor and rotates the locking of finishing catch gear; release; vibration and the impact of having protected magnetic suspension control torque gyroscope to be subjected to effectively in the rocket launching stage; improved the reliability of magnetic suspension control torque gyroscope; simultaneously supersonic motor is carried out temperature and longitudinal travel detection and adopts cooresponding resonant frequency value; make that the supersonic motor serviceability is more stable, improved the reliability of catch gear.
(3) only use the control of having finished magnetic levitation control moment gyroscope frame system and fastening system once cover DSP+FPGA numerical control device, framework and the shared dsp chip of locking control system, fpga chip, communicating circuit, power circuit, simplified the communication between fastening system, frame system and the spaceborne computer three, helped reducing volume, weight, the power consumption of circuit card and increase reliability.
Description of drawings
Fig. 1 is a structure composition frame chart of the present invention;
Fig. 2 is dsp chip of the present invention, fpga chip circuit diagram;
Fig. 3 is a framework controller diagram of circuit of the present invention;
Fig. 4 is CAN communicating circuit figure of the present invention;
Fig. 5 instruction parser of the present invention inside is formed and is connected block diagram;
Fig. 6 is rotating transformer exciting of the present invention and shaft angle decoding circuit figure;
Fig. 7 is frame motor power driving circuit figure of the present invention;
Fig. 8 is current sensor circuit figure of the present invention;
Fig. 9 separates the lock controller diagram of circuit for locking of the present invention;
Figure 10 is supersonic motor power driving circuit figure of the present invention;
Figure 11 is temperature of the present invention and shaft position sensor circuit diagram;
Figure 12 is a catch gear scheme drawing of the present invention.
The specific embodiment
As shown in Figure 1, the present invention includes framework torque motor 12, supersonic motor 13, catch gear 10, lock sensor circuit 11, DSP+FPGA numerical control device 17, wherein DSP+FPGA numerical control device 17 comprises CAN communicating circuit 2, instruction parser 3, framework controller 9, locks and separate lock controller 16, frame motor power driving circuit 14, supersonic motor power driving circuit 15, frame motor sensor circuit 5; Frame motor sensor circuit 5 comprises rotating transformer exciting and shaft angle decoding circuit 6, magslip 8, current sensor 7, A/D sample circuit 4; Framework controller 9 comprises angle position ring controller 91, cireular frequency ring controller 92 and current loop controller 93.Spaceborne computer 1 is separated lock controller 16 transmission given instruction in position, angle and lockings by CAN communicating circuit 2 to framework controller 9 and locking, unlock command, position, angle given instruction input instruction resolver 3 obtains cireular frequency feedforward instruction and current feed-forward instruction, rotating transformer exciting and shaft angle decoding circuit 6 provide excitation power supply for magslip 8, framework torque motor 12 driven rotary voltage transformers 8 rotate together, magslip 8 output four tunnel analog voltage signal relevant with 12 jiaos of positions of framework torque motor is to rotating transformer exciting and shaft angle decoding circuit 6,6 pairs four tunnel analog voltage signals relevant with 12 jiaos of positions of framework torque motor of rotating transformer exciting and shaft angle decoding circuit carry out the shaft angle decoding, the digital signal of 12 jiaos of positions of output framework torque motor and the analog signal of cireular frequency, the phase current analog signal of current sensor 7 output framework torque motors 12, the analog signal of cireular frequency and the analog signal of phase current convert the digital signal of cireular frequency and the digital signal of phase current to by A/D sample circuit 4, given subtracting each other with the digital signal position, angle inputs to the angle position ring controller and carries out the proportional integral (PI) computing position, angle, the digital signal of the output signal of angle position ring controller and cireular frequency feedforward instruction sum and cireular frequency is subtracted each other and is inputed to the cireular frequency ring controller and carry out pid calculation, the digital signal of the output signal of cireular frequency ring controller and current feed-forward instruction sum and phase current is subtracted each other and is inputed to current loop controller and carry out scale operation, the controlling quantity of current loop controller output is the dutyfactor value of pwm pulse, current loop controller output pwm pulse is to frame motor power driving circuit 14, and 14 pairs of pwm pulses of frame motor power driving circuit amplify, be reverse into ac voltage signal and drive 12 rotations of framework torque motor.11 pairs of catch gears 10 of lock sensor circuit and supersonic motor 13 detect output catch gear state, temperature, lock controller 16 is separated in the voltage signal of longitudinal travel to locking, locking is separated lock controller 16 output catch gear states to CAN communicating circuit 2, and according to temperature, longitudinal travel is determined the resonance mode of supersonic motor 13, the locking of 16 pairs of CAN communicating circuits of lock controller, 2 inputs is separated in locking, unlock command is judged, if be the locking instruction, square voltage pulse to the supersonic motor driving circuit 15 of then exporting two-way phase difference 90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference 90 degree, drive supersonic motor 13 forward rotation, thereby finish the locking of catch gear 10; If be unlock command, square voltage pulse to the supersonic motor driving circuit 15 of then exporting two-way phase difference-90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference-90 degree, drive supersonic motor 13 backward rotation, thereby finish the release of catch gear 10.
Fig. 2 is dsp chip of the present invention, fpga chip circuit diagram, is the major control chip of DSP+FPGA numerical control device 17, finishes operations such as the control of DSP+FPGA numerical control device 17 and detections.Wherein dsp chip adopts TMS320C31, the main software section of being responsible for DSP+FPGA numerical control device 17, instruction parser 3, angle position ring controller 91, cireular frequency ring controller 92, current loop controller 93, locking are separated lock controller 16 and are all adopted software programming to realize in dsp chip; Fpga chip adopts EPF10K30, be responsible for hardware components in the DSP+FPGA numerical control device 17, be responsible for control CAN communicating circuit 2, frame motor power driving circuit 14, supersonic motor power driving circuit 15, rotating transformer exciting and shaft angle decoding circuit 6, magslip 8, current sensor 7, A/D sample circuit 4.
As shown in Figure 3, be framework controller 9 diagram of circuits of the present invention, framework controller 9 adopts software to realize, finish framework torque motor three closed loops and add two feedforward computings, the at first given instruction in acceptance angle position, the digital signal that reads the position, angle is to carry out angle position ring proportional integral (PI) computing, and operational formula is C
Outs=Kp
s* (θ
g-θ
G1-θ
f+ θ
F1)+Ki
s* (θ
g-θ
f)+C
Outs1, C wherein
OutsBe the computing output of angle position ring controller, C
Outs1Be the computing output of last angle position ring controller, θ
gBe the given instruction of angle position ring, θ
G1Be the given instruction of position, last angle, θ
fBe the digital signal of position, angle, θ
F1Be the digital signal of position, last angle, Kp
sBe the proportionality coefficient of angle position ring controller, Ki
sIntegral coefficient for the angle position ring controller; Secondly the operation result of output angle position ring controller reads the digital signal and the cireular frequency feedforward of cireular frequency and instructs to carry out the integral differential operation of cireular frequency chain rate example, and operational formula is C
Outv=Kp
v* (C
Outs-C
Outs1+ v
q-v
Q1-v
f+ v
F1)+Ki
v* (C
Outs+ v
q-v
f)+C
Outv1+ Kd
v* (C
Outs-2C
Outs1+ C
Outs2+ v
q-2v
Q1+ v
Q2-v
f+ 2v
F1-v
F2), C wherein
OutvBe the computing output of cireular frequency ring controller, C
Outv1Be the computing output of last cireular frequency ring controller, C
Outs2Be the computing output of last angle position ring controller again, v
qBe cireular frequency feedforward instruction, v
Q1Be last cireular frequency feedforward instruction, v
Q2Be last cireular frequency feedforward instruction again, v
fBe the digital signal of cireular frequency, v
F1Be the digital signal of last cireular frequency, v
F2Be the digital signal of last cireular frequency again, Kp
vBe the proportionality coefficient of cireular frequency ring controller, Ki
vIntegral coefficient for the cireular frequency ring controller; The operation result of output angle speed ring controller once more reads the digital signal of phase current and current feed-forward instruction to carry out the electric current loop scale operation, and operational formula is C
Outi=Kp
i* (C
Outv-C
Outv1+ i
q-i
Q1-i
f+ i
F1), C wherein
OutiComputing output for electric current loop is the PWM dutyfactor value, i
qBe current feed-forward instruction, i
Q1Be last current feed-forward instruction, i
fBe the digital signal of electric current, i
F1Digital signal for last electric current.
As shown in Figure 4, for CAN communicating circuit figure of the present invention, mainly form by crystal oscillator, SJA1000 and PCA82C250.Wherein spaceborne computer links to each other with SJA1000 by PCA82C250, SJA1000 links to each other with fpga chip, crystal oscillator links to each other with SJA1000, for SJA1000 provides work clock, SJA1000 is the CAN communications manager, be responsible for functions such as data transfer, baud rate setting, Working mode set, shielding and verification, interruption in the CAN communication, PCA82C250 is a CAN communication interface device.
As shown in Figure 5, be instruction parser 3 schematic diagrams of the present invention, the angle position command is through obtaining containing the angular velocity information of the above high frequency noise of a large amount of 100Hz after the backward difference, low-pass filter is removed high frequency noise, the cireular frequency connecting rod straightener adopts cascade compensation, control desired amplitude remaining, phase angle remaining and cutoff frequency according to system and carry out leading or correction or lag, to obtain suitable cireular frequency feedforward instruction; The angle position command can obtain angular acceleration feedforward instruction after through twice backward difference and low-pass filter, and acceleration/accel to current correction device carries out cascade compensation with angular acceleration feedforward instruction, and according to the conversion formula K of angular acceleration β and electric current I
i* I-T
l=J β obtains current feed-forward instruction, wherein K
iBe electromagnetic torque coefficient, T
lBe load moment, J is a rotor inertia.
As shown in Figure 6, figure for rotating transformer exciting of the present invention and shaft angle decoding circuit 6, mainly form by rotating transformer exciting circuit and shaft angle decoding chip, wherein rotating transformer exciting circuit output excitation power supply is to the input winding of magslip, and the output winding of magslip links to each other with the shaft angle decoding chip.Rotating transformer exciting circuit is made up of crystal oscillator, low-pass filter, big electric current amplifier, wherein crystal oscillator produces original excited signal and carries out LPF to the two-way low-pass filter, and low-pass filter exports big electric current amplifier to carry out electric current and amplify to satisfy the requirement capability of magslip electric current.The shaft angle decoding chip adopts AD2S80, link to each other with the output winding of magslip, the digital signal of output angle position to the analog signal of framework controller 9 and cireular frequency to A/D sample circuit 4.
As shown in Figure 7, middle frame power of motor driving circuit 14 of the present invention mainly is made up of chip for driving and three phase inverter bridge, and chip for driving is exported 6 the road and driven PWM to three phase inverter bridge.Chip for driving adopts IR2110, three phase inverter bridge uses 6 IRF540 to build, 3 IR2110 export the drive signal that 6 road pwm pulses of FPGA output are converted into three phase inverter bridge to 6 IRF540 respectively, wherein every IR2110 drives two IRF540 up and down of a bridge of three phase inverter bridge, three phase inverter bridge export the three phase electric machine winding to, in addition, IR2110 also has the shutdown pin, draw high this pin and can close the output of IR2110, thereby close framework power of motor driving circuit, power in time-delay, emergency power off, fault plays an important role in resetting.
As shown in Figure 8, be current sensor 7 circuit of the present invention, mainly form by current sensor chip and follow-up simulated modulation circuit.The current sensor chip adopts HBC001S/JN01, is output as the voltage analog signal of size of current, good linearity, and the precision height, response is fast.Follow-up simulated modulation circuit is made up of reduction voltage circuit and low-pass filter circuit, reduction voltage circuit voltage analog signal that current sensor chip output is big is reduced to-4V～4V from-12V～12V, to satisfy the input voltage requirement of A/D sample circuit-5V～5V, low-pass filter circuit adopts two rank voltage controlled voltage source low-pass filters, cutoff frequency is between effective frequency twice and PWM carrier frequency, to eliminate of the interference of three phase inverter bridge power circuit, improve the signal to noise ratio of feedback current signal to current analog signal.
As shown in Figure 9, for lock controller 16 diagram of circuits are separated in locking of the present invention, locking is separated lock controller and is adopted software to realize, at first read temperature, the longitudinal travel value, according to supersonic motor resonant frequency and the temperature surveyed, the relation data form of longitudinal travel is chosen resonant frequency, secondly receive locking, unlock command, read the locking micro-switch, release micro-switch state, if locking instruction and locking micro-switch are not locked, the square voltage pulse of then exporting two-way phase difference 90 degree makes the supersonic motor forward rotation finish locking, if the locking micro-switch is locked, then re-execute flow process; If unlock command and the not release of release micro-switch, the square voltage pulse of then exporting two-way phase difference-90 degree makes the supersonic motor backward rotation finish release, if the release of release micro-switch then re-executes flow process.
As shown in figure 10, supersonic motor power driving circuit 15 of the present invention is made up of chip for driving IR2110, pulse transformer, power tube IRF540.IR2110 becomes the pwm pulse of FPGA output the drive pulse of IRF540, IRF540 is connected on the input winding of pulse transformer, by the alternately break-make of two IRF540 certain frequencies up and down, the alternating-current voltage/AC voltage that makes a same frequency of pulse transformer output and boosted, two groups of supersonic motor power driving circuits 15 drive the stator winding and the armature loop of supersonic motor respectively, can realize the rotating control of supersonic motor by the phase difference of change stator winding and armature loop pulse.
Figure 11 is temperature of the present invention and shaft position sensor circuit diagram, and wherein the left side is a temperature sensor circuit, by platinum resistance R and divider resistance R
_ testForm, platinum resistance adopts pt100, and the resistance value of pt100 varies with temperature, then the AD_t voltage V of ordering
AD_tChange, relational expression is:
Wherein, Vcc is a probe power, and voltage is+12V that R is a pt100 resistance, R
TestBe divider resistance, resistance is 400 ohm.According to voltage V
AD_tValue can obtain the resistance value of pt100 and then obtain the temperature value of supersonic motor.The right side is a supersonic motor shaft position sensor circuit, mainly by oscillating circuit, detecting circuit, modulate circuit is formed, wherein oscillating circuit produces high frequency pure oscillation signal on inductance probe Lz, longitudinal travel between the size of oscillator signal amplitude and inductance probe Lz and the supersonic motor axle is linear, and the amplitude that detecting circuit detects oscillator signal obtains and the linear voltage signal AD_s of supersonic motor longitudinal travel value by modulate circuit.
Figure 12 is a catch gear scheme drawing of the present invention, and catch gear 10 is made up of elastic pressuring plate, hauling rope, and elastic pressuring plate links to each other with supersonic motor by hauling rope.When CAN communicating circuit 2 sends the locking instruction, square voltage pulse to the supersonic motor driving circuit 15 that lock controller 16 output two-way phase differences 90 degree are separated in locking zooms into sinusoidal high-voltage signal driving supersonic motor 13 forward rotation tension hauling rope, force elastic pressuring plate generation elastic deformation to press to magnetic suspension rotor, when compressing fully, locking micro-switch output low level is separated lock controller 16 to locking, makes it stop the output voltage pulse and stops supersonic motor 13 rotations.When CAN communicating circuit 2 sends unlock command, square voltage pulse to the supersonic motor driving circuit 15 that lock controller 16 output two-way phase differences-90 degree is separated in locking zooms into sinusoidal high-voltage signal and drives supersonic motor 13 backward rotation and unclamp hauling rope, elastic pressuring plate resiles gradually and unclamps magnetic suspension rotor, when being totally released, lock controller 16 is separated in release micro-switch output low level to locking, makes it stop the output voltage pulse and makes supersonic motor 13 stalls.
The present invention can be used as a kind of general-duty magnetic levitation control moment gyroscope frame and the platform of locking control system high precision, fast-response, highly reliable control, sufficient hardware resource and abundant control program is provided, and application person can revise software according to its application and realize function flexibly and easily.
Claims (3)
1. magnetic levitation control moment gyroscope frame and locking control system is characterized in that comprising: framework torque motor (12), supersonic motor (13), catch gear (10), lock sensor circuit (11), DSP+FPGA numerical control device (17); Described DSP+FPGA numerical control device (17) comprises CAN communicating circuit (2), instruction parser (3), framework controller (9), locks and separate lock controller (16), frame motor power driving circuit (14), supersonic motor power driving circuit (15) and frame motor sensor circuit (5); Described frame motor sensor circuit (5) comprises rotating transformer exciting and shaft angle decoding circuit (6), magslip (8), current sensor (7) and A/D sample circuit (4); Described framework controller (9) comprises angle position ring controller (91), cireular frequency ring controller (92) and current loop controller (93); Spaceborne computer (1) is separated lock controller (16) by CAN communicating circuit (2) to framework controller (9) and locking and is transmitted the given command signal in position, angle and locking, unlock command signal; Position, angle given command signal input instruction resolver (3) obtains cireular frequency feedforward command signal and current feed-forward command signal; Rotating transformer exciting and shaft angle decoding circuit (6) provide excitation power supply for magslip (8), framework torque motor (12) driven rotary voltage transformer (8) rotates together, magslip (8) output four tunnel analog voltage signal relevant with framework torque motor (12) position, angle is to rotating transformer exciting and shaft angle decoding circuit (6), rotating transformer exciting and shaft angle decoding circuit (6) carry out the shaft angle decoding to four tunnel analog voltage signals relevant with framework torque motor (12) position, angle, the digital signal of output framework torque motor (12) position, angle and the analog signal of cireular frequency, the phase current analog signal of current sensor (7) output framework torque motor (12), the analog signal of cireular frequency and the analog signal of phase current convert the digital signal of cireular frequency and the digital signal of phase current to by A/D sample circuit (4); The digital signal of given command signal in position, angle and position, angle is subtracted each other and is inputed to angle position ring controller (91) and control computing, the digital signal of the output signal of angle position ring controller (91) and cireular frequency feedforward command signal sum and cireular frequency is subtracted each other and is inputed to cireular frequency ring controller (92) and control computing, the output signal of cireular frequency ring controller (92) and the digital signal of current feed-forward command signal sum and phase current are subtracted each other and are inputed to current loop controller (93) and control computing, the controlling quantity of current loop controller (93) output is the dutyfactor value of pwm pulse, current loop controller (93) output pwm pulse is to frame motor power driving circuit (14), and frame motor power driving circuit (14) amplifies pwm pulse, be reverse into ac voltage signal and drive framework torque motor (12) rotation; Lock sensor circuit (11) detects catch gear (10) and supersonic motor (13), output catch gear state, lock controller (16) is separated in the voltage signal of temperature and longitudinal travel to locking, locking is separated lock controller (16) output catch gear state to CAN communicating circuit (2), and determine the resonance mode of supersonic motor (13) according to temperature and longitudinal travel, the locking of lock controller (16) to CAN communicating circuit (2) input is separated in locking, unlock command is judged, if be the locking instruction, square voltage pulse to the supersonic motor driving circuit (15) of then exporting two-way phase difference 90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference 90 degree, drive supersonic motor (13) forward rotation, thereby finish the locking of catch gear (10); If be unlock command, square voltage pulse to the supersonic motor driving circuit (15) of then exporting two-way phase difference-90 degree of the resonant frequency under this resonance mode zooms into the sinusoidal high-voltage signal of phase difference-90 degree, drive supersonic motor (13) backward rotation, thereby finish the release of catch gear (10).
2. magnetic levitation control moment gyroscope frame according to claim 1 and locking control system, it is characterized in that: described instruction parser (3) is made up of backward difference, low-pass filter, cireular frequency connecting rod straightener and acceleration/accel to current correction device; The angle position command is through obtaining containing the angular velocity information of a large amount of high frequency noises after the backward difference, low-pass filter is removed high frequency noise, the cireular frequency connecting rod straightener adopts cascade compensation, control desired amplitude remaining, phase angle remaining and cutoff frequency according to system and carry out leading or correction or lag, to obtain suitable cireular frequency feedforward instruction; The angle position command can obtain angular acceleration feedforward instruction after through twice backward difference and low-pass filter, and acceleration/accel to current correction device carries out cascade compensation with angular acceleration feedforward instruction, and according to the conversion formula K of angular acceleration β and electric current I
i* I-T
l=J β obtains current feed-forward instruction, wherein K
iBe electromagnetic torque coefficient, T
lBe load moment, J is a rotor inertia; Because the use of cireular frequency feedforward and current feed-forward has improved the speed of response of framework torque motor (12).
3. magnetic levitation control moment gyroscope frame according to claim 1 and locking control system, it is characterized in that: described catch gear (10) is made up of elastic pressuring plate, hauling rope, and elastic pressuring plate links to each other with supersonic motor (13) by hauling rope; Lock sensor circuit (11) is made up of locking micro-switch, release micro-switch, temperature and shaft position sensor; When CAN communicating circuit (2) sends the locking instruction, square voltage pulse to the supersonic motor driving circuit (15) that lock controller (16) output two-way phase difference 90 degree are separated in locking zooms into sinusoidal high-voltage signal driving supersonic motor (13) forward rotation tension hauling rope, force elastic pressuring plate generation elastic deformation to press to magnetic suspension rotor, when compressing fully, lock controller (16) is separated in locking micro-switch output low level to locking, makes locking separate lock controller (16) and stops the output voltage pulse and stop supersonic motor (13) and rotate; When CAN communicating circuit (2) sends unlock command, square voltage pulse to the supersonic motor driving circuit (15) that lock controller (16) output two-way phase difference-90 degree is separated in locking zooms into sinusoidal high-voltage signal and drives supersonic motor (13) backward rotation and unclamp hauling rope, elastic pressuring plate resiles gradually and unclamps magnetic suspension rotor, when being totally released, lock controller (16) is separated in release micro-switch output low level to locking, making locking separate lock controller (16) stops the output voltage pulse and makes supersonic motor (13) stall, supersonic motor (13) thus can produce a large amount of heats when rotating in a vacuum rises its temperature its resonant frequency is offset, and the variation of supersonic motor (13) axle pressure also can make its resonant frequency be offset, if resonant frequency is not controlled, the situation of stall even breaking-up may appear in supersonic motor (13); The temperature of temperature and shaft position sensor output ultrasonic wave motor and longitudinal travel value, according to the variation relation of the ultrasonic resonator frequency values of being surveyed with temperature and longitudinal travel value, select cooresponding resonant frequency, make supersonic motor (13) smooth running, improved the reliability of catch gear (10).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010105352511A CN102009597B (en) | 2010-11-03 | 2010-11-03 | Magnetically suspended control moment gyro gimbal and locking control system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010105352511A CN102009597B (en) | 2010-11-03 | 2010-11-03 | Magnetically suspended control moment gyro gimbal and locking control system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102009597A true CN102009597A (en) | 2011-04-13 |
| CN102009597B CN102009597B (en) | 2012-11-14 |
Family
ID=43840000
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010105352511A Active CN102009597B (en) | 2010-11-03 | 2010-11-03 | Magnetically suspended control moment gyro gimbal and locking control system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102009597B (en) |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102510259A (en) * | 2011-11-15 | 2012-06-20 | 永济新时速电机电器有限责任公司 | Conditioning circuit for rotary transformer |
| CN102679979A (en) * | 2012-05-18 | 2012-09-19 | 北京航空航天大学 | Method for monitoring working mode of aerial remote sensing triaxial inertia stabilization platform |
| CN105007011A (en) * | 2015-08-11 | 2015-10-28 | 南京理工大学 | High-precision digital control system of airborne stabilized platform |
| CN106438576A (en) * | 2016-11-14 | 2017-02-22 | 中北大学 | Locking mechanism for locking at any position and locking precision determination method thereof |
| CN106997183A (en) * | 2016-01-25 | 2017-08-01 | 北京林业大学 | Magnetic suspension control moment gyro monitoring system for simulating rocket launching and on-orbit running |
| CN108227607A (en) * | 2016-12-14 | 2018-06-29 | 中国航空工业集团公司西安航空计算技术研究所 | A kind of method of simplified circuit board arrangement circuit |
| CN109375008A (en) * | 2018-10-09 | 2019-02-22 | 北京精密机电控制设备研究所 | A kind of electromagnetic lock working state detecting method |
| CN109375540A (en) * | 2018-10-18 | 2019-02-22 | 九江精密测试技术研究所 | A kind of integrated rotation locking servo module |
| CN109491277A (en) * | 2017-09-11 | 2019-03-19 | 北京遥感设备研究所 | A method of it eliminating target seeker servo-system and is shaken in position loop |
| CN109506649A (en) * | 2018-10-25 | 2019-03-22 | 北京航天控制仪器研究所 | A kind of zero method and system of four axis inertially stabilized platform system inner frames lock |
| CN109502055A (en) * | 2018-12-10 | 2019-03-22 | 上海航天控制技术研究所 | The driving control system and method for control-moment gyro outer framework |
| CN110963083A (en) * | 2019-11-21 | 2020-04-07 | 南京航空航天大学 | Small-sized frame type control moment gyro driven by double-stator ultrasonic motor |
| CN111409870A (en) * | 2020-04-15 | 2020-07-14 | 北京石油化工学院 | Magnetic suspension flywheel fusing locking protection mechanism |
| CN111717039A (en) * | 2020-06-29 | 2020-09-29 | 湖南中车时代通信信号有限公司 | Traction cut-off control method for high-speed magnetic levitation system |
| CN111831023A (en) * | 2020-08-03 | 2020-10-27 | 上海航天控制技术研究所 | Control moment gyro controller |
| CN113607191A (en) * | 2021-08-13 | 2021-11-05 | 北京航天控制仪器研究所 | Reliability determination method for long-term power-up gyro accelerometer of three-floating-platform system |
| CN115549518A (en) * | 2022-11-25 | 2022-12-30 | 吉林大学 | Ultrasonic transducer suspension control device |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5419212A (en) * | 1993-07-02 | 1995-05-30 | Honeywell Inc. | Touchdown and launch-lock apparatus for magnetically suspended control moment gyroscope |
| CN1945467A (en) * | 2006-10-24 | 2007-04-11 | 北京航空航天大学 | Servo control system for quick response magnetic suspension control torque gyroscope frame |
| CN101301934A (en) * | 2008-04-22 | 2008-11-12 | 北京航空航天大学 | Double-frame magnetic suspension control moment gyroscope control system |
-
2010
- 2010-11-03 CN CN2010105352511A patent/CN102009597B/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5419212A (en) * | 1993-07-02 | 1995-05-30 | Honeywell Inc. | Touchdown and launch-lock apparatus for magnetically suspended control moment gyroscope |
| CN1945467A (en) * | 2006-10-24 | 2007-04-11 | 北京航空航天大学 | Servo control system for quick response magnetic suspension control torque gyroscope frame |
| CN101301934A (en) * | 2008-04-22 | 2008-11-12 | 北京航空航天大学 | Double-frame magnetic suspension control moment gyroscope control system |
Non-Patent Citations (2)
| Title |
|---|
| 《北京航空航天大学学报》 20090630 徐向波，房建成 基于角加速度的陀螺框架伺服系统干扰观测器 669-672 1-3 第35卷, 第6期 2 * |
| 《宇航学报》 20070331 于灵慧，房建成 磁悬浮控制力矩陀螺框架伺服系统扰动力矩分析与抑制 287-291 1-3 第28卷, 第2期 2 * |
Cited By (25)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102510259A (en) * | 2011-11-15 | 2012-06-20 | 永济新时速电机电器有限责任公司 | Conditioning circuit for rotary transformer |
| CN102679979A (en) * | 2012-05-18 | 2012-09-19 | 北京航空航天大学 | Method for monitoring working mode of aerial remote sensing triaxial inertia stabilization platform |
| CN102679979B (en) * | 2012-05-18 | 2015-02-25 | 北京航空航天大学 | Method for monitoring working mode of aerial remote sensing triaxial inertia stabilization platform |
| CN105007011A (en) * | 2015-08-11 | 2015-10-28 | 南京理工大学 | High-precision digital control system of airborne stabilized platform |
| CN106997183A (en) * | 2016-01-25 | 2017-08-01 | 北京林业大学 | Magnetic suspension control moment gyro monitoring system for simulating rocket launching and on-orbit running |
| CN106438576A (en) * | 2016-11-14 | 2017-02-22 | 中北大学 | Locking mechanism for locking at any position and locking precision determination method thereof |
| CN106438576B (en) * | 2016-11-14 | 2018-05-29 | 中北大学 | A kind of retaining mechanism for any position locking |
| CN108227607A (en) * | 2016-12-14 | 2018-06-29 | 中国航空工业集团公司西安航空计算技术研究所 | A kind of method of simplified circuit board arrangement circuit |
| CN109491277A (en) * | 2017-09-11 | 2019-03-19 | 北京遥感设备研究所 | A method of it eliminating target seeker servo-system and is shaken in position loop |
| CN109375008A (en) * | 2018-10-09 | 2019-02-22 | 北京精密机电控制设备研究所 | A kind of electromagnetic lock working state detecting method |
| CN109375540A (en) * | 2018-10-18 | 2019-02-22 | 九江精密测试技术研究所 | A kind of integrated rotation locking servo module |
| CN109506649A (en) * | 2018-10-25 | 2019-03-22 | 北京航天控制仪器研究所 | A kind of zero method and system of four axis inertially stabilized platform system inner frames lock |
| CN109502055A (en) * | 2018-12-10 | 2019-03-22 | 上海航天控制技术研究所 | The driving control system and method for control-moment gyro outer framework |
| CN110963083A (en) * | 2019-11-21 | 2020-04-07 | 南京航空航天大学 | Small-sized frame type control moment gyro driven by double-stator ultrasonic motor |
| CN110963083B (en) * | 2019-11-21 | 2021-12-21 | 南京航空航天大学 | Small-sized frame type control moment gyro driven by double-stator ultrasonic motor |
| CN111409870A (en) * | 2020-04-15 | 2020-07-14 | 北京石油化工学院 | Magnetic suspension flywheel fusing locking protection mechanism |
| CN111409870B (en) * | 2020-04-15 | 2022-07-19 | 北京石油化工学院 | Magnetic suspension flywheel fusing locking protection mechanism |
| CN111717039A (en) * | 2020-06-29 | 2020-09-29 | 湖南中车时代通信信号有限公司 | Traction cut-off control method for high-speed magnetic levitation system |
| CN111717039B (en) * | 2020-06-29 | 2022-03-15 | 湖南中车时代通信信号有限公司 | Traction cut-off control method for high-speed magnetic levitation system |
| CN111831023A (en) * | 2020-08-03 | 2020-10-27 | 上海航天控制技术研究所 | Control moment gyro controller |
| CN111831023B (en) * | 2020-08-03 | 2021-10-29 | 上海航天控制技术研究所 | Control moment gyro controller |
| CN113607191A (en) * | 2021-08-13 | 2021-11-05 | 北京航天控制仪器研究所 | Reliability determination method for long-term power-up gyro accelerometer of three-floating-platform system |
| CN113607191B (en) * | 2021-08-13 | 2023-12-12 | 北京航天控制仪器研究所 | Reliability judging method for long-term power-up gyroscope accelerometer of three-floating platform system |
| CN115549518A (en) * | 2022-11-25 | 2022-12-30 | 吉林大学 | Ultrasonic transducer suspension control device |
| CN115549518B (en) * | 2022-11-25 | 2023-03-10 | 吉林大学 | Ultrasonic transducer suspension control device |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102009597B (en) | 2012-11-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102009597B (en) | Magnetically suspended control moment gyro gimbal and locking control system | |
| CN100420145C (en) | A low-loss, high reliability integration magnetic levitation flywheel DC brushless motor control system | |
| CN107992110B (en) | Magnetic suspension control moment gyro frame angular rate servo system based on harmonic reducer | |
| CN102506860B (en) | A kind of inertia stabilizing device based on accelerator feedback and feedforward and control method thereof | |
| CN102980578B (en) | A kind of double-shaft rotation optical fiber strapdown inertia navigation device | |
| De Miras et al. | Active magnetic bearing: A new step for model-free control | |
| CN105786036A (en) | Control moment gyroscope framework control system and control moment gyroscope framework control method for restraining dynamic unbalance disturbance of rotor | |
| CN103522912B (en) | The magnetic flux feedback suspension control method of EMS type low speed aerotrain and device | |
| CN102185546B (en) | Drive control method and system for large-caliber telescope arc motor | |
| CN104062983B (en) | A kind of position control system with high accuracy of harmonic drive and method | |
| CN102495645B (en) | Gyro-stabilized platform for high-speed rolling carrier and control method thereof | |
| CN101734379B (en) | FPGA-based highly-integrated high-precision control system for micro flywheel | |
| CN102437802A (en) | Light high-accuracy digital control system for miniature flywheel | |
| CN100392268C (en) | Highly-reliable integrated low-power consumption magnetic levitation flywheel magnetic bearing numerical control device | |
| CN102013856A (en) | Integrated magnetic suspension flywheel digital control device with high reliability | |
| CN103607149B (en) | A kind of ultrasonic motor rudder servo system and control method thereof | |
| CN106997183B (en) | Magnetic suspension control moment gyro monitoring system for simulating rocket launching and on-orbit running | |
| EP0659266A4 (en) | Earth/gyro power transducer. | |
| CN202351714U (en) | Gyroscope stabilization platform for high-speed rolling carrier | |
| Wang et al. | Robust continuous sliding mode control for manipulator PMSM trajectory tracking system under time-varying uncertain disturbances | |
| CN111006664B (en) | Triaxial inertial platform system based on atomic spin gyroscope | |
| US4266432A (en) | Gyro motor control | |
| CN202255408U (en) | Dual-gyroscope detection stable platform | |
| CN111077801A (en) | Magnetic bearing control method and control platform thereof | |
| Sang et al. | The practical control technology design for AC servo motor based on STM32 micro-controller |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |