一种无GPS信号下的室内无人机自主飞行系统的制作方法

摘要: 本发明属于无gps室内无人机自主导航与飞行控制,具体为一种无gps信号下的室内无人机自主飞行系统。背景技术:1、在无卫星定位信号的室内环境中,无人机通常依靠彩色...
一种无GPS信号下的室内无人机自主飞行系统的制作方法

本发明属于无gps室内无人机自主导航与飞行控制,具体为一种无gps信号下的室内无人机自主飞行系统。

背景技术:

1、在无卫星定位信号的室内环境中,无人机通常依靠彩色深度相机、惯性测量模块和激光雷达获取周围环境信息,并通过同步定位与地图构建方法估计自身位姿。常规方案将图像中的角点、边缘或纹理特征与相邻帧进行匹配,根据深度信息恢复局部三维结构;同时对惯性测量序列进行预积分,获得短时间内的姿态和位移增量;激光点云则通过平面、边缘或邻域几何关系提供距离约束。各类观测数据经时间同步后进入滑动窗口或图优化框架,通过减小视觉重投影误差、点云配准误差和惯性残差得到无人机位姿,并将估计结果发送给飞行控制器。飞行控制器依据目标航点与当前位姿之间的偏差生成速度、姿态和推力控制量,使无人机沿预设路径飞行,定位与控制在处理流程上通常保持单向数据传递。

2、现有多传感器融合方案在观测质量下降时,通常采用调整视觉、惯性和激光观测权重,剔除残差较大的测量数据,扩大状态协方差,或者暂时依赖惯性传播维持位姿连续。部分方案还会在地图中选取稳定的墙角、立柱、设备轮廓或货架节点作为长期特征,通过回环检测或语义匹配修正累计误差。对于飞行控制,常见做法是在定位置信度下降后降低飞行速度、进入悬停状态或者沿原航迹回撤,待传感器重新获取足够特征后恢复任务。此类方案的处理重点仍然是对已经产生的低质量观测进行筛选和补偿,飞行控制动作通常由航迹跟踪误差和障碍距离决定,未将不同位姿自由度的观测约束强弱纳入控制指令生成过程,也未根据缺失约束的方向主动改变无人机运动,以获得能够补充位姿估计的信息。

3、当无人机进入弱纹理墙面、重复货架、狭长走廊或几何结构方向单一的区域时,视觉特征、点云几何关系和惯性信息可能同时无法对某一平移自由度或转动自由度形成充分约束。现有融合方法只能在观测产生后重新分配权重或依赖历史状态传播,不能改变导致观测退化的运动状态和视角关系,因而无法从数据来源上恢复缺失的位姿约束。位姿估计中的方向性误差会持续传递至飞行控制器,飞行控制器又按照偏差状态继续执行原航迹,使视差、点云截面和惯性激励长期保持不足,形成定位退化与控制运动相互强化的闭环。该过程会造成位置漂移、姿态偏差和地图错位逐步累积,并造成控制参考状态失真,使无人机难以在定位完全失效前恢复可用的状态约束。

技术实现思路

1、本发明的目的在于提供一种无gps信号下的室内无人机自主飞行系统,可以解决上述背景技术中的问题。

2、为实现上述目的,本发明采取的技术方案为:

3、一种无gps信号下的室内无人机自主飞行系统,包括多传感器融合感知模块、工业控制软件处理模块和飞行控制模块;

4、所述多传感器融合感知模块同步采集rgb-d图像、imu测量序列和激光点云;

5、所述工业控制软件处理模块对同步数据执行视觉特征约束提取、惯性预积分、点云几何约束构建及滑动窗口状态估计,并依据各约束对无人机位姿自由度的约束强度生成可观测性状态;

6、所述飞行控制模块在所述可观测性状态表征至少一位姿自由度退化时,从满足当前航迹边界和障碍距离约束的候选微幅位移、偏航或高度调整动作中确定主动激励动作;

7、所述工业控制软件处理模块利用执行所述主动激励动作后获得的新增同步数据更新滑动窗口状态估计,并将更新后的位姿状态发送至所述飞行控制模块。

8、优选的,所述工业控制软件处理模块按照统一时间基准对所述rgb-d图像、所述imu测量序列和所述激光点云进行时间对齐,在连续滑动窗口内分别生成视觉特征空间分布矩阵、深度连续性矩阵、点云法向量方向分布矩阵和惯性偏置演化序列,并基于各矩阵与惯性偏置演化序列构建位姿增量对观测残差的灵敏度矩阵;

9、对所述灵敏度矩阵进行方向分解以获得平移自由度和转动自由度对应的约束特征值,将连续多个滑动窗口内低约束特征值对应的自由度及其变化趋势编码为所述可观测性状态。

10、优选的,所述工业控制软件处理模块从所述rgb-d图像和所述激光点云中提取墙角、立柱边缘、设备轮廓及货架交叉节点对应的语义对象,为跨帧保持空间一致性的所述语义对象建立语义锚点,并将视觉重投影约束、激光平面或边缘约束、惯性预积分约束和语义锚点相对位姿约束写入动态因子图;

11、所述动态因子图依据所述可观测性状态确定参与边缘化的状态变量集合,将低约束特征值对应自由度关联的语义锚点约束保留于后续滑动窗口,并基于更新后的动态因子图生成位姿状态。

12、优选的,所述飞行控制模块依据所述可观测性状态确定退化自由度及对应的观测缺失方向,围绕当前参考航迹生成横向平移候选序列、偏航扫描候选序列和高度微调候选序列;

13、利用无人机运动学约束、当前速度约束、姿态变化率约束、三维语义地图中的自由空间边界及动态障碍物预测包络筛除不可执行候选动作,并针对剩余候选动作预测新增视觉视差、激光截面变化和惯性激励分量,根据预测结果确定所述主动激励动作及其与当前参考航迹的连接轨迹。

14、优选的,所述工业控制软件处理模块将相邻滑动窗口的约束特征值、所述视觉特征空间分布矩阵的主方向、所述点云法向量方向分布矩阵的集中方向及所述惯性偏置演化序列输入退化演化模型;

15、所述退化演化模型通过保持各数据与对应位姿自由度的索引关系,生成未来预设控制时域内各位姿自由度的约束特征值序列,并依据所述约束特征值序列确定退化起始窗口、持续窗口数量和退化方向;

16、将所述退化起始窗口之前的控制周期标记为主动激励触发区间,所述飞行控制模块在所述主动激励触发区间内根据当前位姿状态生成所述主动激励动作。

17、优选的,所述工业控制软件处理模块为每一语义锚点建立包含语义类别、三维位置、跨帧观测次数、观测方向集合和局部几何描述子的锚点状态记录,并根据所述可观测性状态选择与退化自由度具有非共线约束关系的候选语义锚点;

18、将所述候选语义锚点在所述主动激励动作执行前后的观测方向差异写入所述动态因子图;

19、对于重复结构区域内局部几何描述子相近的多个语义锚点,结合imu传播位姿限定匹配搜索域,并仅保留满足语义类别一致、相对距离一致和观测方向连续条件的语义锚点关联。

20、优选的,所述飞行控制模块将所述主动激励动作离散为多个控制节点,并在各控制节点处根据三维语义地图生成与无人机外包络相匹配的局部安全可行域;

21、将连接轨迹表示为当前参考航迹与主动激励动作轨迹之间的连续过渡曲线,所述连续过渡曲线的控制点同时受局部安全可行域、速度连续条件、加速度连续条件和退化自由度所需观测基线方向约束;

22、当动态障碍物预测包络与任一控制节点的局部安全可行域相交时,沿保持观测基线方向的剩余自由方向重构对应控制点。

23、优选的,所述工业控制软件处理模块在所述主动激励动作执行期间,按照控制周期计算新增视觉特征的视差分布、激光点云截面差异、退化自由度对应的约束特征值和位姿协方差变化量,并将各控制周期的数据与所述主动激励动作执行前的基准窗口进行对应比较;

24、当连续控制周期内退化自由度的约束特征值未形成恢复趋势时,所述工业控制软件处理模块向所述飞行控制模块发送减速控制量,并锁定所述基准窗口对应的局部参考位姿;

25、所述飞行控制模块按照所述局部参考位姿执行受限悬停或沿已验证自由空间反向回撤。

26、优选的,所述飞行控制模块采用滚动时域方式执行连续过渡曲线规划;

27、在每一滚动时域起点读取更新后的可观测性状态、动态障碍物预测包络和局部安全可行域,仅固化当前滚动时域内首个控制节点对应的控制指令,并基于新增同步数据重新计算后续控制节点;

28、所述工业控制软件处理模块将已经执行的控制指令作为确定性运动约束写入下一滑动窗口的状态估计,并根据退化自由度的约束特征值变化重新确定观测基线方向,使未执行部分的控制点沿更新后的观测基线方向进行连续重构。

29、优选的,还包括边缘计算节点;

30、所述工业控制软件处理模块将各候选窗口对应的局部地图摘要、可观测性状态、候选主动激励动作及各候选主动动作的预测观测增量分别构建候选观测因子图,并同步计算各候选观测因子图的条件数变化和位姿协方差传播因子,返回带有状态版本号和时间戳的候选排序结果;

31、所述工业控制软件处理模块仅在所述状态版本号与当前滑动窗口一致且时间戳位于当前控制时限内时采用候选排序结果,否则依据机载端当前计算结果维持受限悬停或反向回撤。

32、与现有技术相比,本发明的有益效果在于:

33、1.通过对彩色深度图像、惯性测量序列和激光点云进行统一时间对齐,并在滑动窗口内构建各类观测对平移自由度和转动自由度的约束强度,可在定位结果尚未完全失效时识别具体退化方向。飞行控制根据退化方向生成受航迹边界、障碍距离、速度和姿态变化率限制的横向位移、偏航扫描或高度调整动作,使无人机改变传感器视角和运动基线。动作执行后产生的新增视差、点云截面变化和惯性响应继续写入状态估计过程,使原本缺失约束的自由度获得新的观测关系。由此,定位不确定性不再仅作为事后补偿依据,而是直接参与飞行控制指令生成,形成观测约束评估、主动运动调整和位姿更新相互闭合的控制过程,可抑制方向性误差持续进入飞行控制回路,减少定位退化与原航迹运动相互强化造成的漂移累积。

34、2.将墙角、立柱边缘、设备轮廓和货架交叉节点建立为跨帧语义锚点,并将语义锚点约束、视觉重投影约束、激光几何约束和惯性预积分约束共同纳入动态状态估计,可在重复结构和局部遮挡条件下保持观测关联的连续性。根据退化自由度保留具有非共线约束关系的语义锚点,能够降低相似结构之间错误匹配对位姿更新的干扰。主动激励动作采用连续过渡轨迹和滚动时域执行方式,并在每个控制周期依据更新后的可观测状态、局部安全可行域和动态障碍预测结果重新计算未执行部分,可避免一次性动作在环境变化后继续执行。边缘计算节点对候选动作的观测条件变化和位姿协方差传播结果进行并行计算,机载端仅采用版本一致且处于控制时限内的结果,在保持控制连续性的同时减少候选动作求解占用的机载计算资源。