航天器姿态动力学与控制大作业任务(2A)根据伪速率控制器的喷气姿态控制系统的仿真与分析

基于伪速率控制器的喷气姿态控制系统的仿真与分析—航天器姿态动力学与控制大作业（2A）

一、任务描述

目的：设计基于伪速率控制器的喷气姿态控制系统并进行仿真与分析

基本内容：

(1)建立三轴稳定对地定向航天器的姿态动力学和姿态运动学模型；

(2)设计基于伪速率控制器的喷气姿态控制系统；

(3)完成数学仿真。

具体要求

(1)建立对地定向刚体航天器的三轴稳定姿态动力学和姿态运动学模型。

I x=1000kg·m2，I y=1500kg·m2，I z=1300kg·m2

I xy=−20kg·m2，I xz=30kg·m2，I yz=−10kg·m2

设航天器在圆轨道上运行，轨道角速度ω0=0.0011rad/s

要求姿态动力学动力学采用欧拉方程，姿态运动学模型采用zyx顺序欧拉角的姿态运动学方程；

(2)姿态推力器的数学模型为理想的继电器特性姿态推力器的标称推力为10N，在各轴上的力臂分别为1m、1.5m和2m。

(3)要求姿态角控制精度：优于0.5deg。

(4)不考虑姿态角速率的测量误差，试设计伪速率控制器，要求实现最小脉冲宽度(30ms)。给出数学仿真结果。绘出控制过程的相轨迹图，及性能指标(如极限环的速度等)，估算燃料消耗率。并体会姿态动力学模型的三轴耦合对控制过程是否有影响。

(5)设卫星在三轴方向受到常值的气动干扰力矩，分别为

T dx=−0.02Nm，T dy=−0.03Nm，T dz=0.04Nm

试设计伪速率喷气控制器，要求能实现最长周期的单边极限环。给出数学仿真结果。

绘出控制过程的相轨迹图，及性能指标(如极限环的速度等)，试估算此时的燃料消耗率。

二、喷气系统与推力器布局的选择

喷气姿态控制系统框图

典型的6+2斜装小推力配置的推力器布局图

三、建模原理

2.1 姿态动力学方程

考虑在圆轨道上飞行的对地定向航天器，姿态角和姿态角速率较小，惯量积远小于主惯量，简化后的三轴耦合的姿态动力学方程如下

I xφ+(I y−I z−I x)ω0ψ+(I y−I z)ω02φ=T jx+T dx

I yθ=T jy+T dy

I zψ−(I y−I z−I x)ω0φ+(I y−I x)ω02ψ=T jz+T dz

又考虑到轨道角速度较小，且推力器产生的推力器控制矩较大的情况下，忽略发动机偏心产生的干扰力，不考虑三轴耦合，简化的姿态动力学方程如下

I xφ=T jx+T dx

I yθ=T jy+T dy

I zψ=T jz+T dz

其中T jx，T jy，T jz为推力器产生的控制力矩在星体三轴上的分量，T dx，T dy，T dz为卫星在三轴方向受到常值的气动干扰力矩。

2.2 姿态运动学模型

采用zyx旋转，考虑到航天器在圆轨道上运行，姿态角与姿态角速率都较小的情况，简化后的姿态运动学模型如下

ω=[φθ

ψ]−[

ψ

1

−φ

]ω0

2.3理想继电器特性

理想的继电器喷气控制系统具有理想的开关特性，控制方程为：

u={1e>0

−1e<0

2.4 最长周期单边极限环

在进行极限环设计时，为了达到最长时间的单边极限环，需要不断地调整喷气时间。最长周期单边极限环如下图中曲线所示

单边极限环

2.5 伪速率增量反馈控制器原理

伪速率控制器是一种脉宽调制器，其输出脉冲的宽度和相邻脉冲的时间间隔随输入信号（姿态角）而变化。由于其数学模型可以近似用线性关系表示，因此是一种准线性喷气控制器。采用伪速率控制器的喷气姿态控制系统控制框图如下图所示。

采用伪速率控制器的单轴喷气姿态控制系统框图

斯密特触发器的数学描述：

u ={

+1e >θD +1

e >(1−ℎ)θD ,ė<00−θD 0−1

e <−(1−ℎ)θD ,ė>0−1e ≤−θD

四、 无干扰力矩的单通道控制系统仿真与分析

4.1 控制参数

由T on =

ℎθD K F −ℎ

2

θD

T F 选取各通道参数，再由θR ≈

αi0ℎθD T F

2K F

（i 可取x ，y ，z 以表示不同通道）估算极限环速

度，其中αi0=|T i0|I i

，经过调试获取控制参数

4.2单通道系统模型

三轴单通道系统模型如下，仅控制力矩有所不同

俯仰通道控制力矩T jy =15Nm 时的控制系统模型图

4.3仿真结果

初始角度偏差设为0.8deg =0.01396 运行周期为500s

4.3.1滚转通道控制力矩T jx =10Nm

相轨迹图如下，可以观察到，相轨迹最后收敛到一个较小的极限环。

角度偏差图如下，可以看出角度最终在−0.4~0.4deg之间变动，符合控制精度0.5deg的要求

角速度偏差图如下，可以看出角速度最终在−0.015~0.0098deg∙s−1之间变动

4.3.2俯仰通道控制力矩T jy=15Nm

相轨迹图如下，相轨迹图如下，可以观察到，相轨迹最后收敛到一个较小的极限环。

角度偏差图如下，可以看出角度最终在−0.4~0.4deg之间变动，符合控制精度0.5deg的要求

角速度偏差图，可以看出角速度最终在−0.0197~0.0168deg∙s−1之间变动

4.3.3偏航通道控制力矩T jz=20Nm

相轨迹图如下，可以观察到，相轨迹最后收敛到一个较小的极限环。