一种基于视觉定位的系留无人机作业控制方法及系统与流程

摘要: 本申请涉及无人机导航控制与视觉定位,且更为具体地,涉及基于视觉定位的系留无人机作业控制方法及系统。背景技术:1、系留无人机借助地面绞盘与线缆持续供电,摆脱了电池...
一种基于视觉定位的系留无人机作业控制方法及系统与流程

本申请涉及无人机导航控制与视觉定位,且更为具体地,涉及基于视觉定位的系留无人机作业控制方法及系统。

背景技术:

1、系留无人机借助地面绞盘与线缆持续供电,摆脱了电池容量对滞空时长的限制,在应急通讯中继、舰载长时值守、变电站与桥梁巡检等场景中承担长航时定点作业。此类作业环境金属结构密集或处于城市峡谷,卫星导航信号受多径与遮挡干扰,难以支撑稳定的悬停精度,因此需以机载相机为主传感器、辅以惯性测量单元构建视觉定位闭环,维持无人机相对作业目标的位姿稳定。

2、现有方案大致沿三条路线展开:结合线缆张力感知与视觉跟随基站实现无遥控操纵;围绕线缆空间占位进行视觉避障与路径规划;将柔性线缆动力学纳入模型预测控制并由视觉惯性里程计提供状态估计。三者的共同前提是惯性积分能够平滑衔接相邻视觉帧,但系留线缆属分布参数非线性系统,当阵风或基站晃动使机体偏移至线缆极限长度时,线缆由松弛骤然绷紧,产生类似撞墙的高频脉冲力:瞬时加速度超出商用微机电惯性器件量程而削峰饱和,同期曝光窗口内图像严重模糊致特征跟踪中断。此时紧耦合优化框架同时接收错误的惯性预积分量与极少量视觉观测,而其观测噪声协方差为静态分配,无法自适应削弱失效传感器的权重,残差异常放大后被误判为剧烈位姿变化,估计轨迹瞬间飞出实际位置数十米,控制环随之输出极端转速,导致失稳乃至坠机。即便在视觉失效期间转入纯惯性航位推算予以维持,位置误差仍随失效时长以平方量级累积,且输出为不含不确定度描述的裸位姿,后端寻优无从判断其可信区间;失效时长偏长时,累积漂移会超出视觉重定位的邻域搜索范围,恢复过程退化为耗时的全局重初始化。

3、因此,期望一种优化的基于视觉定位的系留无人机作业控制方案。

技术实现思路

1、为了解决上述技术问题,提出了本申请。本申请的实施例提供了一种基于视觉定位的系留无人机作业控制方法及系统。

2、根据本申请的一个方面,提供了一种基于视觉定位的系留无人机作业控制方法,其包括:

3、s1、对采集的多源传感数据流进行同步解析以得到原始惯性比力数据、惯性加工作用率序列、视觉特征点数据和系留物理边界数据;

4、s2、利用滑窗对惯性加工作用率序列进行冲击预判,其中超阈值时生成解耦触发信号,并同步冻结视觉特征点数据与运动学缓存,得到冻结冲击前特征地图和冲击瞬态速度矢量;

5、s3、响应于解耦触发信号,基于系留物理边界数据构建空间球面边界模型,并将冲击瞬态速度矢量投影至球面切平面进行受力推演以得到虚拟单摆轨迹约束数据;

6、s4、致盲期内依据虚拟单摆轨迹约束数据进行推力反向补偿以抑制水平漂移,并对原始惯性比力数据进行滑窗方差判别,其中方差收敛时生成冲击消退恢复信号并锁存盲飞末态位姿数据;

7、s5、响应于冲击消退恢复信号,以盲飞末态位姿数据为初值先验,对视觉特征点数据与冻结冲击前特征地图进行透视投影匹配解算以得到重构当前位姿数据,其中,重构当前位姿数据被用于控制系留无人机继续定点作业。

8、根据本申请的另一个方面,提供了一种基于视觉定位的系留无人机作业控制系统,其包括:

9、多源传感同步解析模块,用于对采集的多源传感数据流进行同步解析以得到原始惯性比力数据、惯性加工作用率序列、视觉特征点数据和系留物理边界数据;

10、瞬态冲击预判解耦模块,用于利用滑窗对惯性加工作用率序列进行冲击预判,其中超阈值时生成解耦触发信号,并同步冻结视觉特征点数据与运动学缓存,得到冻结冲击前特征地图和冲击瞬态速度矢量;

11、虚拟单摆约束推演模块,用于响应于解耦触发信号,基于系留物理边界数据构建空间球面边界模型,并将冲击瞬态速度矢量投影至球面切平面进行受力推演以得到虚拟单摆轨迹约束数据;

12、盲飞漂移抑制与末态锁存模块,用于致盲期内依据虚拟单摆轨迹约束数据进行推力反向补偿以抑制水平漂移,并对原始惯性比力数据进行滑窗方差判别,其中方差收敛时生成冲击消退恢复信号并锁存盲飞末态位姿数据;

13、暖启动位姿重构模块,用于响应于冲击消退恢复信号,以盲飞末态位姿数据为初值先验,对视觉特征点数据与冻结冲击前特征地图进行透视投影匹配解算以得到重构当前位姿数据,其中,重构当前位姿数据被用于控制系留无人机继续定点作业。

14、有益效果:

15、与现有技术相比,本发明提出一种基于视觉定位的系留无人机作业控制方法,其不让估计器在传感器失效期内继续融合失真数据,而以惯性高阶变化作为冲击征兆,在图像模糊与惯性饱和污染状态量之前切断视觉与惯性的耦合,并原样封存冲击前的视觉特征与运动状态;致盲期改由线缆长度与高度构成的几何边界接管位姿维持,把不可观的水平漂移约束在可解析的球面轨迹上并据此反向补偿推力,避免双重积分自由发散;惯性读数恢复平稳后,以致盲期推得的位姿及其量化可信度为初值先验,与封存特征直接匹配解算,在小范围搜索内一次完成重连。由此,发散被前置规避而非事后修正,漂移被几何真值压制并附带置信描述,定位恢复不再退化为全局冷启动,进而提高系留无人机相对作业目标的位姿稳定。

1.一种基于视觉定位的系留无人机作业控制方法,其特征在于,包括:

2.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,多源传感数据流包含机载惯性比力信号、机载相机图像信号、气压计高度信号和地面绞盘排线长度信号。

3.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s1,包括:

4.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s2,包括:

5.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s3,包括:

6.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s4,包括:

7.根据权利要求1所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s5,包括:

8.根据权利要求6所述的基于视觉定位的系留无人机作业控制方法,其特征在于,步骤s43,包括:

9.一种基于视觉定位的系留无人机作业控制系统,其特征在于,包括:

10.根据权利要求9所述的基于视觉定位的系留无人机作业控制系统,其特征在于,所述盲飞漂移抑制与末态锁存模块,包括: