毕业设计(论文)中期报告
题 目:基于飞轮摩擦观测器设计的卫星姿态控制方
法研究
专 业 飞行器设计与工程 学 生 学 号 指导教师 吴宝林 日 期 2015年3月13日
哈尔滨工业大学教务处制
1. 绪论
对于要求三轴稳定的小卫星姿态控制系统,当前主要有喷气、反作用飞轮和力矩陀螺三种控制方式。而其中,反作用飞轮由于具有不消耗推进剂、控制精度高、系统简单灵活可靠并且可以实现整星零动量等优点,而得到广泛的运用。但在转速较低时,由于摩擦力矩的存在,尤其是在转速过零时摩擦力的大小、方向均产生突变,导致反作用轮的输入信号和输出力矩间的线性关系被严重破坏,大大限制了该方案的实际应用。因此,如何改善反作用飞轮的低速摩擦性能成为了提高飞轮姿态控制精度的关键课题。
对比当前的国内外主要的诸如自适应、变结构、H∞等小卫星姿态控制系统,虽然在精度、稳定性和机动能力上都已达到了较佳的性能,但针对于反作用飞轮的低速摩擦补偿却研究不多,也尚未有较为有效可靠的方案。当前对于低速摩擦补偿,国内外学者主要提出了以下方式:(1)直接补偿:将摩擦力都视作库伦摩擦,并根据库伦摩擦力模型,在飞轮输入信号上叠加一个与转速同向的偏置信号,用以抵消摩擦力。这样虽然可以改善一部分飞轮性能,但由于模型的不精确而且所受摩擦力不全是库伦摩擦,导致在反作用飞轮转速过零时补偿效果减弱甚至失效;(2)变增益:在低速过零时提高飞轮转速的反馈增益,即提高了系统转速跟踪的精度,但过高的反馈增益会导致系统能耗增加而且削弱系统稳定性甚至产生极限环振荡现象;(3)高频线性化:当反作用轮转速低于某个阈值时,将高频正弦震颤信号叠加进输入信号中,使原本不连续的摩擦特性得到了较好的线性化,但此方法受限于附加的高频震颤信号和飞轮的摩擦频率特性。(4)变结构控制:将摩擦力在飞轮过零时的突变视作模型的不确定性,并假设不确定上界已知。这种方式虽然有效,但可能导致较大的震颤和控制量,故仍具有一定的保守型和改进空间。
2. 研究内容
本文对比了现有的摩擦补偿方案,决定设计摩擦补偿观测器,并采用变结构控制的方式,使系统按照预定“滑动模态”的状态轨迹运动,改善飞轮的低速摩擦性能。结合现有的知识技能,需要进一步研究的内容主要包括:
1) 反作用飞轮的低速摩擦与润滑机理和较准确的低速摩擦模型、收敛的飞轮摩擦补偿状态观测器设计及其应用;
2) 变结构控制的基础理论与应用以及包含摩擦补偿观测器的变结构姿态控制系统的设计;
3) 考虑摩擦的变结构姿态控制系统的Simulink仿真与结果评价及进一步减小控制量和震颤的优化方案,并在仿真中验证优化的效果。
3. 研究方案及进度安排
1) 查阅有关飞轮低速摩擦和润滑的相关文献或者进行实验测定数据,给出较为精确
的低速过零时的摩擦模型,并将其合理的连续化,再由现代控制理论得出观测器状态方程,并证明其收敛性。
2) 学习滑模变结构控制的相关理论,并研究将之运用于卫星姿态控制的方式。 3) 根据卫星姿态动力学模型,首先建立不失真实性的三通道姿态计控制系统(包含不确定的干扰因素),并在Simulink中搭建模块,进行计算机仿真以观察低速摩擦对姿态控制系统的影响。
4) 在已有基础上,以减小姿态误差和扰动为目标,设计基于状态观测器的变结构卫星姿态控制系统,并在同等条件下进行仿真,并与之前的仿真结果进行对比。 5) 结合工程实际方法,从多角度尝试对这种控制策略进行进一步优化,目前尚在论证中的方案是在低速时增加系统阻尼或采用极点连续变化的方式,以改善其震颤特性,并进行仿真验证。
4. 进度完成情况
5. 已完成的研究工作及成果
1)
卫星姿态动力学模型建模(含飞轮)
卫星的姿态动力学模型即卫星在内外力矩的共同作用下绕质心转动的规律,包括整星运动和星体各部分的相对运动。出于简化考虑,本文采用单刚体假设,即不考虑星体挠性和液体晃动对姿态运动的影响,将卫星视作简单刚体进行计算。
卫星通常由星体和转子组成,以卫星质心O为原点,并以某需要的特征方向为坐标轴建立卫星本体坐标系Oxyz。Is为卫星本体(不含飞轮)在Oxyz系内的转动惯量,IR为飞轮转动惯量。转动角速度ω在本体系中的分量依次为ωx、ωy、ωz,则可记作ω=(ωx,ωy,ωz),飞轮相对于主体的角速度记作Ω=(Ω1,Ω2,Ω3),则克得到卫星相对其质心O的动量矩:
T
H=ISωIRΩ
(1) (2) (3)
设卫星受环境干扰力矩Te,则由动量矩定理有:
HωHTe
ISωIRω(ISωIRΩ)Te
代公式(2)入公式(1),可得方程:
0
其中,z
y
z0
y
x 为角速度的叉乘矩阵,IRω为飞轮对本体的实际
0
x
输出力矩,记作Tu故得到卫星姿态动力学方程:
1
ωI(IωIRΩTuTe) sS
(4) (5)
同理,对于飞轮,其动力学方程为:
IRΩTuTCTf
其中TC为根据控制方程求出的应有控制力矩,Tf为摩擦力矩,主要包括轴承固体间摩擦力矩和润滑剂的粘滞摩擦力矩。
对于卫星姿态运动的描述,考虑到避免奇异,采用姿态四元数q描述卫星姿态。 以四元数形式表示的卫星姿态运动学方程:
T
q1
ω q
2q0I33q
(6)
q0
qq
01
其中:q 为卫星姿态四元数;
q2qq3
2)
摩擦模型建立及状态观测器设计
反作用飞轮在轴承的支撑下转动,不仅仅受到电机的驱动力矩,也受到轴承的摩擦力矩,二者合力矩才是飞轮的和外力矩,即姿态控制系统真正的控制力矩:
TrTc-Tf
(7)
其中,Tr为卫星实际控制力矩,Tc为根据控制律得出的应受控制力矩,Tf主要包括轴承固体间摩擦力矩、库伦摩擦力矩和润滑剂的粘滞摩擦力矩,粘性摩擦力矩与转速成正比,比例系数为Kv,而固体摩擦则参考Dahl于1968年提出的固体间摩擦模型,即Dahl模型。该模型与实际摩擦情况较为相似,已被广泛应用,而库伦摩擦则可视作定值。
Dahl模型如下:
Ω
TS0 时:TfKvΩTsignΩ k2
Ω1Ωs
Tc>TmTm
Ω0 时:Tf=Tc-Tm-Tm
-TTc
(8)
(9)
(8)式中Kv为粘性摩擦力矩系数,Tm为最大静摩擦力矩,Tc为电机驱动力矩,Tk为库
伦摩擦力矩,Ts为Stribeck摩擦力矩,Ωs为Stribeck摩擦特征速率。工程中常常取一个极小的正常数α,定义:停滞区为Ωα。
由于粘性部分的建模较为简单,故通常将其与线性系统模型合为一部分,则其余部分为:
TSTSΩ
TfnTfKvΩTksignΩTtanh22k
1ΩΩ11ΩΩss此处为便于计算,将sign函数用tanh函数代替,其中0
(10)
ΩJ1(TcKvΩTf)
TSΩJ1TcKvΩTktanh2
1Ω1Ωs
ΩJ1(TfDΩTc) 2
TΩ(Tsign(Ω)T)fff0ΩJ1DJ1Ωo(x) 2
0Tf0TfTf
(11)
相应的状态方程为:
(12)
可以得出Ω=0,Tf=0是该式的一个稳定平衡点,在平衡点将方程展开,可得:
(13)
这里,x=[Ω,Tf]T,o(x)表示高阶小量。在这里可以根据上式的线性部分判断系统稳定性:在Ω=Tf=0点系统是稳定的,即低速摩擦有令飞轮趋于停止的特点。
将(13)上式进一步线性化,即可得到线性系统:
ΩJ1TfDΩTc
0Tf
1ˆˆˆΩˆJTfDΩTck1ΩΩ
ˆTˆk1ΩΩf
(14)
考虑到系统中Ω可以直接测量,故设计状态观测器:
(15)
其中k1与k2分别为观测器增益,调节增益可实现对线性系统的状态观测,且经证明此观测器同样可以实现对非线性系统的状态观测。
3) 基于误差四元数的PD控制系统设计
a) 为观察摩擦对于飞轮姿态控制系统的影响,并进一步熟悉姿态控制系统设计,设计了基于误差四元数和加速度误差的姿态控制系统,系统框图如下
图1
进行控制律设计必须先明确误差信号的表示形式,出于避免奇异的考虑,本文选用姿态四元数表征卫星姿态,而姿态误差则有误差四元数表示,其计算方法为:
数的共轭,四元数乘法计算:
qaqbqa0qb0qa.qb,qaqbqa0qbqb0qa
qeqa*qd
(16)
其中qe为误差四元数,qa为实际姿态四元数,qd为目标姿态四元数。q*为四元
(17)
以四元数形式表示的卫星姿态运动学方程:
Tq1
ω q
2q0I33q
(18)
系统采用经典的PD控制,即以误差四元数和误差角速度作为控制器的输入量,控制方程为:
Tu=dIsωdIsωddIRΩKpqeKdωe
(19)
其中dIsωdIsωddIRΩ为考虑姿态跟踪的前馈量。且可以证明该控制律
可以实现系统的渐进稳定性。
4) 控制系统的matlab实现与仿真
matlab仿真程序设计
以yf=[qe1,qe2,qe3,ω1,ω2,ω3,Ω1,Ω2,Ω3]为每一步积分的初值,其中
qe1,qe2,qe3为上一控制周期末的姿态与期望姿态间误差四元数的矢量部分,ω1,ω2,ω3为角速度误差,Ω1,Ω2,Ω3为飞轮转速,根据系统动力学与运动学模型:
1
ωI
s(ISωIRΩTuTf)
Tq1
ω q
2q0I33q1ΩIR(TuTf)
(20)
建立oed45积分函数。每一个控制周期内控制力矩不变且与上一周期末的姿态误差、姿态角速度相关,积分迭代后即可得出卫星在仿真时间内的姿态运动情况。
仿真结果
参考“实验三号”小卫星的有关数据,设置: 控制周期为t=250ms 仿真时间设ts=22000s 迭代步数n=88000步
12.490.670.06
kgm2 0.6713.850.06星体转动惯量矩阵:IS
0.060.0615.75000.0023
kgm2 00.00230飞轮转动惯量矩阵:IR
00.00230
轨道角速度00.001rad/s
初始姿态:qi0.70710.30.40.5
星体初始角速度ωi0.010.0050.0033rad/s 飞轮初始角速度Ωri000rad/s 控制系统增益:Kp3 ,Kd18 粘性摩擦系数:Kv6.4105Nms/rad 库伦摩擦力矩:Tk2.5104Nm Stribeck摩擦力矩:Ts2.5104Nm Stribeck摩擦特征速率常数:S2.5rad/s
有摩擦时的姿态误差: 仿真曲线及数据:
TT
图2
θ轴:
图3
图4
无摩擦时的姿态误差
Ψ轴:
图5
θ轴:
图6
φ轴:
图7
由仿真结果可见,无摩擦力矩作用时,卫星姿态稳态误差小于0.008deg,而加入摩
擦力矩后姿态误差最大达到1.00deg。因此,必须在飞轮的低速区内设法补偿摩擦力矩,尤其是静摩擦力矩,以提高姿态控制性能。
6. 后期拟完成的研究工作及进度安排
依照原计划,如表格所示:
7. 存在的问题与困难
对于滑模变结构控制的理论及运用了解不够,需继续学习 对于状态观测器在matlab中的实现及在变结构控制系统中的运用 缺乏更多控制系统性能评价手段,对系统的性能评价不够全面
8. 论文按时完成的可能性
可按时完成
毕业设计(论文)中期报告
题 目:基于飞轮摩擦观测器设计的卫星姿态控制方
法研究
专 业 飞行器设计与工程 学 生 学 号 指导教师 吴宝林 日 期 2015年3月13日
哈尔滨工业大学教务处制
1. 绪论
对于要求三轴稳定的小卫星姿态控制系统,当前主要有喷气、反作用飞轮和力矩陀螺三种控制方式。而其中,反作用飞轮由于具有不消耗推进剂、控制精度高、系统简单灵活可靠并且可以实现整星零动量等优点,而得到广泛的运用。但在转速较低时,由于摩擦力矩的存在,尤其是在转速过零时摩擦力的大小、方向均产生突变,导致反作用轮的输入信号和输出力矩间的线性关系被严重破坏,大大限制了该方案的实际应用。因此,如何改善反作用飞轮的低速摩擦性能成为了提高飞轮姿态控制精度的关键课题。
对比当前的国内外主要的诸如自适应、变结构、H∞等小卫星姿态控制系统,虽然在精度、稳定性和机动能力上都已达到了较佳的性能,但针对于反作用飞轮的低速摩擦补偿却研究不多,也尚未有较为有效可靠的方案。当前对于低速摩擦补偿,国内外学者主要提出了以下方式:(1)直接补偿:将摩擦力都视作库伦摩擦,并根据库伦摩擦力模型,在飞轮输入信号上叠加一个与转速同向的偏置信号,用以抵消摩擦力。这样虽然可以改善一部分飞轮性能,但由于模型的不精确而且所受摩擦力不全是库伦摩擦,导致在反作用飞轮转速过零时补偿效果减弱甚至失效;(2)变增益:在低速过零时提高飞轮转速的反馈增益,即提高了系统转速跟踪的精度,但过高的反馈增益会导致系统能耗增加而且削弱系统稳定性甚至产生极限环振荡现象;(3)高频线性化:当反作用轮转速低于某个阈值时,将高频正弦震颤信号叠加进输入信号中,使原本不连续的摩擦特性得到了较好的线性化,但此方法受限于附加的高频震颤信号和飞轮的摩擦频率特性。(4)变结构控制:将摩擦力在飞轮过零时的突变视作模型的不确定性,并假设不确定上界已知。这种方式虽然有效,但可能导致较大的震颤和控制量,故仍具有一定的保守型和改进空间。
2. 研究内容
本文对比了现有的摩擦补偿方案,决定设计摩擦补偿观测器,并采用变结构控制的方式,使系统按照预定“滑动模态”的状态轨迹运动,改善飞轮的低速摩擦性能。结合现有的知识技能,需要进一步研究的内容主要包括:
1) 反作用飞轮的低速摩擦与润滑机理和较准确的低速摩擦模型、收敛的飞轮摩擦补偿状态观测器设计及其应用;
2) 变结构控制的基础理论与应用以及包含摩擦补偿观测器的变结构姿态控制系统的设计;
3) 考虑摩擦的变结构姿态控制系统的Simulink仿真与结果评价及进一步减小控制量和震颤的优化方案,并在仿真中验证优化的效果。
3. 研究方案及进度安排
1) 查阅有关飞轮低速摩擦和润滑的相关文献或者进行实验测定数据,给出较为精确
的低速过零时的摩擦模型,并将其合理的连续化,再由现代控制理论得出观测器状态方程,并证明其收敛性。
2) 学习滑模变结构控制的相关理论,并研究将之运用于卫星姿态控制的方式。 3) 根据卫星姿态动力学模型,首先建立不失真实性的三通道姿态计控制系统(包含不确定的干扰因素),并在Simulink中搭建模块,进行计算机仿真以观察低速摩擦对姿态控制系统的影响。
4) 在已有基础上,以减小姿态误差和扰动为目标,设计基于状态观测器的变结构卫星姿态控制系统,并在同等条件下进行仿真,并与之前的仿真结果进行对比。 5) 结合工程实际方法,从多角度尝试对这种控制策略进行进一步优化,目前尚在论证中的方案是在低速时增加系统阻尼或采用极点连续变化的方式,以改善其震颤特性,并进行仿真验证。
4. 进度完成情况
5. 已完成的研究工作及成果
1)
卫星姿态动力学模型建模(含飞轮)
卫星的姿态动力学模型即卫星在内外力矩的共同作用下绕质心转动的规律,包括整星运动和星体各部分的相对运动。出于简化考虑,本文采用单刚体假设,即不考虑星体挠性和液体晃动对姿态运动的影响,将卫星视作简单刚体进行计算。
卫星通常由星体和转子组成,以卫星质心O为原点,并以某需要的特征方向为坐标轴建立卫星本体坐标系Oxyz。Is为卫星本体(不含飞轮)在Oxyz系内的转动惯量,IR为飞轮转动惯量。转动角速度ω在本体系中的分量依次为ωx、ωy、ωz,则可记作ω=(ωx,ωy,ωz),飞轮相对于主体的角速度记作Ω=(Ω1,Ω2,Ω3),则克得到卫星相对其质心O的动量矩:
T
H=ISωIRΩ
(1) (2) (3)
设卫星受环境干扰力矩Te,则由动量矩定理有:
HωHTe
ISωIRω(ISωIRΩ)Te
代公式(2)入公式(1),可得方程:
0
其中,z
y
z0
y
x 为角速度的叉乘矩阵,IRω为飞轮对本体的实际
0
x
输出力矩,记作Tu故得到卫星姿态动力学方程:
1
ωI(IωIRΩTuTe) sS
(4) (5)
同理,对于飞轮,其动力学方程为:
IRΩTuTCTf
其中TC为根据控制方程求出的应有控制力矩,Tf为摩擦力矩,主要包括轴承固体间摩擦力矩和润滑剂的粘滞摩擦力矩。
对于卫星姿态运动的描述,考虑到避免奇异,采用姿态四元数q描述卫星姿态。 以四元数形式表示的卫星姿态运动学方程:
T
q1
ω q
2q0I33q
(6)
q0
qq
01
其中:q 为卫星姿态四元数;
q2qq3
2)
摩擦模型建立及状态观测器设计
反作用飞轮在轴承的支撑下转动,不仅仅受到电机的驱动力矩,也受到轴承的摩擦力矩,二者合力矩才是飞轮的和外力矩,即姿态控制系统真正的控制力矩:
TrTc-Tf
(7)
其中,Tr为卫星实际控制力矩,Tc为根据控制律得出的应受控制力矩,Tf主要包括轴承固体间摩擦力矩、库伦摩擦力矩和润滑剂的粘滞摩擦力矩,粘性摩擦力矩与转速成正比,比例系数为Kv,而固体摩擦则参考Dahl于1968年提出的固体间摩擦模型,即Dahl模型。该模型与实际摩擦情况较为相似,已被广泛应用,而库伦摩擦则可视作定值。
Dahl模型如下:
Ω
TS0 时:TfKvΩTsignΩ k2
Ω1Ωs
Tc>TmTm
Ω0 时:Tf=Tc-Tm-Tm
-TTc
(8)
(9)
(8)式中Kv为粘性摩擦力矩系数,Tm为最大静摩擦力矩,Tc为电机驱动力矩,Tk为库
伦摩擦力矩,Ts为Stribeck摩擦力矩,Ωs为Stribeck摩擦特征速率。工程中常常取一个极小的正常数α,定义:停滞区为Ωα。
由于粘性部分的建模较为简单,故通常将其与线性系统模型合为一部分,则其余部分为:
TSTSΩ
TfnTfKvΩTksignΩTtanh22k
1ΩΩ11ΩΩss此处为便于计算,将sign函数用tanh函数代替,其中0
(10)
ΩJ1(TcKvΩTf)
TSΩJ1TcKvΩTktanh2
1Ω1Ωs
ΩJ1(TfDΩTc) 2
TΩ(Tsign(Ω)T)fff0ΩJ1DJ1Ωo(x) 2
0Tf0TfTf
(11)
相应的状态方程为:
(12)
可以得出Ω=0,Tf=0是该式的一个稳定平衡点,在平衡点将方程展开,可得:
(13)
这里,x=[Ω,Tf]T,o(x)表示高阶小量。在这里可以根据上式的线性部分判断系统稳定性:在Ω=Tf=0点系统是稳定的,即低速摩擦有令飞轮趋于停止的特点。
将(13)上式进一步线性化,即可得到线性系统:
ΩJ1TfDΩTc
0Tf
1ˆˆˆΩˆJTfDΩTck1ΩΩ
ˆTˆk1ΩΩf
(14)
考虑到系统中Ω可以直接测量,故设计状态观测器:
(15)
其中k1与k2分别为观测器增益,调节增益可实现对线性系统的状态观测,且经证明此观测器同样可以实现对非线性系统的状态观测。
3) 基于误差四元数的PD控制系统设计
a) 为观察摩擦对于飞轮姿态控制系统的影响,并进一步熟悉姿态控制系统设计,设计了基于误差四元数和加速度误差的姿态控制系统,系统框图如下
图1
进行控制律设计必须先明确误差信号的表示形式,出于避免奇异的考虑,本文选用姿态四元数表征卫星姿态,而姿态误差则有误差四元数表示,其计算方法为:
数的共轭,四元数乘法计算:
qaqbqa0qb0qa.qb,qaqbqa0qbqb0qa
qeqa*qd
(16)
其中qe为误差四元数,qa为实际姿态四元数,qd为目标姿态四元数。q*为四元
(17)
以四元数形式表示的卫星姿态运动学方程:
Tq1
ω q
2q0I33q
(18)
系统采用经典的PD控制,即以误差四元数和误差角速度作为控制器的输入量,控制方程为:
Tu=dIsωdIsωddIRΩKpqeKdωe
(19)
其中dIsωdIsωddIRΩ为考虑姿态跟踪的前馈量。且可以证明该控制律
可以实现系统的渐进稳定性。
4) 控制系统的matlab实现与仿真
matlab仿真程序设计
以yf=[qe1,qe2,qe3,ω1,ω2,ω3,Ω1,Ω2,Ω3]为每一步积分的初值,其中
qe1,qe2,qe3为上一控制周期末的姿态与期望姿态间误差四元数的矢量部分,ω1,ω2,ω3为角速度误差,Ω1,Ω2,Ω3为飞轮转速,根据系统动力学与运动学模型:
1
ωI
s(ISωIRΩTuTf)
Tq1
ω q
2q0I33q1ΩIR(TuTf)
(20)
建立oed45积分函数。每一个控制周期内控制力矩不变且与上一周期末的姿态误差、姿态角速度相关,积分迭代后即可得出卫星在仿真时间内的姿态运动情况。
仿真结果
参考“实验三号”小卫星的有关数据,设置: 控制周期为t=250ms 仿真时间设ts=22000s 迭代步数n=88000步
12.490.670.06
kgm2 0.6713.850.06星体转动惯量矩阵:IS
0.060.0615.75000.0023
kgm2 00.00230飞轮转动惯量矩阵:IR
00.00230
轨道角速度00.001rad/s
初始姿态:qi0.70710.30.40.5
星体初始角速度ωi0.010.0050.0033rad/s 飞轮初始角速度Ωri000rad/s 控制系统增益:Kp3 ,Kd18 粘性摩擦系数:Kv6.4105Nms/rad 库伦摩擦力矩:Tk2.5104Nm Stribeck摩擦力矩:Ts2.5104Nm Stribeck摩擦特征速率常数:S2.5rad/s
有摩擦时的姿态误差: 仿真曲线及数据:
TT
图2
θ轴:
图3
图4
无摩擦时的姿态误差
Ψ轴:
图5
θ轴:
图6
φ轴:
图7
由仿真结果可见,无摩擦力矩作用时,卫星姿态稳态误差小于0.008deg,而加入摩
擦力矩后姿态误差最大达到1.00deg。因此,必须在飞轮的低速区内设法补偿摩擦力矩,尤其是静摩擦力矩,以提高姿态控制性能。
6. 后期拟完成的研究工作及进度安排
依照原计划,如表格所示:
7. 存在的问题与困难
对于滑模变结构控制的理论及运用了解不够,需继续学习 对于状态观测器在matlab中的实现及在变结构控制系统中的运用 缺乏更多控制系统性能评价手段,对系统的性能评价不够全面
8. 论文按时完成的可能性
可按时完成