自动控制原理试验-卫星三轴姿态控制系统

1、自动控制理论实验报告人：赵振根02020802班2008300597卫星三轴姿态飞轮控制系统设计一：概述1.1 .坐标系选择与坐标变换在讨论卫星姿态时，首先要选定空间坐标系，不规定参考坐标系就无从描述卫星的姿态，至少要建立两个坐标系，一个是空间参考坐标系,一个是固连在卫星本体的星体坐标系。在描述三轴稳定对地定向卫星的姿态运动时，一般以轨道坐标系为参考坐标系，还有星体坐标系。(1)轨道坐标系O-X0Y°Z。，原点位于卫星的质心O,OX。轴在轨道平面上与oz。轴垂直，与轨道速度方向一致，OZ。轴指向地心，OYo轴垂直于轨道平面并构成右手直角坐标系星体坐标系O-XbYbZb,原点位于卫星的

2、质心O,OXb,OYb,OZb固连在星体上，为卫星的三个惯性主轴。其中OXb为滚动轴，OYb为俯仰轴，OZb为偏航轴。1.2 飞轮控制系统在卫星三轴姿态控制中的应用与特点长寿命，高精度的三轴姿态稳定卫星，在轨道上正常工作时，普遍采用角动量交换装置作为姿态控制系统的执行机构。与喷气推力器三轴姿态稳定系统相比，飞轮三轴姿态稳定系统具有多方面的有点：（1）飞轮可以给出较为精确地连续变化的控制力矩，可以进行线性控制，而喷气推力器只能作为非线性开关控制，因此轮控系统的精度比喷气推力器的精度高一个数量级，而姿态误差速率也比喷气控制小。（2）飞轮所需要的能源是电能可以不断地通过太阳能电池在轨得到补充，因而适

3、用于长寿命工作，喷气推力器需要消耗工质或燃料，在轨无法补充，因而寿命大大受限。（3）轮控系统特别适用于克服周期性扰动。（4）轮控系统能够避免热推力器对光学仪器的污染。然而，轮控系统在具有以上优越性的同时，也存在两个主要问题，一是飞轮会发生速度饱和。当飞轮朝着一个方向加速或偏转以克服某一方面的非周期性扰动时，飞轮终究要达到其最大允许转速。二是由于转速部件的存在，特别是轴承寿命和可靠性受到限制。1.3 飞轮姿态控制原理从动力学角度看，卫星姿态运动时卫星角动量作用的结果，飞轮则是通过与卫星间的角动量的交换来实现姿态控制，要使卫星在轨道上保持三轴稳定并对地定向。卫星的角动量H应该不变，且方向与轨道平面

4、卫星的角动量H由星体角动量L和飞轮控制系统的角动量Li组成，由于飞轮控制系统存在饱和问题，需要有第二个控制系统进行卸载饱和，可以是喷气推力器或磁力器，所以卫星受到一个外控制力矩Mc的作用，同时由于空间环境影响，卫星受到干扰力矩Md的作用。由动量矩定理得：dLdL1二-一1McMdtdt在外力矩作用下，星体角动量变化是上式的积分ttL(t)=L(0)+Li(0)Li(t)+1ML10Md(12)而飞轮控制力矩由内控制力矩和摩擦力矩组成dLi力矩万程为=L+Tf(1-3)dt1飞轮作用的力矩并不改变星体系统的总的角动量，仅重新分配了两者间的角动量。1.4飞轮控制系统分类在三轴姿态控制系统设计中，根

5、据系统在标称状态下整星在角动量是否为零，可以将飞轮控制系统分为零动量系统和偏置动量系统，对姿态稳定度要求高的卫星如遥感卫星，采用零动量系统的比较多，而在对指向精度要求比较高的地球静止轨道卫星中，偏置动量系统用的比较多。在这里，我们主要考虑零动量飞轮控制系统设计。二：零动量飞轮三轴姿态控制系统数学模型5.1 卫星中飞轮安装结构飞轮安装结构划分为三种，即正交型，俯仰轴安装反作用轮和斜装型。每种安装形式的飞轮在应用时一般首先考虑系统的可靠性，要求飞轮有合理的布局，合理的布局不但可以提高系统的可靠性，而且可以减轻质量，节省能量，提高飞轮的角动量存储能力。提高飞轮系统的可靠性的一个重要途径是给飞轮系统一

6、定的备份，即要求系统有一定的冗余度。本文中采用的安装构型为：四个反作用飞轮相对三轴等倾角安装。与星体坐标系O-XbYbZb的三个轴互相平行，第四个反作用飞轮相对于三个轴等倾角安装，安装角为a=54.71正常工作状态下为三个正交的反作用轮工作，斜装轮为备份轮。飞轮安装方式如图5.2 飞轮控制数学模型采用飞轮控制卫星的三轴姿态时，可以分为三个通道进行控制，俯仰通道，偏航通道和滚转通道，由于在控制一个通道使得卫星姿态发生变化的过程中，卫星的其他通道会存在严重的耦合，但是，在姿态稳定期间，卫星姿态角变化很小的情况下，我们可以把通道之间的耦合除去，这样，对系统的分析影响并不是很大。设卫星在轨时原始的姿态

7、角为：俯仰角为中，偏航角为中，滚转角为6,由于卫星在空间运动时，受到控制干扰力矩的作用，使得卫星的姿态发生了变化，其期望的俯仰角为中1,期望的偏航角为中1,期望的滚转角为3,为了实现姿态角的变化，可以先控制俯仰角的变化，再控制偏航角的变化，为了简化控制系统设计，同时减弱系统中各个通道之间的相互耦合作用，可以每次控制使用一个轴上的飞轮进行卫星的姿态角的控制，由与控制中三个角度之间有一定的约束关系，可以通过俯仰通道和偏航通道的控制大致实现卫星滚转角度的控制，由于存在一定的误差，可以在实现俯仰角和偏航角的控制之后，对卫星的滚转角控制，这样通过三次不同通道的控制，能够实现卫星姿态稳定和机动的低精度控制

8、。下面以卫星俯仰通道角度控制为例。俯仰通道数学模型Step2:建立各个控制模块的传递函数。.角度转换放大模块：功能：将系统所需要实现的角度变化信号转化为放大的能实现电机驱动的电信号。传递函数邛(s)-Ki*U(S).伺服电动机模块：功能：给电动机一个电压信号,通过电动机输出一个转矩驱动飞轮转动，表现为飞轮角度的变化。传递函数模型:U(S)Kms(Tms1)m(s)3飞轮与星体动量交换模块功能：将电动机作用于飞轮上的力矩，使得飞轮的角动量发生变化，由于系统的总动量保持不变，这样，就能将飞轮的角动量传递到星体的角动量的变化，从而使得星体的俯仰角发生变化。实现系统设计输入时的姿态角。传递函数：不考虑

9、卫星各个通道之间的相互耦合作用，飞轮控制动力学方程可以简化为dtfMCxMdx(21)这是一个非线性环节，要进行线性化，由于喷气或磁控系统的控制力相对于飞轮控制系统很小，而且由于空间干扰力矩的存在，在飞轮正常情况下，飞轮速度未达到速度饱和时，我们可以将第二控制力矩和空间干扰力矩看成近似抵消，不考虑系统设计过程中传递函数的增益符号，这样飞轮动量交换系统的传递函数可以简化为。日m(S)-K=Jl(S)一gI4测速电动机和比例环节上将卫星星体俯仰角输出角度信号反馈到伺服电动机输入信号上。外加一个比例环节，可以进行反馈的强弱调节。传递函数模型："一KtS”Um5传感器模块功能：将控制器输出的

10、角度信号测量出来和系统输入的期望角度信号作比较，形成误差信号，通过转换和放大驱动电动机带动飞轮转动，再通过动量交换装置使得卫星俯仰角实现预定规律。传递函数*1(S)-*K=1*m(S)rxm1Step3:俯仰角控制系统数学模型Step4:控制系统参数设置伺服电动机参数电动机传递系数20.1s1.1se(S)=2，在实验中取0.1s1.1s10Km二10电动机时间常数品=Jm/(*+Cw)在试验中取，=0.1角度信号放大器的倍数一般在10到1000之间，在实验中取:K1=100测速发动机的传递函数系数取：Kt=1飞轮动量交换机构的传递系数：2_2K°=J/Ix=mr/MXRXgxxx近

11、似的取：Kg=g100所以控制系统的方框图可以化简为：G0(s)一0.1s1,1s100.1s21.1s1020.1s1.1s一20.1s1.1s1010控制系统的开环传递函数为：闭环传递函数为：i(s)系统的误差传递函数为：:'e(s)三：Matab分析和验证3.1时域分析法n1=10;d1=0,11.110;s1=tf(n1,d1);step(s1)使用simulink控制系统仿真建立的方框图如图3.1040.2000.20.40.60.8Tkrne(ssej11.2G6o,O.寻聂与113-1系统的超调量为：-%=100%=13%1系统的稳态误差2%调节时间为：ts=0.8控制系

12、统的稳定性分析控制系统的闭环特征方程为：D(S)=0.1S21.1S10建立系统的劳斯表为：一2一，一S0.110一1.S1.1一0一S10由于劳斯表的第一列元素全为正数，所以控制系统是稳定的。3.13系统稳态性能计算10由于系统的开环传递函数为：GKs)=s(0.1s1.1)系统为I型系统，控制系统对位置信号的稳态误差为零，对速度输入信号存在稳态误差，但是系统无法跟踪上加速度输入信号，对其稳态误差为五穷大。ess0=0ves1s=9.9esm二二3.2控制系统频域分析3.21编程画出系统的波特图n1=10;d1=0.11.10;s1=tf(n1,d1);margin(s1);GM,pm,wc

13、p,wcg=margin(s1)系统的波特图如图3.3-WO-90BodeDiagramGm=InfdB网Inir&d/sec)hPm=55,7deg(at7.51rad/sec)500*50180-1IQ110101010210*FrequencygWsec)由波特图求得系统性能指标:幅值裕度GM=Inf穿越频率wcp=Inf相角裕度pm=55.6831截止频率wcg=7.50853.23作出系统奈氏图和稳定性分析系统的奈奎斯特图如图3.4n1=10;d1=0.11.10;s1=tf(n1,d1);nyquist(s1)nyqusit(s1,w);由奈奎斯特图知，因为奈奎斯特曲线不包

14、含(-1J0)点，且系统开环稳定，系统右半平面开环极点p=0,所以系统是稳定的。3.3根轨迹分析系统参数对系统的影响。3.31放大器的倍数aK,系统的闭环传递函数为：，(s)=-1S11SK1.1其等价根轨迹方程为：1Ki-=0S11SG=zpk(,0,-11,1);rlocus(G)RootILQCK瓷A<su_£icE_1111-System.GGain:18.7Pole:-8.9Oamping：1Overshoot(%);0Frequency(raditeec):B.jSystemGam：21Pole:DampirtgOverslxiFrequer(G21a(%sci/s

15、ec>2.5G白ri：329Pole;-5.5-1.63iDamping:0J859Overshocrt(%)：0X)025Frequency(racVsec):5.741I1111IRealAxis由系统的根轨迹图知，只要Ki>0系统都是稳定的。当信号转换与放大器的放大倍数七=61.73时，系统获得最佳阻尼比。3.32.动量交换结构传递系数Kg系统的闭环传递函数为：1000Kg中(s):20.1S(110Ka)S1000Kagg其等价根轨迹方程为：10s10001Kg2二00.1SSRacrt:Locus505000O20O52.O30.oooooooooO口-308642246

16、8O-1-«-1由上面的根轨迹图得出：当系统的动量传递系数为&=100时，系统的阻尼比为匚=0.551,当Kg=179时，系统的阻尼比为0.707,此时，系统的阻尼性最好，动态性能最好，系统的超调量为6%=4.3%四：控制系统校正设计为了增加系统容噪声的能力，在角度信号转换放大器的后面需要增加一个滤波器，同时，因为电机控制时存在一系列的干扰信号，如负载转矩变化，电压变化等，故实际的俯仰角控制系统的方框图图4.1修正卫星俯仰角控制方框图系统滤波器的电路实现:Ui(t)=RCdUo(t)dtUo(t)Ui(s)=Uo(s)RCsUo(s)UGo(s)Uo(s)1Ui(s)RCs1

17、取R=1M,C=0.1uf,则传递函数为：Go(s)=10.1s1画出加滤波器的系统的奈氏图与Bode图$上IIImmmmlllliilllmmmmJullllilmm!l!'!求得其频域性能指标为：幅值裕度GM=7.4dB相角裕度pm=26.0845穿越频率wcp=10.4881截止频率wcg=6.5397系统是稳定的，但是系统的幅值裕度和相角裕度都比较小，所以要进行校正网络设计，使用串联校正能满足指标要求.校正网络设计因为一般导弹系统要求幅值裕度6dB,相角裕度40。以上，所以可以使用串联超前校正实现。超前校正网络传递函数设为:Gc(s)=aTs1Ts1用Matlab编程求得超前网

18、络的参数为:theta=(50-26+5)/180*pi);a=(1+sin(theta)/(1-sin(theta);b=1/sqrt(a);f='1000/(w*(sqrt(wA2+121)*(sqrt(wA2+100)-0.59'w=solve(f,'w');T=1./(sqrt(a).*w)s=zpk(-1/(a*T),0,-11,-10,-1/T,1000*a)margin(s)GM,pm,wcp,wcg=margin(s)求得:a=3.5T=0.52校正后系统的频率响应为BodeCiisgrafTiFrequenGy(r-ad/sec)mp)卷1受(君)菖£校正后系统的频率指标为：幅值裕度GM=9.98dB相角裕度pm=41.8,系统满足设计要求。校正系统的时域响应s2=tf(s)s3=feedback(s2,1)step(s3)由时域响应图知系统的时域响应比较好，系统超调不多且很快的进入稳定状态，控制系统设计已大致满足系统性能要求。五：研究进展,按扰动补偿的复合校正考虑到干扰信号对控制系统控制精度的影响，要进行控制系统的复合校正，在控制系统中加入一个前馈装置，使得干扰信号对控制系统的姿态角输出影响为零。即设计校正网络Gn(s),使得Gn(S)=0。.设计偏航角和滚