一种基于法向过载的总攻角控制方法与流程

[0001]本发明属于深空探测行星表面着陆项目中的小升力体稀薄大气进入过程的制导控制领域，涉及一种基于法向过载的总攻角控制方法。背景技术：[0002]我国首次火星探测任务将通过一次发射实施火星环绕、着陆和巡视探测，任务的关键是成功实施进入、下降和着陆过程，实现火星表面软着陆。要实现安全软着陆，降落伞能否成功打开是关键，因此大气进入过程必须充分设计以满足各项开伞条件约束。降落伞展开的条件除了对开伞点处的动压、马赫数、高度有严格约束以外，对进入舱的攻角、侧滑角以及总攻角都有明确的限制，如总攻角应不大于6°。[0003]在大气进入过程中，进入舱构型通过设计质心偏移产生了一定的升力，俯仰方向仅采用速率阻尼方式进行姿控，实现以某配平攻角气动稳定飞行的状态，这样能够帮助进入舱充分利用火星大气进行减速，使得开伞时高度、动压、马赫数等约束条件得到满足。为了进一步满足开伞点处对进入舱总攻角的约束，需在开伞点前通过展开配平翼以改变其原来的配平状态，使新的配平攻角恢复至0°附近。[0004]在这个过程中，一旦配平翼展开出现故障，姿控仍采用速率阻尼方式，必然无法将总攻角控制在6°以内，因此需对总攻角进行控制。然而在开伞前的大气进入过程，如果试图改变气动配平状态，强制对进入舱的攻角进行控制，气动干扰力矩会很大，且总攻角越小，进入舱偏离配平状态的程度越大，控制所受的干扰力矩也越大。而且由于火星大气密度和气动力系数均存在较大的不确定性，干扰力矩也存在不确定性，此时如果直接以总攻角为控制目标，加之攻角测量的误差，必然会使开伞时刻总攻角的约束条件不能满足，严重危害降落伞的顺利展开。技术实现要素：[0005]本发明解决的技术问题是：针对上述配平翼展开故障问题，为了保证进入舱的总攻角满足开伞条件的约束，本发明设计了一种基于法向过载的总攻角控制方法。[0006]本发明解决技术的方案是：一种基于法向过载的总攻角控制方法，在配平翼未成功展开时，通过下述方式进行控制：[0007]分析纵向短周期运动，简化俯仰平面内的动力学方程；[0008]建立期望法向过载即法向过载指令为零；[0009]根据简化的俯仰平面内的运动方程，推导攻角偏差与法向过载的关系；[0010]基于实测法向过载与期望法向过载的偏差，结合推导的法向过载与攻角偏差的关系，求解控制力矩，按照控制力矩进行控制。[0011]优选的，所述的简化假定探测器倾侧角和侧滑角，被控制在零度的目标姿态，且探测器的惯量积为零，忽略地球自转角速度的影响，且忽略当地地平的变化。[0012]优选的，简化俯仰平面内的动力学方程如下：[0013][0014][0015][0016]式中，α为攻角，ωz为本体相对惯性系的俯仰角速率，γ为飞行路径角，ρ为火星大气密度，v为相对火星表面的速度大小，s为探测器的参考面积，lref为探测器的参考长度，cmz为俯仰力矩系数，iz为俯仰轴转动惯量，ny为法向气动过载，m为探测器的质量，cy为俯仰力矩系数，g为地球引力加速度，u是控制力矩。[0017]优选的，攻角偏差与法向过载的关系为[0018]其中，ωz为本体相对惯性系的俯仰角速率，为攻角偏差，ny为实测的法向过载，θ为俯仰角，gm为火星引力加速度，v为相对火星表面的速度大小。[0019]优选的，控制力矩[0020]其中，ny为实测法向过载，nyc＝0为法向过载指令等于零，为攻角偏差，为控制原配平状态下的攻角至开伞所需的攻角，为攻角偏差需控制的目标量，kiz为反馈系数。[0021]优选的，所述的反馈系数通过下述方式确定：[0022]首选，确定反馈系数之间的关系式，对于双积分环节的刚体模型，反馈系数满足如下关系：[0023][0024]其中，ωb为控制带宽，ζ为系统阻尼比；[0025]然后，根据控制带宽必须抵抗上百牛米的气动干扰，且在避免导致对喷不稳定的前提下设计控制带宽；同时，根据过阻尼设计系统阻尼比；进而根据上述关系式确定[0026]最后根据积分系数kiz取的1％～5％的关系确定kiz。[0027]本发明与现有技术相比的有益效果是：[0028]我国首次火星探测即要实现火星表面的软着陆，而进入、下降和着陆过程中有些关键技术既前沿又兼具挑战性，其中的典型就是配平翼展开技术。为了满足开伞时对进入舱总攻角的约束，型号中通过展开配平翼将大气进入过程某较大配平攻角调整至0°附近。[0029]新任务新设计，针对配平翼展开故障处理问题，目前国内外几乎没有公开发表的文章论及，而过载控制方法均是针对舵控飞行器设计的，与本专利有本质的区别。[0030]当前我国火星探测任务edl过程配平翼展开的安全性难以达到百分之百，而开伞条件约束又十分严苛。在这种情况下，本发明针对配平翼展开故障，提出了一种基于法向过载的总攻角控制方法，通过对加计可直接测量的法向过载进行控制，达到按期望姿态飞行的目的，同时避免了导航带来的攻角测量误差对控制精度的影响，大大提高了故障情况下开伞点总攻角满足约束的概率和开伞的成功率。[0031]本发明通过对加计可直接测量的法向过载进行控制，达到按期望姿态飞行的目的，同时避免了导航带来的攻角测量误差对控制精度的影响，大大提高了故障情况下开伞点总攻角满足约束的概率和开伞的成功率。附图说明[0032]图1为本发明方法流程图；[0033]图2为法向过载控攻角的控制器框图；[0034]图3为展开配平翼故障时，法向过载控攻角的效果图；[0035]图4为展开配平翼故障时，仅速率阻尼控制的效果图。具体实施方式[0036]下面结合实施例对本发明作进一步阐述。[0037]小于某马赫数后展开配平翼，在配平翼未成功展开时，攻角需要采取基于法向过载的控制方法，以控制攻角近0°，满足开伞条件的需求。一种基于法向过载的总攻角控制方法，如图1所示，具体步骤如下：[0038](1)分析纵向短周期运动，简化俯仰平面内的动力学方程。纵向短周期运动描述了俯仰通道姿态运动与攻角运动。这里假定探测器倾侧角和侧滑角，被控制在零度的目标姿态，且探测器的惯量积为零，忽略地球自转角速度的影响，且因探测器速度较小忽略在较短时间内当地地平的变化，可得简化后的基本动力学方程如下。[0039][0040][0041][0042]式中，α为攻角，ωz为本体相对惯性系的俯仰角速率，γ为飞行路径角，ρ为火星大气密度，v为相对火星表面的速度大小，s为探测器的参考面积，lref为探测器的参考长度，cmz为俯仰力矩系数，iz为俯仰轴转动惯量，ny为法向气动过载，m为探测器的质量，cy为俯仰力矩系数，g为地球引力加速度。[0043](2)建立期望法向过载。为了保障降落伞的顺利展开，需要尽力控制攻角在0°附近，因此期望的法向过载即法向过载指令应该为零，即nyc＝0。[0044](3)推导法向过载偏差与俯仰角速度和攻角偏差之间的关系。[0045]ny为可测的法向过载，法向加速度az与法向过载的关系如下：[0046]az＝nyg-gmcosθ[0047]其中θ为俯仰角，gm为火星引力加速度。法向加速度与飞行路径角γ的变化率有如下关系：[0048][0049]根据简化动力学方程有则可得攻角偏差与法向过载的关系为：[0050][0051]其中ωz为俯仰角速率，为攻角偏差。[0052](4)基于实测法向过载与期望值的偏差，求解控制力矩u。[0053]假设当前实测的法向过载为ny，则设计控制器框图如图2所示，[0054][0055]其中，ny为法向过载，nyc＝0为法向过载指令等于零，为攻角偏差，为控制原配平状态下的攻角至开伞所需的攻角0°，为攻角偏差需控制的目标量，kiz为反馈系数。[0056]对于双积分环节的刚体模型，可推导pd反馈系数满足如下关系：[0057][0058]其中，ωb为控制带宽，ζ为系统阻尼比。此处控制带宽必须足够高以抵抗上百牛米的气动干扰，在避免导致对喷不稳定的前提下，这里设计系统带宽约为3.5，根据过阻尼设计，系统阻尼比设计约为2，从而确定积分系数kiz考虑强积分控制设计，同时可加积分饱和限制。根据上述原则，结合数学仿真，确定攻角控制的pid参数。[0059]以某火星探测器为例进行仿真验证，图3为法向过载控总攻角的效果图，图4为仅采用速率阻尼控制的效果图，对比说明本发明所述方法的有效性。取火星着陆器质量为1300kg，iz＝848.9kg˙m2，lref＝3.4m，sref＝10.5m2。kiz值取为2500，3000，1500。[0060]设置配平翼展开故障，考虑大气密度偏差，气动系数偏差的情况下进行算法的200次打靶仿真，仿真结果如图2所示，图中红线为开伞时对攻角和攻角速率的条件约束，由蓝点可知开伞时最大的攻角为4.664°，攻角速率均很小，显然满足开伞的约束条件。对比仅速率阻尼的打靶结果如图4所示，最大总攻角已接近18°，大部分情况超出6°。可见本发明提出的姿态控制方法明显减小了开伞时的总攻角，改善了开伞条件，提高了开伞的安全性。[0061]本发明未详细说明部分属于本领域技术人员的公知常识。