[发明专利]一种基于自适应预测周期的再入飞行器预测控制方法有效
申请号: | 202011324498.9 | 申请日: | 2020-11-23 |
公开(公告)号: | CN112506209B | 公开(公告)日: | 2023-04-14 |
发明(设计)人: | 孙光;张旭辉;李永远;陈海鹏;黄育秋;程奇峰;刘焱飞;郑雄;刘丙利;郝宇星;郭晶;姚星合;康磊晶;赵大海 | 申请(专利权)人: | 中国运载火箭技术研究院 |
主分类号: | G05D1/08 | 分类号: | G05D1/08 |
代理公司: | 中国航天科技专利中心 11009 | 代理人: | 马全亮 |
地址: | 100076 北京*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 自适应 预测 周期 再入 飞行器 控制 方法 | ||
1.一种基于自适应预测周期的再入飞行器预测控制方法,其特征在于步骤如下:
(1)建立反映再入飞行器飞行过程动态特性的姿态动力学模型;包括三自由度质心平动模型、三自由度质心转动模型以及面向姿控设计的飞行器模型;
考虑地球自转对再入运动的影响,将飞行器视作质点,描述质心运动的三自由度质心平动模型为:
式中re、φ、θ分别表示飞行器飞行过程中所处的地心矩、经度和纬度;υ,χ,γ分别表示飞行速度、航向角和航迹角;g0为地球引力常数,ΩE为地球自转角速度;L,D,Y分别表示飞行器再入过程中受到的升力、阻力和侧力;所有参数顶部带点的变量均表示该参数的导数,β、σ分别表示侧滑角和倾斜角,m为飞行器质量;
描述绕质心运动的三自由度质心转动模型为:
式中α、β、σ分别表示攻角、侧滑角和倾斜角;p、q1、r分别表示滚转角速度、俯仰角速度和偏航角速度;Mx、My、Mz分别表示滚转、俯仰和偏航通道的控制力矩;I为飞行器的转动惯量;Ixx、Iyy、Izz分别为滚转、俯仰和偏航通道主惯性矩,Ixy、Iyz、Ixz分别为相应两通道间的惯性积;
将质心平动对转动的影响作为不确定处理,建立如下面向姿控设计的飞行器模型:
令姿态角速度ω=(p q1 r)T,姿态角q=(α β σ)T,f=(f1 f2 f3)T为轨迹运动对姿态运动产生的不确定性,则面向控制设计的质心转动运动学方程写为:
式中令控制输入u=(Mx My Mz)T,考虑模型不确定性与外部干扰d,质心转动动力学方程写为
整理得
其中为模型未知变量,ΔI为转动惯量不确定性,ω×为ω的叉乘矩阵;
(2)对再入飞行器的姿态子系统进行常值预测周期的虚拟预测控制器设计,具体为:针对质心转动运动学方程系统,即姿态子系统设计虚拟控制律通过使性能指标J1最小来实现姿态角的跟踪;
其中,预测跟踪姿态误差为其中是飞行器姿态q(t)在t+τ时刻的预测值,是期望姿态轨迹qr(t)在t+τ时刻的预测值;T1为预测周期,且T1>0;姿态误差定义假设其中为姿态角速度误差,δ1为已知有界正常数;
(3)基于步骤(2)得到的姿态子系统的常值预测周期的虚拟预测控制器,对再入飞行器的姿态子系统进行动态预测周期的自适应虚拟预测控制器设计;具体为:对姿态子系统;定义动态预测周期为对姿态进行变换形成新的过渡姿态误差建立虚拟控制律
动态预测周期自适应律和干扰估计律
使得过渡姿态误差收敛到零附近的小邻域之内;这里L1为动态预测周期变化率,且L1(0)=0;待设计参数γ1>0,ε1∈(0,1),κ1>0,且T1(0)为初始预测周期,为Tn的估计值,为估计误差;
(4)对再入飞行器的姿态角速度子系统进行常值预测周期的预测控制器设计;具体为:对于质心转动动力学方程,即姿态角速度子系统设计控制律
可通过使性能指标J2最小来实现姿态角速度的跟踪;
其中,为姿态角速度误差,是飞行器姿态角速度ω在t+τ时刻的预测值,是ωd(t)在t+τ时刻的预测值;T2为预测周期,且T2>0;
(5)基于步骤(4)得到的姿态角速度子系统的常值预测周期的虚拟预测控制器,对再入飞行器的姿态角速度子系统进行动态预测周期的自适应预测控制器设计;具体为:对于姿态角速度子系统,定义并假设其中δ2为已知有界正常数;定义动态预测周期为对姿态角速度进行变换形成新的过渡姿态角速度误差建立姿态角速度系统的基于动态预测周期的自适应预测控制器
可使过渡姿态角速度误差收敛到零附近的小邻域之内;这里L2为动态预测周期变化率,且L2(0)=0;待设计参数γ2>0,ε2∈(0,1),κ2>0,且T2(0)为初始预测周期,为Tm的估计值,为估计误差;
(6)结合步骤(3)得到的姿态子系统动态预测周期的自适应虚拟预测控制器以及步骤(5)得到的姿态角速度系统动态预测周期的自适应预测控制器,对再入飞行器进行动态预测周期的自适应预测控制器设计,从而实现基于自适应预测周期的再入飞行器预测控制。
2.根据权利要求1所述的一种基于自适应预测周期的再入飞行器预测控制方法,其特征在于:所述步骤(6)对再入飞行器进行动态预测周期的自适应预测控制器设计,具体为:对于再入飞行器,建立飞行器基于动态预测周期的自适应预测控制器如下:
使得飞行器姿态误差q(t)和ω(t)收敛到期望姿态附近的小邻域之内。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国运载火箭技术研究院,未经中国运载火箭技术研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011324498.9/1.html,转载请声明来源钻瓜专利网。