基于一致性的起落架和传感器的建模方法与流程
本发明涉及硬件建模仿真,具体为基于一致性的起落架和传感器的建模方法。
背景技术:
1、飞控硬件在环(hardware-in-the-loop,hil)仿真系统是一种将实物飞控计算机接入实时仿真环境的测试方法,广泛应用于无人机及有人机飞控软件的验证与测试。在地面滑行、起飞和着陆等地面接触阶段,起落架与地面的接触力建模是硬件在环仿真的关键环节。现有起落架仿真建模方法通常针对特定构型(如三点式或四点式)单独开发代码,当飞机构型发生变化时需重新开发对应模型,导致不同构型之间模型复用性差,开发维护成本较高。
2、在离散仿真步长条件下,接触单元在接触与非接触状态之间频繁切换时,法向接触力容易出现阶跃突变,引发接触状态抖动问题,影响六自由度动力学方程的数值稳定性。此外,在硬件在环仿真中,若将物理接触力直接作为惯性测量单元(imu)的激励输入,与六自由度动力学状态之间存在不一致,可能导致飞控系统中扩展卡尔曼滤波(ekf)等算法产生误判;飞控在地面已解锁状态下,姿态控制输出也可能因地面约束状态未被正确识别而出现异常。
3、因此,我们提出了基于一致性的起落架和传感器的建模方法来解决以上问题。
技术实现思路
1、(一)解决的技术问题
2、针对现有技术的不足,本发明提供了基于一致性的起落架和传感器的建模方法,具备支持多构型起落架快速切换、抑制接触状态抖动、保持惯性测量单元激励与六自由度动力学状态一致,并可靠识别地面约束主导状态等优点,解决了现有起落架仿真建模方法针对特定构型单独开发代码,不同构型之间模型复用性差的问题。
3、(二)技术方案
4、为实现上述支持多构型起落架快速切换、抑制接触状态抖动、保持惯性测量单元激励与六自由度动力学状态一致,并可靠识别地面约束主导状态的目的,本发明提供如下技术方案:基于一致性的起落架和传感器的建模方法,应用于飞控硬件在环仿真系统,包括以下步骤:
5、s1、读取起落架构型配置文件,建立起落架接触单元集合,所述接触单元集合包含n个接触单元,每个接触单元包含对应的接触参数;
6、s2、在每个仿真步长内,根据飞机六自由度位姿状态及各接触单元在机体坐标系中的位置偏置,计算各接触单元在地面坐标系中的空间位置,获得各接触单元与地面的垂直压缩量及压缩速度;
7、s3、对各接触单元执行迟滞阈值接触状态判断,根据判断结果确定各接触单元的接触状态;
8、s4、根据各接触单元的接触状态,基于弹簧-阻尼模型计算各接触单元的物理法向接触力,当接触单元处于非接触状态时,物理法向接触力为零;
9、s5、基于平滑函数对各接触单元的物理法向接触力进行连续化处理,输出连续化法向接触力,消除接触状态切换引起的力突变;
10、s、计算各接触单元的切向摩擦力,将各接触单元的连续化法向接触力和切向摩擦力转换至机体坐标系后进行叠加,得到起落架对飞机的合力和合力矩,并注入六自由度动力学方程;
11、s7、将物理接触力与惯性测量单元激励解耦,通过冲击传递系数对接触力进行缩放,生成惯性测量单元激励比力,并对所述惯性测量单元激励比力施加一致性约束,使惯性测量单元激励与六自由度动力学状态保持一致;
12、s8、综合有效接触单元数量、接触合力方向与大小及飞机运动状态执行地面约束主导状态识别,输出地面状态标志,飞控系统依据所述地面状态标志对姿态控制输出进行限制。
13、进一步的,所述配置文件采用结构化格式,所述接触参数包括各接触单元的等效接触半径、等效刚度系数、阻尼系数、静摩擦系数、动摩擦系数及机体坐标系位置偏置向量;所述结构化格式为json格式。
14、进一步的,所述迟滞阈值接触状态判断具体为:为每个接触单元设置接触触发阈值δon,i和接触断开阈值δoff,i,且δon,i大于δoff,i;当接触单元处于非接触状态时,若压缩量δi大于δon,i,则判定该接触单元接触状态成立;当接触单元处于接触状态时,若压缩量δi小于δoff,i,则判定该接触单元接触状态断开;当压缩量δi处于δoff,i与δon,i之间时,保持当前接触状态不变。
15、进一步的,所述弹簧-阻尼模型计算物理法向接触力的公式为:当接触状态成立时,=max(0,ki·δi+ci·i);当接触状态断开时,=0;其中,ki为所述等效刚度系数,ci为所述阻尼系数,δi为压缩量,i为压缩速度。
16、进一步的,所述平滑函数为sigmoid函数,所述连续化处理具体为:将物理法向接触力通过sigmoid函数进行平滑过渡处理,输出连续化法向接触力,使接触状态切换边界处的法向接触力由阶跃变化转变为连续平滑过渡。
17、进一步的,所述一致性约束具体为:计算高度一致性误差eh=‖δh6dof-∬dt2‖及速度一致性误差ev,依据公式=clip(kimpact+ke·ev,kmin,kmax)对冲击传递系数进行自适应调整,其中ke为误差增益系数,kmin和kmax分别为冲击传递系数的下限值和上限值;
18、当所述速度一致性误差ev超过判断阈值时触发冲击传递系数的自适应调整,所述判断阈值的取值范围为0.1~0.3m/s。
19、进一步的,所述接触质量指标包括有效接触单元数量、接触合力的方向与大小、飞机高度及飞机速度;所述地面约束主导状态识别具体为:综合判断有效接触单元数量、接触合力的方向与大小、飞机高度及飞机速度,当判断结果满足地面约束主导条件时,输出地面状态标志为有效,飞控系统依据所述地面状态标志对姿态控制输出施加限制。
20、进一步的,所述切向摩擦力的计算具体为:根据各接触单元的连续化法向接触力和摩擦系数,结合接触点在地面坐标系中的速度方向,计算各接触单元的切向摩擦力;当接触点速度超过滑动判断速度时采用动摩擦系数,否则采用静摩擦系数。
21、进一步的,步骤s2中所述压缩量的计算具体为:根据飞机六自由度位置和姿态四元数,将各接触单元在机体坐标系中的位置偏置向量转换至地面坐标系,得到各接触单元在地面坐标系中的空间位置,所述压缩量为各接触单元位置在地面坐标系垂直方向分量相对于地面高度的差值,所述压缩速度等于接触单元速度在地面坐标系垂直方向分量的负值。
22、一种飞控硬件在环起落架接触力与传感器激励一致性建模装置,包括处理器和存储器,还包括:配置读取模块,被配置为读取起落架构型配置文件,建立包含n个接触单元的接触单元集合,每个接触单元包含对应的接触参数;接触几何计算模块,与所述配置读取模块数据连接,被配置为根据飞机六自由度位姿状态及各接触单元在机体坐标系中的位置偏置,计算各接触单元在地面坐标系中的空间位置及垂直压缩量和压缩速度;接触状态判断模块,与所述接触几何计算模块数据连接,被配置为根据各接触单元的压缩量和压缩速度执行迟滞阈值接触状态判断,确定各接触单元的接触状态;接触力计算模块,与所述接触状态判断模块数据连接,被配置为根据各接触单元的接触状态基于弹簧-阻尼模型计算物理法向接触力及切向摩擦力;接触力连续化模块,与所述接触力计算模块数据连接,被配置为基于平滑函数对物理法向接触力进行连续化处理,输出连续化法向接触力;惯性测量单元激励生成模块,与所述接触力连续化模块数据连接,被配置为将物理接触力与惯性测量单元激励解耦,通过冲击传递系数对接触力进行缩放生成惯性测量单元激励比力,并对惯性测量单元激励比力施加一致性约束;地面状态识别模块,与所述接触力连续化模块及所述惯性测量单元激励生成模块数据连接,被配置为综合有效接触单元数量、接触合力方向与大小及飞机运动状态执行地面约束主导状态识别,输出地面状态标志;
23、所述配置读取模块还被配置为解析json格式配置文件,提取各接触单元的等效刚度系数、阻尼系数、摩擦系数及机体坐标系位置偏置向量,建立接触单元集合;所述惯性测量单元激励生成模块还包括一致性误差计算单元,所述一致性误差计算单元与所述惯性测量单元激励生成模块数据连接,被配置为计算高度一致性误差和速度一致性误差,并依据误差值自适应调整冲击传递系数。
24、(三)有益效果
25、与现有技术相比,本发明提供了一种飞机卸装坡道,具备以下有益效果:
26、1、通过采用配置文件驱动的参数化接触单元集合建模框架,将起落架构型信息与建模代码完全解耦,不同构型的起落架仅需修改json配置文件中的接触单元数量及对应参数即可完成模型切换,无需为每种构型重新开发建模代码,从根本上解决了现有方法中不同构型起落架模型复用性差、开发维护成本高的技术问题,显著提升了建模效率和跨构型适用性。
27、2、通过将迟滞阈值接触状态判断机制与sigmoid平滑函数连续化处理相结合,形成双重抑制机制:迟滞阈值在接触触发与断开之间引入状态保持区间,消除了压缩量在临界值附近微小波动引起的接触状态反复切换;sigmoid平滑函数将接触状态切换边界处的法向力阶跃转化为连续平滑过渡,显著改善了六自由度动力学方程的数值稳定性,有效解决了现有离散仿真中接触状态抖动导致法向力突变的技术问题。
28、3、通过将物理接触力与惯性测量单元激励解耦,并引入基于高度一致性误差和速度一致性误差的冲击传递系数自适应调整机制,使惯性测量单元激励比力与六自由度动力学状态始终保持一致,从根本上消除了将物理接触力直接作为惯性测量单元激励输入时产生的激励失真问题,避免了飞控系统中扩展卡尔曼滤波等状态估计算法因激励不一致而产生误判。
29、4、通过建立综合有效接触单元数量、接触合力方向与大小、飞机高度及飞机速度等多维度接触质量指标的地面约束主导状态识别方法,能够可靠判断飞控处于地面约束主导状态,并据此对飞控姿态控制输出施加合理限制,有效解决了现有方法中飞控在地面已解锁状态下因地面约束状态未被正确识别而导致姿态控制输出异常的技术问题。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com