飞行器制导指令的生成方法及系统与流程

摘要: 本发明涉及飞行器制导控制,具体而言,涉及一种飞行器制导指令的生成方法及系统。背景技术:1、evtol飞行器常采用任务计算机与飞控计算机协同工作的架构,任务计算机...
飞行器制导指令的生成方法及系统与流程

本发明涉及飞行器制导控制,具体而言,涉及一种飞行器制导指令的生成方法及系统。

背景技术:

1、evtol飞行器常采用任务计算机与飞控计算机协同工作的架构,任务计算机负责完成环境感知、地图构建、航线规划以及动态避障等复杂运算,向下层飞控计算机输出航点、航迹段、运动约束等运动规划意图,飞控计算机则承担底层飞行闭环控制任务,保障飞行器稳定运行。当前主流实现方式是在接口层完成报文crc校验、字段静态范围检查之后,直接将任务计算机输出的规划意图交付飞控计算机执行,以此完成飞行器的制导控制。

2、发明人在实现本发明的过程中发现,现有evtol飞行器制导指令校验处理方式存在难以克服的核心缺陷:仅依靠静态字段检查无法适配飞行器实时变化的飞行能力,难以结合飞行器当前运动学可行域对上游规划意图开展联合校验,容易出现下发的制导指令超出飞行器实际可执行能力,影响飞行器飞行安全。

技术实现思路

1、基于此,针对上述问题,本发明提供一种飞行器制导指令的生成方法及系统,通过根据飞行器的当前状态信息和能力约束信息构建包含约束边界的动态包络,对上游规划意图信息进行校验,对超出约束边界的规划意图进行修正得到修正后意图信息,并依据修正后意图信息生成制导指令,有助于实现制导安全约束边界跟随飞行器实时运行状态动态变化,对上游下发的规划意图完成可达性校验与超限修正,提升制导指令与飞行器当下实际运动能力的匹配程度,避免不可执行的规划意图直接进入底层飞控闭环,为evtol飞行器的自主飞行制导控制提供稳定可靠的技术支撑。

2、第一方面,本发明提供一种飞行器制导指令的生成方法,该方法包括:根据飞行器的当前状态信息和能力约束信息构建动态包络;动态包络包含飞行器在当前时刻下的运动学可行域,以及由运动学可行域确定的约束边界;对上游的规划意图信息进行校验,若规划意图信息超出约束边界,则对超出部分进行修正,得到落入约束边界内的修正后意图信息;根据修正后意图信息生成制导指令。

3、在上述实现过程中,规划意图信息包含航点序列以及各航点的期望运动参数和期望飞行模式;当前状态信息包含飞行器的位置、速度、姿态、角速度、加速度、推力余量、执行机构状态、导航质量及权限状态;能力约束信息包含能源状态、环境状态及故障状态。通过完整采集涵盖航点序列以及各航点的期望运动参数、期望飞行模式的规划意图信息,该规划意图信息还包括报文序号、时间戳、坐标系、crc校验信息;同时获取飞行器位置、速度、姿态、角速度、加速度、推力余量、执行机构状态、导航质量及权限状态等多维度的当前状态信息,以及包含能源状态、环境状态及故障状态的能力约束信息,能够将报文协议层面的完整性信息、任务规划侧输出的飞行诉求、飞行器本体实时运动工况、能源环境与故障带来的能力限制全部纳入信息输入来源;拓宽动态包络构建以及规划意图校验修正的数据覆盖维度,可提前识别报文时序错乱、坐标系不匹配、报文异常等问题,避免因输入信息维度缺失造成动态可行域刻画失真、非法报文流入后续处理链路,保障后续动态包络解算、意图校验修正过程能够充分贴合飞行器真实的运行条件,为生成适配飞行器实际能力的制导指令提供全面完备的数据输入基础。

4、可选的,根据飞行器的当前状态信息和能力约束信息构建动态包络,包括:根据能力约束信息中的能源状态、环境状态及故障状态分别确定能源维度能力因子、环境维度能力因子和故障维度能力因子;根据能源维度能力因子、环境维度能力因子和故障维度能力因子确定综合能力系数;读取机型配置表中存储的标称能力参数,利用综合能力系数对标称能力参数进行降额处理,得到有效能力边界;根据当前状态信息中的位置和速度确定当前运动状态,将有效能力边界与当前运动状态结合,生成多维的动态包络;其中,多维的动态包络包含位置约束、速度约束、加速度约束、姿态约束和复合约束。通过依据能源状态、环境状态及故障状态分别计算得到各维度能力因子,再由各维度能力因子确定综合能力系数,读取机型配置表的标称能力参数并结合综合能力系数完成降额处理得到有效能力边界,结合飞行器位置、速度表征的当前运动状态生成包含位置约束、速度约束、加速度约束、姿态约束和复合约束的多维动态包络,能够结合能源、环境、故障带来的实际能力衰减对飞行器出厂标称能力做动态降额修正,不再直接采用固定不变的标称限值作为安全边界;将飞行器实时运动工况与降额后的有效能力边界相融合,构建出贴合飞行器当下真实可用性能的多维运动学可行域,规避静态边界与飞行器实际执行能力不匹配的问题,为后续规划意图的校验、超限修正提供准确、与时序工况联动的约束基准。

5、在上述实现过程中,能源维度能力因子、环境维度能力因子和故障维度能力因子采用滞回更新、低通滤波更新或不对称更新方式更新;当发生执行机构故障时,切换至预先离线计算的故障包络作为动态包络。通过对能源维度能力因子、环境维度能力因子和故障维度能力因子采用滞回更新、低通滤波更新或者不对称更新方式进行更新,并且在发生执行机构故障时,切换至预先离线计算的故障包络作为动态包络,能够抑制传感器测量噪声造成能力因子在边界处频繁跳变,避免动态包络出现剧烈抖动,保障约束边界输出的平稳性;当出现执行机构故障时直接复用离线预计算得到的故障包络,无需在线实时运算故障对应的可行域,降低在线计算开销,快速完成安全约束域切换,使得动态包络可以平稳、可靠地适配飞行器正常工况以及故障工况。

6、可选的,对上游的规划意图信息进行校验,包括:对规划意图信息中的航点序列进行连续性校验,根据相邻航点之间的距离和期望运动参数中的期望到达时间确定所需运动参数,判断所需运动参数是否落入动态包络的约束边界内;对航点序列进行有限时域可达性校验,从当前状态信息中的位置和速度出发,沿航点序列进行滚动预测,判断各预测节点处的状态是否均满足动态包络的全部约束;当连续性校验和有限时域可达性校验均通过时,判定规划意图信息符合约束边界。通过对上游规划意图信息中的航点序列开展连续性校验,依据相邻航点距离以及期望到达时间反推所需运动参数,判别所需运动参数是否处于动态包络约束边界之内,同时对航点序列执行有限时域可达性校验,由飞行器当前位置、速度沿航点序列做滚动预测,核查各个预测节点是否全部满足动态包络的各项约束,仅在连续性校验与有限时域可达性校验均通过的情况下,才判定规划意图信息符合约束边界,能够不局限于对单个航点做孤立合法性判断,从航段运动连续性以及时序滚动可达性两个维度对整条航点序列开展联合校验;避免出现单点航点参数合法,但整条航迹连续执行时超出飞行器实际运动能力的问题,提升了对上游规划意图校验的完备性。

7、可选的,若规划意图信息超出约束边界,则对超出部分进行修正,得到落入约束边界内的修正后意图信息,包括:

8、以规划意图信息为基准点,在动态包络的约束边界内搜索与基准点距离最近的可行点,将搜索到的可行点作为修正后意图信息;其中,搜索过程中各维度的距离权重由权重矩阵确定,权重矩阵为正定矩阵,权重矩阵中垂向制动维度、姿态稳定维度和障碍远离维度的权重大于速度维度和到达时间维度的权重。通过以规划意图信息作为基准点,在动态包络约束边界内搜索得到加权距离最近的可行点作为修正后意图信息,并采用正定权重矩阵设定各维度距离权重,将垂向制动、姿态稳定以及障碍远离维度的权重设置为高于速度、到达时间维度的权重,能够在对超限的规划意图进行修正的过程中实现对原始规划意图的最小程度改动;同时借助权重矩阵体现飞行安全优先的修正策略,优先保障飞行器姿态稳定、制动能力以及远离障碍的安全需求,其次再兼顾任务的速度与时间指标,避免简单直接截断字段带来的指令突变,使得修正后的意图既满足飞行器动态包络的硬约束条件,又尽可能保留上游任务规划的原有飞行诉求,提升超限意图修正输出的安全性与任务延续性。

9、可选的,当在动态包络的约束边界内无法搜索到可行点时,还包括逐级优先级对规划意图信息进行裁剪,得到修正后意图信息:第一优先级,保持航迹方向不变并将速度矢量和加速度矢量按等比例缩小至落入约束边界内;若等比例缩小不可行,则执行第二优先级,优先保证姿态稳定和推力余度满足约束,分别对位置、速度、加速度各分量进行独立裁剪至落入约束边界内;若独立裁剪仍不可行,则执行第三优先级,生成减速、悬停、定高或返回最近安全点的最小风险后备意图。当动态包络约束边界内无法搜索得到可行点时,通过按照逐级优先级对规划意图信息进行裁剪以获得修正后意图信息,先在第一优先级下保持航迹方向不变,对速度矢量、加速度矢量做等比例缩放使其满足约束;等比例缩放失效时进入第二优先级,以姿态稳定、推力余度为优先约束对各运动分量独立裁剪;若依旧不可行则执行第三优先级,输出减速、悬停、定高或者返回最近安全点的最小风险后备意图,能够在加权投影找不到可行解的极端工况下建立分层降级处置机制;优先尽可能保留原有航迹走向,最大限度继承上游规划意图,在常规裁剪手段失效时切换至风险最低的后备飞行策略,避免因无可用可行意图造成制导逻辑失效,兼顾任务意图的延续性与飞行器飞行安全,提升极端工况下制导修正的鲁棒性。

10、可选的,生成减速、悬停、定高或返回最近安全点的最小风险后备意图作为修正后意图信息之后,还包括:根据规划意图信息超出动态包络的约束边界的超限类型和超限程度,生成约束摘要;将约束摘要和重规划请求发送至任务计算机,以使任务计算机根据约束摘要重新规划航点序列。在生成减速、悬停、定高或返回最近安全点的最小风险后备意图作为修正后意图信息之后,通过依据规划意图信息超出动态包络约束边界的超限类型与超限程度生成约束摘要,并将约束摘要连同重规划请求下发至任务计算机,供任务计算机参照约束摘要重新完成航点序列规划,能够把底层制导侧识别到的能力约束与超限情况向上反馈给上游规划单元;任务计算机无需盲目重新开展全域规划,可基于约束摘要针对性调整规划条件,减少无效规划运算,打通底层安全钳制与上层重规划之间的信息交互链路,既保障飞行器当下执行最小风险后备意图实现飞行安全,又为上游重新生成适配飞行器实际能力的航点规划提供明确参考依据。

11、可选的,根据修正后意图信息生成制导指令,包括:获取上一周期输出的制导指令;对修正后意图信息与上一周期输出的制导指令之间的差值依次施加速率约束、加速度约束和加速度变化率约束,得到平滑修正量;其中,速率约束的限幅值、加速度约束的限幅值和加速度变化率约束的限幅值由有效能力边界确定;将上一周期输出的制导指令与平滑修正量叠加,生成当前周期的制导指令。通过获取上一周期输出的制导指令,针对修正后意图信息与上一周期制导指令的差值,依次施加由有效能力边界确定限幅值的速率约束、加速度约束以及加速度变化率约束得到平滑修正量,再将上一周期制导指令与平滑修正量叠加生成并输出当前周期制导指令,能够避免修正后意图直接切换带来的指令跳变、冲击问题;平滑约束的限幅值直接取自飞行器实时的有效能力边界,使平滑处理贴合飞行器当前真实运动极限,不会出现平滑后的指令依然超出飞行器执行能力的情况,保障输出的制导指令连续平滑、可被飞控计算机稳定闭环执行,降低飞控端的控制负担,进一步提升飞行器制导控制过程的稳定性。

12、第二方面,本发明还提供一种飞行器制导指令的生成系统,该系统包括:动态包络构建模块,用于根据飞行器的当前状态信息和能力约束信息构建动态包络;动态包络包含飞行器在当前时刻下的运动学可行域,以及由运动学可行域确定的约束边界;指令校验修正模块,用于对上游的规划意图信息进行校验,若规划意图信息超出约束边界,则对超出部分进行修正,得到落入约束边界内的修正后意图信息;制导指令生成模块,用于根据修正后意图信息生成制导指令。

13、根据本发明的技术方案,通过根据飞行器的当前状态信息和能力约束信息构建包含约束边界的动态包络,对上游规划意图信息进行校验,对超出约束边界的规划意图进行修正得到修正后意图信息,并依据修正后意图信息生成制导指令,有助于实现制导安全约束边界跟随飞行器实时运行状态动态变化,对上游下发的规划意图完成可达性校验与超限修正,提升制导指令与飞行器当下实际运动能力的匹配程度,避免不可执行的规划意图直接进入底层飞控闭环,为evtol飞行器的自主飞行制导控制提供稳定可靠的技术支撑。