CN104714407B - A kind of rotating mechanism PID/H∞Control method - Google Patents
A kind of rotating mechanism PID/H∞Control method Download PDFInfo
- Publication number
- CN104714407B CN104714407B CN201310694471.2A CN201310694471A CN104714407B CN 104714407 B CN104714407 B CN 104714407B CN 201310694471 A CN201310694471 A CN 201310694471A CN 104714407 B CN104714407 B CN 104714407B
- Authority
- CN
- China
- Prior art keywords
- mrow
- rotating mechanism
- control
- msub
- controller
- 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.)
- Active
Links
Landscapes
- Feedback Control In General (AREA)
Abstract
The invention belongs to rotation modulation inertial navigation system control technology field, and in particular to a kind of rotating mechanism PID/H∞Control method.The control method comprises the following steps:1st, photoelectric encoder gathers the actual angular position θ of rotating frame in real time;2nd, actual angular position θ and control targe angle θrefMake difference, difference result is sent into position PID controller as input;Step 3, signals of the actual angular position θ after differentiator differential and the output of position PID controller done into difference, using differentiated result as input feeding speed loop H∞Controller;Step 4, speed loop H∞Torque motor is sent into the output of controller after power amplifier amplifies, and performs control result, drives rotating frame to be rotated by control rate.The control method of the present invention, can effectively eliminate the influence of moment of friction present in rotating mechanism and unbalanced moments, improve the control accuracy and dynamic reliability of rotating mechanism, and then improve the overall performance of inertial navigation system.
Description
Technical field
The invention belongs to rotation modulation inertial navigation system control technology field, and in particular to a kind of bi-axial swivel mechanism PID/
H∞Control method.
Background technology
Moment of friction interference in bi-axial swivel mechanism, in shafting be present, the low speed rotation performance of rotating mechanism can be influenceed;This
Outside, under airborne dynamic environment, the motion of carrier aircraft and random vibration can be produced by inertial navigation system pedestal couples into rotating mechanism
Raw Ji trimming moment, influence the dynamic property of rotating mechanism.And traditional control method Ji can effectively handle in rotating mechanism and deposit
Above-mentioned moment of friction and Ji trimming moment influenceed to caused by system, make rotating mechanism servo performance and robustness drop
It is low.
The content of the invention
The technical problem to be solved in the invention is moment of friction and Ji equilibrant force present in effective elimination rotating mechanism
Square influences to caused by the servo performance and robustness of system.
The rotating mechanism PID/H of the present invention∞Control method, comprise the following steps:
Step 1, photoelectric encoder gather the actual angular position θ of rotating frame in real time;
Step 2, actual angular position θ not control targe angle θrefMake difference, difference result is inputted to position PID controllers;
Step 3, the output of signals of the actual angular position θ after differentiator differential not position PID controller made into difference, it is poor
Result after point is inputted to speed loop H∞Controller;
Step 4, speed loop H∞Torque motor is sent into the output of controller after power amplifier amplifies, and performs control knot
Fruit, rotating frame is driven to be rotated by control rate;
Wherein, in the step 3, speed loop H∞The control rate of controller uses H∞Mixed Sensitivity PS/T methods are asked
Solution draws, the H∞Mixed Sensitivity PS/T methods are shown below:
In formula, W1(s) it is the performances weighting functions of rotating mechanism control system, W2(s) it is the robust of rotating mechanism control system
Stable weight function, P (s) are the transmission function of rotating mechanism controlled device, and S (s) is to characterize rotating mechanism panel level
Sensitivity function, T (s) are the mending sensitivity function for the robust stability for characterizing rotating mechanism.
Preferably, the rotating mechanism control system performances weighting functions W1(s) expression formula is:
Wherein
ρ=ML/ωJK0
In formula, MLFor disturbance torque;ω is disturbance torque MLThe Output speed in the lower loop of effect;J is turning for rotating mechanism
Dynamic inertia;K0For the gain coefficient of rotating mechanism controlled device;ξ is control output adjustment parameter;μ1、μ2、μ3For adjusting system
Frequency characteristic parameter
The rotating mechanism control system performances weighting functions W2(s) expression formula is:
W2=k1λ1λ2
In formula, k1For gain coefficient;λ1For loop bandwidth restricted function;λ2For high-frequency noise inhibition function.
Preferably, ρ=1518, a width of 400Hz of rotating mechanism speed loop band, ξ=0.60;μ1=235; μ2=360;μ3
=780, then
λ1=0.0025 (s+1), λ2=(0.0003s+1), k1=1.2, then
W2(s)=1.2 × 0.0025 (s+1) (0.0003s+1);
The H of speed loop∞The input/output model of controller is:
Preferably, position PID controller described in step 3 is PI structures, and its input/output model is:
Preferably, to the H of the speed loop∞The input/output model K of controllerv(s) depression of order simplification processing is carried out, is obtained
H after simplification∞Controller input/output model is:
Brief description of the drawings
Fig. 1 is a kind of PID/H of rotating mechanism of the present invention∞The controlled rotating mechanism composition schematic diagram of control method;
Fig. 2 is a kind of PID/H of rotating mechanism of the present invention∞The control principle drawing of control method.
Embodiment
Embodiment 1,
A kind of as shown in Fig. 2 rotating mechanism PID/H of the present invention∞Control method, comprise the following steps:
Step 1, photoelectric encoder gather the actual angular position θ of rotating frame in real time;
Step 2, actual angular position θ not control targe angle θrefMake difference, difference result is sent into position PID controls as input
Device processed;
Step 3, the output of signals of the actual angular position θ after differentiator differential not position PID controller done into difference, will
Differentiated result is sent into speed loop H as input∞Controller;
Step 4, speed loop H∞Torque motor is sent into the output of controller after power amplifier amplifies, and performs control knot
Fruit, rotating frame is driven to be rotated by control rate;
In the step 3, speed loop H∞The control rate of controller uses H∞Mixed Sensitivity PS/T methods are solved and drawn,
The H∞Mixed Sensitivity PS/T methods such as following formula:
In formula
W1(s) it is the performances weighting functions of rotating mechanism control system;
W2(s) it is the robust stability weight function of rotating mechanism control system;
P (s) is the transmission function of the controlled device of rotating mechanism;
S (s) is the sensitivity function for characterizing rotating mechanism panel level, and its acquisition methods is known in the art often
Know;
T (s) is the mending sensitivity function for the robust stability for characterizing rotating mechanism, and its acquisition methods is known in the art
General knowledge;
Embodiment 2
The difference of the present embodiment not embodiment 1 is, W1(s) determination method is as follows:
Step 3.1.1, according to inner membrance principle, to eliminate loop steady-state error, W1(s) integral element 1/s should be contained in;
Step 3.1.2, it is delayed phase caused by decaying integral link, in W1(s) near increase loop Mid Frequency
Zero point (μ s+1);
Step 3.1.3, the AF panel performance indications T (s) of speed loop=ω (s) ML(s), to make in disturbance torque ML
(s) the Output speed ω (s) under acting on is as far as possible small, in W1(s) gain coefficient ρ=M is set inL/ωJK0, wherein, MLIt is dry
Disturb torque;ω is disturbance torque MLThe Output speed in the lower loop of effect;J is the rotary inertia of rotating mechanism;K0For rotating mechanism
The gain coefficient of controlled device;
Step 3.4, in W1(s) increase inLink, to improve rotating mechanism
The stability margin of speed loop, wherein ξ export adjustment parameter, μ for control1、μ2、μ3The frequency characteristic parameter of adjusting system;
It is final to determine W1(s) expression formula is:
W2(s) determination method is:
Step 3.2.1, in order to suppress the high frequency unmodelled dynamics of control loop, the bandwidth of limit circuit, in W2(s)
Middle setting loop bandwidth limiting element λ1;
Step 3.2.2, in order to quickly suppress the high-frequency noise in loop, in W2(s) the high frequency link λ outside bandwidth is set in2;
The gain perturbation of system is considered as when step 3.2.3, designing, therefore W is set2(s) gain coefficient in is k1;
Then determine W2(s) expression formula is:
W2=k1λ1λ2
Embodiment 3
The difference of the present embodiment not embodiment 2 is:Take ρ=1518, the bandwidth of rotating mechanism speed loop in 400Hz,
Take ξ=0.60;μ1=235;μ2=360;μ3=780, then
Take λ1=0.0025 (s+1), λ2=(0.0003s+1), the gain perturbation for considering system is ± 20%, takes k1=1.2,
Then
W2(s)=1.2 × 0.0025 (s+1) (0.0003s+1);
Therefore the H of speed loop∞The input/output model of controller is:
Embodiment 4
The difference of the present embodiment not embodiment 1 is, position PID controller described in step 3 is PI structures, proportional gain
K=42, storage gain p=494, the input/output model of PID controller are:
Embodiment 5
The difference of the present embodiment not embodiment 3 is, H described in embodiment 3∞Speed control modular form(1)Exponent number
Higher, Ji is beneficial to Project Realization, and depression of order processing need to be carried out to it, and depression of order principle is:
1st, the high frequency link much larger than system speed loop bandwidth influences smaller on the characteristic of the main frequency range of system, can be with
Ignore;
2nd, closely located zero pole point is almost constant in the characteristic of middle low-frequency range, can be cancelled out each other;
3rd, when speed control designs, in order to meet H∞Solving condition and increased small perturbing term should reduce;
4th, the static gain Ji of speed control becomes before and after depression of order.
According to above-mentioned depression of order principle, to H∞Speed control modular form(1)Simplified, the H after must simplifying∞Controller
Input/output model is:
。
Claims (4)
- A kind of 1. rotating mechanism PID/H∞Control method, comprise the following steps:Step 1, photoelectric encoder gather the actual angular position θ of rotating frame in real time;Step 2, actual angular position θ and control targe angle θrefMake difference, difference result is inputted to position PID controller;Step 3, difference of making the output of signals of the actual angular position θ after differentiator differential and position PID controller, after difference Result input to speed loop H∞Controller;Step 4, speed loop H∞Torque motor is sent into the output of controller after power amplifier amplifies, and performs control result, Rotating frame is driven to be rotated by control rate;It is characterized in that:In the step 3, speed loop H∞The control rate of controller uses H∞Mixed Sensitivity PS/T methods are asked Solution draws, the H∞Mixed Sensitivity PS/T methods are shown below:<mrow> <mo>|</mo> <mo>|</mo> <mtable> <mtr> <mtd> <mrow> <msub> <mi>W</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>P</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>S</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>W</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>T</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>|</mo> <msub> <mo>|</mo> <mi>&infin;</mi> </msub> <mo><</mo> <mn>1</mn> </mrow>In formula, W1(s) it is the performances weighting functions of rotating mechanism control system, W2(s) it is the robust stability of rotating mechanism control system Weight function, P (s) are the transmission function of rotating mechanism controlled device, and S (s) is the sensitive of sign rotating mechanism panel level Function is spent, T (s) is the mending sensitivity function for the robust stability for characterizing rotating mechanism;The rotating mechanism control system performances weighting functions W1(s) expression formula is:Whereinρ=ML/ωJK0In formula, MLFor disturbance torque;ω is disturbance torque MLThe Output speed in the lower loop of effect;J is that the rotation of rotating mechanism is used to Amount;K0For the gain coefficient of rotating mechanism controlled device;ξ is control output adjustment parameter;μ1、μ2、μ3For the frequency of adjusting system Characterisitic parameter;The robust stability weight function W of the rotating mechanism control system2(s) expression formula is:W2=k1λ1λ2In formula, k1For gain coefficient;λ1For loop bandwidth restricted function;λ2For high-frequency noise inhibition function.
- 2. rotating mechanism PID/H as claimed in claim 1∞Control method, it is characterised in that:ρ=1518, rotating mechanism speed Loop bandwidth is 400Hz, ξ=0.60;μ1=235;μ2=360;μ3=780, then<mrow> <msub> <mi>W</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>1518</mn> <mfrac> <mrow> <mo>(</mo> <mfrac> <mn>1</mn> <mn>385</mn> </mfrac> <mi>s</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> <mo>(</mo> <msup> <mi>s</mi> <mn>2</mn> </msup> <mo>+</mo> <mn>432</mn> <mi>s</mi> <mo>+</mo> <mn>129600</mn> <mo>)</mo> </mrow> <mrow> <mi>s</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>+</mo> <mn>235</mn> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>s</mi> <mo>+</mo> <mn>780</mn> <mo>)</mo> </mrow> </mrow> </mfrac> </mrow>λ1=0.0025 (s+1), λ2=(0.0003s+1), k1=1.2, thenW2(s)=1.2 × 0.0025 (s+1) (0.0003s+1);The H of speed loop∞The input/output model of controller is:<mrow> <msub> <mi>K</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mn>7881.665</mn> <msup> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>5</mn> <mi>e</mi> <mn>004</mn> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>2332</mn> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>764.6</mn> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>285.4</mn> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msup> <mi>s</mi> <mn>2</mn> </msup> <mo>+</mo> <mn>373.7</mn> <mi>s</mi> <mo>+</mo> <mn>3.63</mn> <mi>e</mi> <mn>004</mn> </mrow> <mo>)</mo> </mrow> </mrow> <mrow> <mi>s</mi> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>5.247</mn> <mi>e</mi> <mn>004</mn> </mrow> <mo>)</mo> </mrow> <msup> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>1</mn> <mi>e</mi> <mn>005</mn> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>3641</mn> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>780</mn> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <mi>s</mi> <mo>+</mo> <mn>235</mn> </mrow> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>.</mo> </mrow>
- 3. rotating mechanism PID/H as claimed in claim 1∞Control method, it is characterised in that:Control position PID described in step 3 Device processed is PI structures, and its input/output model is:<mrow> <msub> <mi>K</mi> <mi>p</mi> </msub> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>42</mn> <mrow> <mo>(</mo> <mn>1</mn> <mo>+</mo> <mfrac> <mn>1</mn> <mrow> <mn>0.085</mn> <mi>s</mi> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>.</mo> </mrow>
- 4. rotating mechanism PID/H as claimed in claim 3∞Control method, it is characterised in that:To the H of the speed loop∞Control The input/output model K of device processedv(s) depression of order simplification processing, the H after must simplifying are carried out∞Controller input/output model is:<mrow> <msubsup> <mi>K</mi> <mi>v</mi> <mo>&prime;</mo> </msubsup> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mn>0.0286</mn> <mrow> <mo>(</mo> <msup> <mi>s</mi> <mn>2</mn> </msup> <mo>+</mo> <mn>373.7</mn> <mi>s</mi> <mo>+</mo> <mn>3.63</mn> <mi>e</mi> <mn>004</mn> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mn>0.0035</mn> <mi>s</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mrow> <mi>s</mi> <mrow> <mo>(</mo> <mn>0.0043</mn> <mi>s</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>.</mo> </mrow>
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310694471.2A CN104714407B (en) | 2013-12-17 | 2013-12-17 | A kind of rotating mechanism PID/H∞Control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310694471.2A CN104714407B (en) | 2013-12-17 | 2013-12-17 | A kind of rotating mechanism PID/H∞Control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104714407A CN104714407A (en) | 2015-06-17 |
CN104714407B true CN104714407B (en) | 2018-02-09 |
Family
ID=53413845
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310694471.2A Active CN104714407B (en) | 2013-12-17 | 2013-12-17 | A kind of rotating mechanism PID/H∞Control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104714407B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107168359A (en) * | 2017-07-03 | 2017-09-15 | 上海航天控制技术研究所 | A kind of control method of large-scale flexible satellite high precision high stability degree |
CN107992109B (en) * | 2017-12-06 | 2021-03-09 | 深圳易能电气技术股份有限公司 | Full closed-loop positioning control system and method |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101480347A (en) * | 2009-01-20 | 2009-07-15 | 深圳市蓝韵实业有限公司 | Four-dimensional ultrasound probe motor control system |
CN102495645A (en) * | 2011-11-28 | 2012-06-13 | 西北工业大学 | Gyro-stabilized platform for high-speed rolling carrier and control method thereof |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008225632A (en) * | 2007-03-09 | 2008-09-25 | Hitachi Via Mechanics Ltd | Servo-drive device for nc control |
WO2010054506A1 (en) * | 2008-11-11 | 2010-05-20 | 深圳航天科技创新研究院 | Control system of multi- shaft servo motor |
-
2013
- 2013-12-17 CN CN201310694471.2A patent/CN104714407B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101480347A (en) * | 2009-01-20 | 2009-07-15 | 深圳市蓝韵实业有限公司 | Four-dimensional ultrasound probe motor control system |
CN102495645A (en) * | 2011-11-28 | 2012-06-13 | 西北工业大学 | Gyro-stabilized platform for high-speed rolling carrier and control method thereof |
Non-Patent Citations (5)
Title |
---|
两轴稳定转台伺服控制***研究;董新利;《信息科技辑》;20110415;摘要,第18页第3-12行,第19-21页,附图3.2,3.6 * |
四环式两轴稳定平台闭锁环控制***设计与应用;王仁臻等;《航空兵器》;20101231;第25-28页 * |
基于最小熵H∞控制的降阶电力***稳定器设计;孙勇等;《吉林大学学报(工学版)》;20100331;第40卷(第2期);第524页右栏倒数第1-11行,第525页左栏第7-12行,右栏,附图1,2 * |
基于航天器复杂动力学模型的鲁棒H∞振动抑制算法;刘磊等;《空间控制技术与应用》;20110430;第37卷(第2期);第6-13,25页 * |
机载光电跟瞄平台稳定与跟踪控制方法研究;黄一等;《飞机设计》;20030930;第39页右栏第1,2,16,17行,第41页左栏第5-21行,右栏第3-18行,附图2 * |
Also Published As
Publication number | Publication date |
---|---|
CN104714407A (en) | 2015-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102506860B (en) | Inertial stabilization device based on acceleration feedback and feedforward and control method thereof | |
CN104071031B (en) | A kind of suppressing method of pure electric automobile starting shake | |
CN104214044A (en) | Independent variable pitch control method of double-fed variable-speed variable-pitch wind generating set | |
CN104214045A (en) | Independent variable pitch control method of double-fed variable-speed variable-pitch wind generating set | |
CN105305920B (en) | A kind of system and method for suppressing AC servo twisting vibration | |
CN100587632C (en) | Adaptive neural network control method used for magnetic suspension reaction flywheel | |
CN108087423A (en) | A kind of control device of magnetic suspension bearing, magnetic suspension bearing and its control method | |
CN102621890A (en) | Control method of photoelectric tracking stable platform of moving carrier | |
KR20150094706A (en) | Controlling motions of floating wind turbines | |
CN104714407B (en) | A kind of rotating mechanism PID/H∞Control method | |
CN103256188B (en) | A kind of Torsional Vibration Control method of driving chain of wind generating set and device | |
CN112412701A (en) | Vibration control method for wind turbine generator tower | |
CN103296961A (en) | Control method and system for restraining vibration of offshore wind turbine generator set | |
CN106586034A (en) | Self-compensating method for dynamic and still unbalancing disturbance moment of satellite rotating part | |
CN101145027A (en) | High precision magnetic levitation control moment gyroscope frame servo control system | |
CN107992063B (en) | Variable-parameter nutation damping-based precession control method for variable-speed tilting momentum wheel | |
CN110439747A (en) | A kind of IPC control method reducing the vibration of wind-power tower left and right directions and load | |
CN104090578A (en) | Magnetic-control bias momentum satellite attitude control method based on periodic Lyapunov equation | |
CN103713520A (en) | Gyroscope stabilized platform adaptive composite control method | |
CN103529858A (en) | Position closed-loop system-based minimum phase difference tracking method | |
CN104374390A (en) | inertial stabilization platform unbalanced disturbance inhibition method | |
CN202854611U (en) | Four-rotor aircraft attitude control system | |
CN109936150B (en) | Optimal control method and device for virtual inertia control and controller of optimal control method and device | |
CN104808673A (en) | Height estimation method for four-rotor aircraft based on Kalman filtering | |
CN106321248A (en) | Gas turbine control method and system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |