一种无人机的降落控制系统

摘要: 本发明涉及无人机控制,尤其涉及一种无人机的降落控制系统。背景技术:1、无人机降落控制是无人系统自动化运行的关键环节,直接影响无人装备在复杂气象与低空遮挡环境下的...
一种无人机的降落控制系统

本发明涉及无人机控制,尤其涉及一种无人机的降落控制系统。

背景技术:

1、无人机降落控制是无人系统自动化运行的关键环节,直接影响无人装备在复杂气象与低空遮挡环境下的接入安全与调度效率。现有无人机降落多通过卫星定位或单一视觉传感器获取无人机与降落平台的相对位姿,再依靠串级反馈控制计算偏差并生成控制指令,使无人机跟随预设的固定航线降落。

2、由于采用固定期望航迹与独立引导机制,当低空风场扰动导致机体偏离时,纯反馈控制存在响应滞后,并且会导致实际轨迹震荡,使得抗扰控制仍盲目跟踪固定预设轨迹,无法根据近场高精度观测结果动态调整控制目标,最终导致无人机在风扰与光照耦合干扰下的着陆精度与平稳性下降。

技术实现思路

1、基于此,有必要针对上述技术问题,提供一种无人机的降落控制系统。

2、本说明书采用下述技术方案:

3、本说明书提供了一种无人机的降落控制系统,控制站以及搭载于无人机的机载终端;其中,机载终端包括:

4、数据采集模块,用于采集多源传感数据;

5、定位模块,用于根据多源传感数据中的惯性测量单元数据及卫星导航数据对无人机的位姿进行估计,输出位姿估计结果;

6、风扰控制模块,用于根据位姿估计结果与期望降落航迹的偏差生成反馈控制力;对降落环境的三维风场进行估计,并将三维风场估计结果解算为风扰补偿力;根据反馈控制力和风扰补偿力对无人机的飞行参数进行修正;

7、近场引导模块,用于根据多源传感数据中的降落平台视觉标识估计无人机与降落平台之间的相对第一位姿;根据接收的降落平台发射的脉冲信号估计无人机与降落平台之间的相对第二位姿;对相对第一位姿与相对第二位姿进行融合,生成相对引导位姿;以及将相对引导位姿反馈至风扰控制模块,以修正期望降落航迹。

8、进一步地,所述定位模块包括:

9、惯性预测单元,用于根据多源传感数据中的惯性测量单元数据,基于误差状态卡尔曼滤波框架进行位姿预测,生成预测位姿;

10、绝对观测融合单元,用于在误差状态卡尔曼滤波框架下,将多源传感数据中的卫星导航数据所携带的绝对位置观测与预测位姿进行融合,生成第一估计位姿;

11、相对观测更新单元,用于当卫星导航数据的信噪比低于预设阈值时,根据多源传感数据中的机载激光雷达点云与预存的环境地图点云进行迭代最近点匹配获取相对位姿,以对预测位姿进行更新,生成第二估计位姿;

12、自适应权重单元,用于根据卫星导航观测噪声协方差与激光雷达观测噪声协方差,按照观测噪声协方差与贡献权重呈负相关的关系,动态调整绝对观测融合单元与相对观测更新单元的贡献权重;根据调整后的贡献权重对第一估计位姿和第二估计位姿进行加权融合,获得位姿估计结果。

13、进一步地,所述风扰控制模块包括:

14、载风感单元,用于将多源传感数据中的空速计数据转换至机体坐标系下的空速,并将定位模块输出的速度估计结果转换至机体坐标系;根据速度估计与空速的矢量差获取机载估计风速;

15、气象站接收单元,用于接收通过控制站发送的风场信息;

16、风场融合估计单元,用于将机载估计风速与风场信息进行坐标系统一,并采用自适应卡尔曼滤波估计三维风场。

17、进一步地,所述风扰控制模块还包括:

18、风场分类单元,用于根据三维风场估计结果识别风扰类型标识:当风速变化率超过预设变化率阈值且持续时间小于预设时间阈值时识别为阵风,当风速功率谱密度在中高频段出现显著峰值时识别为湍流,当垂直方向风速梯度超过预设梯度阈值时识别为风切变;

19、气动解算单元,用于根据预设的无人机气动参数模型,将当前三维风场估计结果中的风速、风向以及无人机的飞行姿态角解算为作用于机体的力和力矩,作为风扰补偿。

20、进一步地,所述风扰控制模块还包括:

21、轨迹跟踪控制单元,用于对由近场引导模块修正后的期望降落航迹进行平滑处理以抑制指令跳变,并根据位姿估计结果、速度估计结果与平滑后的期望降落航迹的偏差以及风扰补偿力,通过线性二次型调节器生成抗扰轨迹指令;

22、增益调度单元,用于根据风扰类型标识查询预设的风扰-增益映射表,获得与当前风扰类型匹配的控制增益参数集,并将控制增益参数集嵌入抗扰轨迹指令,生成增益修正指令;

23、推力分配单元,用于以增益修正指令为期望合力及合力矩输入,以各旋翼电机推力为优化变量,以电机推力饱和约束及旋翼间气动干扰约束为约束条件,通过求解二次规划优化问题获得各旋翼电机的目标推力,对无人机的飞行参数进行修正。

24、进一步地,所述近场引导模块包括:

25、特征提取单元,用于对多源传感数据中的降落平台视觉标识进行对比度增强处理,并通过角点检测算法提取视觉特征点;

26、位姿解算单元,用于结合透视n点算法,根据提取的视觉特征点与预存的视觉标识三维模型点之间的二维到三维对应关系,估算无人机与降落平台之间的相对第一位姿,所述相对第一位姿包含第一相对位置与第一相对姿态。

27、进一步地,所述近场引导模块还包括:

28、信号解码单元,用于对多源传感数据中的红外脉冲数据进行解码,识别各信标的空间编码标识;

29、三角测量单元,用于根据空间编码标识查询预设的信标阵列布局获取各信标的已知空间位置,并结合红外脉冲信号的到达角度和到达时间,通过三角测量法解算无人机与着陆平台之间的相对距离和水平偏移,作为相对第二位姿,所述相对第二位姿仅包含第二相对位置。

30、进一步地,所述近场引导模块还包括:

31、权重计算单元,用于根据当前环境光照强度、视觉特征点的匹配数量及重投影误差计算视觉置信度权重,并根据红外脉冲数据的解码成功率计算红外置信度权重;其中,视觉置信度权重与光照强度正相关、与匹配数量正相关、与重投影误差负相关;红外置信度权重与解码成功率正相关;视觉置信度权重与红外置信度权重之和为1;

32、位姿融合单元,用于根据视觉置信度权重与红外置信度权重,对相对第一位姿中的第一相对位置与相对第二位姿中的第二相对位置进行加权平均,并以相对第一位姿中的第一相对姿态作为融合后的姿态分量,生成相对引导位姿;

33、末段权重调整单元,用于在无人机相对降落平台的高度低于预设切换高度或环境光照强度低于预设光照阈值时,将红外置信度权重调整为大于视觉置信度权重,并重新设定视觉置信度权重以使两者之和保持为1。

34、进一步地,所述控制站包括虚拟控制层中间件,所述虚拟控制层中间件包括:

35、协议适配单元,用于接收当前降落无人机上报的设备标识,根据设备标识中的品牌与型号从预设的协议库中检索对应的协议适配器,并通过动态插件框架加载所述协议适配器的实例;

36、指令翻译单元,用于接收上层调度系统下发的标准化控制指令,按已加载的协议适配器定义的字段映射规则,将标准化控制指令翻译为当前降落无人机原生协议的具体指令报文,并通过控制站与机载终端之间的通信链路下发;

37、数据解析单元,用于基于已加载的协议适配器,将当前降落无人机上报的原始数据反向解析,提取关键状态信息并转换为统一的标准状态数据结构。

38、进一步地,所述数据采集模块包括:

39、时间同步单元,用于对多源传感数据进行时间戳对齐;

40、数据封装单元,用于将时间戳对齐后的多源传感数据封装为融合定位数据包,并输出至定位模块与近场引导模块。

41、本说明书采用的上述至少一个技术方案能够达到以下有益效果:

42、本发明的风扰控制模块基于位姿偏差生成反馈控制力并对降落环境的三维风场估计结果解算生成风扰补偿力,使得控制输出能够抵消环境风场对机体产生的扰动力矩,从而避免纯位置反馈控制存在的响应滞后与动态稳态误差;近场引导模块对视觉标识估计的相对第一位姿与脉冲信号估计的相对第二位姿进行融合生成相对引导位姿,并将该相对引导位姿反馈至风扰控制模块对期望降落航迹进行修正,使得风扰控制的目标轨迹不再是固定僵化的预设曲线,而是能够随近场双模融合观测结果实时动态微调的自适应期望航迹,促使风扰补偿力与反馈控制力均基于该动态修正后的目标进行解算,使得当脉冲信号在光照恶化条件下接管引导并输出相对第二位姿时,该位姿变化能够重塑风扰控制器内部的跟踪目标向量,从而阻断固定航迹与实际可达成着陆点间的偏差累积发散,促使风扰补偿机制在轨迹动态微调后依然能够匹配当前机体相对风场的空气动力学受力状态,避免航迹突变修正引发的附加气动力失稳,从而在低空风扰与光照突变耦合干扰下实现抗扰跟踪与引导的同频动态闭环,保障无人机触地状态连续性与物理接入可靠性。