用于在线轨迹规划的模型误差补偿方法、系统及存储介质技术方案

本发明专利技术公开了一种用于在线轨迹规划的模型误差补偿方法、系统及存储介质，首先根据轨迹规划生成的标称数据和视加速度测量值，计算理论视加速度和实际视加速度的偏差，然后根据该偏差计算补偿推力指令，并利用低通滤波器对其进行滤波处理，最后将推力补偿量和标称推力指令组合成为推力指令。本发明专利技术的优点在于能够有效减小模型误差，增加在线轨迹规划的抗干扰能力，从而实现高精度着陆。

【技术实现步骤摘要】
用于在线轨迹规划的模型误差补偿方法、系统及存储介质
本专利技术涉及制导与控制
，特别是一种用于在线轨迹规划的模型误差补偿方法、系统及存储介质。
技术介绍
运载火箭一子级制导系统的作用是克服飞行过程中的各种误差和不确定性因素，使之按照某些控制规律或沿着选定的轨迹飞向目标着陆场。标准轨迹制导方法是一种基于摄动思想的制导方法，是目前应用范围最广的一类制导方法，绝大多数运载火箭在主动段都采用了此种方法，其优点是制导律简单、箭上实现容易，但不足是无法适应大干扰、大偏差等情况。为了实现在大干扰、大偏差情况下的高精度着陆，现有技术提出了一种基于在线轨迹规划的制导方法，它不依赖于标准轨迹，能够利用数值优化方法在线规划出飞行轨迹以及其相应的制导指令，SpaceX公司在Falcon火箭一子级回收的着陆段制导中，已经使用了在线轨迹规划技术(马林.垂直起降运载火箭动力软着陆轨迹优化方法研究[D].浙江大学,2019.)。在线轨迹规划中使用的动力学模型通常是简化的、不精确的模型，忽略了动力学模型中某些非线性以及不确定项，使得与实际飞行过程中的动力学模型存在一定的模型误差。由于模型误差的存在，如果火箭直接按照轨迹规划产生的推力指令飞行，其实际飞行轨迹会逐渐偏离规划轨迹，这会使得轨迹规划问题无解，在线轨迹规划失败，从而降低制导精度(王劲博.可重复使用运载火箭在线轨迹优化与制导方法研究[D].哈尔滨工业大学,2019.)。因此必须要对在线规划中所使用的动力学模型和实际动力学模型之间的模型误差进行处理，减小模型误差，使得实际轨迹尽量靠近规划轨迹，保证在线轨迹规划能够连续的进行，从而提高着陆精度。
技术实现思路
本专利技术所要解决的技术问题是，针对现有技术不足，提供一种用于在线轨迹规划的模型误差补偿方法、系统及存储介质，有效减小轨迹规划模型与实际模型之间误差，增加在线轨迹规划的抗干扰能力，从而实现高精度着陆。为解决上述技术问题，本专利技术所采用的技术方案是：一种用于在线轨迹规划的模型误差补偿方法，其特征在于，该方法包括：S1、判断是否为首次进行误差补偿，否则，进入步骤S2；S2、利用下式计算t时刻运载火箭的推力指令T：T＝TN+TΔ；其中，TN为t时刻下运载火箭的标称推力；mN为t时刻下运载火箭的标称质量；为视加速度偏差，计算公式为：W1为实际视加速度，W2为理论视加速度；ω为滤波系数；t时刻下，初始值为0，t+1时刻，本专利技术利用上述方法对动力学模型和实际动力学模型之间的模型误差进行处理，能够有效减小轨迹规划模型与实际模型之间误差，增加在线轨迹规划的抗干扰能力，从而实现高精度着陆。步骤S1之前，还包括：1)判断运载火箭是否达到飞行终点，若是，则结束；否则，根据当前状态信息进行在线轨迹规划，得到时间序列标称推力序列{T0,T1,...,TM-1}、标称阻力序列{D0,D1,...,DM-1}和标称质量序列{m0,m1,...,mM-1}，其中M表示飞行起点到飞行终点之间的离散点数量；2)获取当前时刻t，根据时间序列、标称阻力序列和标称质量序列，获取t时刻下的标称推力TN，标称阻力DN，标称质量mN。本专利技术首次进行误差补偿时，由于先前没有推力指令的输入，无法计算误差大小，因此不能进行误差补偿，由于实际飞行中推力补偿的时间间隔非常短，首次不进行误差补偿对制导精度影响非常小。为简化计算过程，步骤2)中，利用插值方法获取t时刻下的标称推力TN，标称阻力DN，标称质量mN。步骤S2的具体实现过程包括：A)计算t时刻下运载火箭的补偿推力指令TΔ：B)计算t时刻运载火箭的推力指令T：T＝TN+TΔ；C)令返回步骤A)。步骤A)表示对补偿推力进行低通滤波处理，目的是使得推力补偿更加平滑，减少波动，从而提高制导性能的稳定性。步骤B)中推力指令T由标称推力TN和补偿推力TΔ组成，标称推力TN可以使得实际轨迹在标称轨迹附近，补偿推力TΔ可以减少实际轨迹与标称轨迹之间的偏差，提高制导精度。步骤C)是为了保存数据，提供给下次进行步骤A)使用。本专利技术步骤S1中，若是首次进行误差补偿，则运载火箭的推力指令T＝TN。理论视加速度W2的计算公式为：DN为t时刻的标称阻力。理论视加速度的计算公式与在线轨迹规划中的视加速度计算公式相同，将该公式和实际视加速度作差计算出的补偿推力可以使得减少实际视加速度与规划视加速之间的偏差，从而提高制导精度。本专利技术还提供了一种用于在线轨迹规划的模型误差补偿系统，其包括计算机设备；所述计算机设备被配置或编程为用于执行本专利技术所述方法的步骤。一种计算机可读存储介质，其存储有程序；所述程序被配置为用于执行本专利技术所述方法的步骤。与现有技术相比，本专利技术所具有的有益效果为：本专利技术在轨迹规划生成的标称数据基础上，计算理论视加速度和实际视加速度的偏差，并根据该偏差计算补偿推力用于补偿模型误差。本专利技术的优点在于能够有效减小模型误差，增加在线轨迹规划的抗干扰能力，从而实现高精度着陆。附图说明图1为本专利技术方法流程示意图；图2(a)～图2(h)为无模型误差补偿下的制导结果，其中图2(a)为垂直方向位置；图2(b)为垂直方向速度；图2(c)为射向位置；图2(d)为射向速度；图2(e)为侧向位置；图2(f)为侧向速度；图2(g)为位置偏差；图2(h)为速度偏差；图3(a)～图3(h)为无模型误差补偿下的制导结果；其中图3(a)为垂直方向位置；图3(b)为垂直方向速度；图3(c)为射向位置；图3(d)为射向速度；图3(e)为侧向位置；图3(f)为侧向速度；图3(g)为位置偏差；图3(h)为速度偏差。具体实施方式下面以某型运载火箭着陆段制导系统为例，说明本专利技术的具体实现过程。相关参数如下：起始点状态信息：位置为[3500-720100]Tm、速度为[-207880]Tm/s、质量为26000kg，滤波系数ω＝0.1。S1：由导航设备获取运载火箭当前状态信息，判断运载火箭是否到达飞行终点，若是结束程序，若否，转S2。S2：则根据当前状态信息进行在线轨迹规划(SzmukM,AcikmeseB,BerningAW.SuccessiveConvexificationforFuel-OptimalPoweredLandingwithAerodynamicDragandNon-ConvexConstraints[C].AIAAGuidance,Navigation,andControlConference,2015.)，得到时间序列标称推力序列{T0,T1,...,TM-1}、标称阻力序列{D0,D1,...,DM-1}和标称质量序列{m0,m1,...,mM-1}，其中括号中的每个符号表示对应下标的离散点处的取值，M表示离散点数。S3：利用计时装置(计算机计时器)获取当前时刻t，根据时间序列、标称阻力序列和质量序列，利用本文档来自技高网...

【技术保护点】
1.一种用于在线轨迹规划的模型误差补偿方法，其特征在于，该方法包括：/nS1、判断是否为首次进行误差补偿，否则，进入步骤S2；/nS2、利用下式计算t时刻运载火箭的推力指令T：T＝T

【技术特征摘要】
1.一种用于在线轨迹规划的模型误差补偿方法，其特征在于，该方法包括：
S1、判断是否为首次进行误差补偿，否则，进入步骤S2；
S2、利用下式计算t时刻运载火箭的推力指令T：T＝TN+TΔ；其中，TN为t时刻下运载火箭的标称推力；mN为t时刻下运载火箭的标称质量；为视加速度偏差，计算公式为：W1为实际视加速度，W2为理论视加速度；ω为滤波系数；t时刻下，初始值为0，t+1时刻，


2.根据权利要求1所述的用于在线轨迹规划的模型误差补偿方法，其特征在于，步骤S1之前，还包括：
1)判断运载火箭是否达到飞行终点，若是，则结束；否则，根据当前状态信息进行在线轨迹规划，得到时间序列标称推力序列{T0,T1,...,TM-1}、标称阻力序列{D0,D1,...,DM-1}和标称质量序列{m0,m1,...,mM-1}，其中M表示飞行起点到飞行终点之间的离散点数量；
2)获取当前时刻t，根据时间序列、标称阻力序列和标称质量序列，获取t时刻下的标称推力TN，标称阻力DN，标称质量mN。


3.根据权利要求2所述的用于在线轨迹规划的...

【专利技术属性】
技术研发人员：张洪波，谢磊，周亮，何睿智，王鹏，汤国建，
申请(专利权)人：中国人民解放军国防科技大学，
类型：发明
国别省市：湖南;43