一种重力梯度小卫星实时姿态控制方法研究

1、一种重力梯度小卫星实时姿态控制方法研究韩建斌 王新升（北京航空航天大学宇航学院 北京 100083）摘要：重力梯度卫星是一种利用重力梯度力矩来实现对地定向的卫星。其在达到重力梯度稳定之前还需要消旋、重力梯度捕获等过程，需要一定的主动控制。本文针对重力梯度小卫星的动力学特性在卫星本体坐标系下建立了数学模型。考虑到小卫星的质量和功耗限制，选取了功耗、质量较小的磁力矩器作为控制手段。依据当地的地磁场强度调整磁力矩器磁矩大小，从而产生相应的磁力矩对卫星进行主动控制。依此方法在Matlab/Simulink中建立模型进行仿真运算。在对仿真结果进行分析的基础上加入星载计算机实物进行半物理实时仿真。仿真结果

2、表明，这种控制方法可以满足重力梯度小卫星所需的主动控制要求。关键字：飞行器控制，重力梯度，半物理仿真，磁力矩器中图分类号：V488.222 Real-time Attitude Control Method For Gravity Gradient Micro-satelliteHan Jianbin, Wang Xinsheng（School of Astronautics, Beihang University, Beijing 100083）Abstract: Gravity gradient micro-satellite is a kind of satellite which po

3、int to the earth with gravity gradient moment. Before the stability of gravity gradient, the micro-satellite needs active control to complete gravity gradient capturing and dumping of the angular velocity. Considering the dynamics of the gravity gradient micro-satellite, a mathematical model of the

4、micro-satellite in the body fixed frame has been made. The magnetic torque is chosen as the executor which has a small mass and needs low power. The magnetic torque is adjusted with the local geomagnetic intensity and the micro-satellite will obtain active control torque. According to the result of

5、mathematical simulation, the real-time on-board computer is used in the hardware-in-loop simulation. The result of semi-physical simulation shows the method is satisfied to the gravity gradient micro-satellite.Key words: control of spacecraft, gravity gradient, semi-physical simulation, magnetic tor

6、que收稿日期：2208-9-15基金项目：中国博士后基金资助(课题号20070410457)作者简介：韩建斌，北京航空航天大学宇航学院，博士研究生，E-mail：hangjianbin。王新升，北京航空航天大学宇航学院, 讲师/博士后,E-mail: xswang。0 引言重力梯度卫星是利用空间的重力梯度实现姿态稳定的一类卫星。在理想情况下，卫星仅利用重力梯度力矩即可以实现姿态稳定，但由于存在轨道天平动、太阳光压力矩、气动力矩、剩磁力矩等干扰因素，卫星对地指向有很大的误差，需要加一定的控制和阻尼才能使卫星的控制精度达到设计要求。本文在建立重力梯度卫星在轨姿态控制闭环的基础上，加入星载计算机实

7、物，进行实时仿真，以确定控制方案的可行性。并对仿真结果进行了分析，提出了改进的方法。1 卫星姿态控制系统数学模型如图1所示，卫星姿态控制系统包括卫星姿态动力学、运动学，控制模块，执行机构使用三轴磁力矩器，因此还包括地磁场模型及磁力矩器模型。控制系统直接从姿态运动学模块得到姿态信息。参考姿态地磁场模块磁力矩器模块干扰力矩姿态动力学、运动学姿态信息姿态敏感器图1姿态仿真系统结构Fig.1 The structure of attitude simulation system1.1 坐标系卫星的姿态计算需要涉及一定的坐标系，本模型所用坐标系为惯性坐标系、第二轨道坐标系和卫星本体坐标系。三个坐标系原点

8、均在卫星几何中心。其中惯性坐标系三个轴指向空间一个固定的方向（例如初始方向）不变；第二轨道坐标系z轴指向地心，x轴与z轴垂直，沿卫星速度方向，y轴方向按右手法则确定；卫星本体坐标系在初始状态下和第二轨道坐标系重合，在仿真开始后随卫星本体运动，即它是固连在卫星上的。图2本体坐标示意图Fig.2 The body fixed frame图3轨道坐标系示意图Fig.3 The orbit fixed frame1.2 重力梯度卫星姿态动力学为了不增加建模的复杂性，暂不考虑卫星的柔性，即认为卫星是一个刚体。所用卫星姿态动力学方程如下：（此方程以卫星本体坐标系为参考系，原点在卫星质心。为卫星绝对角速度在

9、卫星本体坐标系下的投影，下面的为其分量）。其中，进一步认为本体轴即为惯量主轴，这样，于是方程简化为： （1） （2）为磁滞棒产生的阻尼力矩，为重力梯度力矩，为其它干扰力矩。，为从地心指向卫星质心的矢量在卫星本体轴下的投影。 1.3 卫星姿态运动学方程考虑到卫星可能有较大的姿态变化，采用姿态四元数来描述卫星的姿态。（为卫星轨道角速度，为卫星相对于轨道坐标系的角速度在本体坐标系的投影，下面的为其分量）。（3）（4）1.4 卫星姿态数据解算数值积分在长时间下会有较大的误差，因此选择了下面的Euler法。（5）（6）对于，可以转化为这样，则，（力矩也是和卫星姿态有关的变量。）1.5 磁力矩器模型磁力矩

10、器是利用本身磁矩和地磁场的相互作用而产生作用于星体的力矩。忽略地磁场意外的其它外磁场，则T为： (7)为磁力矩器磁矩矢量，为地磁场磁通密度矢量（磁场强度）在建模时选用了空心磁力矩器作为建模对象，这主要也是为了简化模型。其磁矩大小：（8）A为线圈面积，N为线圈匝数，I为线圈电流。磁矩方向由磁力矩器安装方向决定。如果装三轴磁力矩器则其每个分量的大小由公式（8）决定。1.6 地磁场模型地球外部空间的地磁场产生的源域可分为地核场、地壳场和外源场。产生于地核的磁场约占地球总磁场的95%，成为地球的主磁场，而称地壳场和地核场的和为内源场，占地磁场的99%。外源场强度非常弱，在讨论地球外部空间磁场分布时，通

11、常将其忽略。内源场可以看作一个磁偶极子，可以用位势函数表示。地磁位势函数模型利用球谐函数将地球基本磁场位势函数展成级数形式。（9）其中：标准地球磁参考半径 (6371.2 km)：距地心的距离：经度：地理纬度：n次m阶的Schimidt准归一化的伴随多项式函数。：为描述地磁场模型的高斯系数，根据测量数据确定。由于地磁场在缓慢地变化，因此和是时间的函数，一般形式有：（10）和的系数一般是每五年定期更新，IGRF2005模型和WMM2005模型是目前国际上影响广泛的地磁位势函数模型，根据IGRF2005公布的2005年2010年的数据，前3阶的高斯系数见表1，WMM2005公布的2005年2010

12、年的数据，前3阶的高斯系数见表2，两种地磁位势函数模型的精度是相当的。根据地磁场位势函数，地磁场强度为（11） 其中，为地磁场强度在当地向上，向北和向东三个方向的投影分量。表1 IGRF2005模型高斯系数Table 1 The Gauss parameter of IGRF2005NM10-29556.80.08.80.011-1671.85080.010.8-21.320-2340.50.0-15.00.0213047.0-2594.9-6.9-23.3221656.9-516.7-1.0-14.0301335.70.0-0.30.031-2305.3-200.4-3.15.4321246

13、.8269.3-0.9-6.533674.4-524.5-6.8-2.0表2 WMM2005模型高斯系数Table 2 The Gauss parameter of WMM2005NM10-29556.80.08.00.011-1671.75079.810.6-20.920-2340.60.0-15.10.0213046.9-2594.7-7.8-23.2221657.0-516.7-0.8-14.6301335.40.00.40.031-2305.1-199.9-2.65.0321246.7269.3-1.2-7.033674.4-524.5-6.8-2.02 磁力矩器控制律设计磁力矩器在本

14、卫星控制中主要执行两个任务：卫星的初始消旋以及姿态校正。在本仿真中只对初始消旋进行验证。要能最终消除旋转动能，只要分别在三个正交轴上产生如下方法确定的磁矩。（9）卫星绕其质心转动动能T的时间变化率为： 此处为作用在卫星上的磁力矩，为卫星角速度矢量地磁场强度矢量在轨道平面内以（2倍轨道角速度）的角频率做周期性变化。由于，初步近似可认为，即 于是可以得到可见按确定的控制规律可以减少动能。3 数学仿真结果根据前面所述在Matlab/Simulink中搭建了整个姿态控制系统。卫星质量特性参数：。控制律参数：K=2。磁力矩器参数：选择A=0.005，N=100，I简化为与输入电压成正比，取R=50初始条

15、件设置：初始角速度：0.086rad/s（各轴角速度为0.05rad/s）；初始三个欧拉角均为0度；仿真时间：20000秒。图4卫星滚转角变化曲线（仿真时间20000秒）Fig.4 The changing of roll angle (simulation time: 20000s)图5卫星俯仰角变化曲线（仿真时间20000秒）Fig.5 The changing of pitch angle (simulation time: 20000s)图6卫星偏航角变化曲线（仿真时间20000秒）Fig.6 The changing of yaw angle (simulation time: 20

16、000s)图7卫星绕轴角速度变化曲线（仿真时间20000秒）Fig.7 The changing of the angle velocity circling x axis (simulation time: 20000s) 图8卫星绕轴角速度变化曲线（仿真时间20000秒）Fig.8 The changing of the angle velocity circling axis (simulation time: 20000s)图10卫星绕轴角速度变化曲线（仿真时间20000秒）Fig.10 The changing of the angle velocity circling axis

17、(simulation time: 20000s)图11控制力矩变化曲线（仿真时间20000秒）Fig.11 The changing of controlling moment (simulation time: 20000s)4 实时姿态控制仿真系统设计上述姿态控制系统仿真是在Matlab/Simulink下计算所得，为了检验在包含已有的硬件的系统运行的特性，下面引入半物理仿真系统：卫星姿态的计算数据由动力学仿真计算机程序得到，利用CAN卡将姿态数据传给星载计算机，星载计算机根据姿态数据得到控制量再通过CAN卡传给仿真程序，由此构成一个闭环。为了实现实时性，控制器控制周期设定为250毫秒。

18、整个实时姿态控制仿真系统设计如图12所示：其中仿真计算程序指卫星的姿态仿真，即第2节所描述的数学模型。星载计算机部分为实际的星载计算机。具体程序流程见图13.图12半物理仿真系统结构图Fig.12 Structure of the hardware-in-loop system图13姿态控制系统程序流程图Fig.13 the flow diagram of the attitude control program5 结论由重力梯度卫星姿态控制仿真结果可以看出，卫星在10000秒左右可以达到稳定，这主要从角速度变化曲线可以看出：绕x轴的角速度在10000秒左右开始在0上下振荡，而绕y、z轴的角速

19、度在很早就已接近于0。从欧拉角变化曲线上也可以得到几乎相同的结果。仿真结果表明，利用第二节所述的控制方法，卫星可以在有限的时间内达到平衡。卫星在消旋模式之后将进入对地定向模式。参考文献(References)1.肖业伦.航空航天器运动的建模飞行动力学的理论基础 M. 北京：北京航空航天大学出版社，2003.6：50-51，130-138.Xiao Yelun, Model of the air&spacecraft movementthe academic basic of flight dynamic M. Beijing: Press of Beihang University. 2003.6：50-51, 130-138.2.屠善澄.卫星姿态动力学与控制（1） M. 北京：中国宇航出版社，2005