一种动态场景下摄像模组障碍物测距避障方法与流程
本发明涉及自动导航避障,具体为一种动态场景下摄像模组障碍物测距避障方法。
背景技术:
1、随着自主导航设备的广泛应用,摄像模组作为核心感知器件常被用于构建障碍物感知与避障系统;传统避障系统主要依靠光流估计技术获取连续图像帧间的像素位移,借此推算环境深度信息;在动态场景中,搭载摄像模组的移动设备处于持续运动状态,设备自身运动产生的背景光流场与独立动态障碍物产生的光流场相互叠加,传统光流算法直接处理整幅图像的稠密光流,未对摄像模组自运动与障碍物运动进行物理层面的解耦;未解耦的处理方式使得系统难以准确剥离动态障碍物的边缘轮廓,造成后续特征提取环节出现严重偏差。
2、设备在运行过程伴随着瞬态机械冲击与姿态高频震荡,系统仅依靠图像平面的几何尺度因子求解障碍物绝对物理距离时,高频震荡引发的像素抖动会诱导尺度因子发生突变;尺度因子突变导致测距方程的计算分母趋近于零,引发视觉测距模型失效并输出发散的异常距离数值。
3、现有测距避障方案是将视觉感知端与设备控制端作为独立模块运行,感知端解算出的距离信息需要经过多层数据链路传递至控制端,增加避障响应延迟,控制模块仅以固定的距离阈值作为触发条件,未将障碍物的切向逼近趋势与引斥力势场结合;单一的触发机制导致避障系统在面对高速逼近的非均匀状态障碍物时,难以及时生成直接对抗逼近方向的斥力控制量,造成下发至执行器的避让动作滞后或避让方向偏离安全路径。
技术实现思路
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、此步骤的原理是,执行测距数据的互补融合控制,在视觉信号可靠时由视觉测距分量主导,在门控权重衰减时利用反相余量将主导权平滑交接给历史运动学推算分量,维持测距输出的连续性。
27、进一步的,计算核心特征多边形的投影位移矢量的步骤包括:遍历当前图像帧对应核心特征多边形的所有多边形顶点像素坐标并计算算术平均值获取当前帧几何形心二维坐标;将当前帧几何形心二维坐标与前一帧几何形心二维坐标执行二维向量减法提取表征障碍物切向运动趋势的投影位移矢量;对投影位移矢量执行向量模长归一化处理提取障碍物在二维平面的逼近单位方向向量。
28、此步骤的原理是,通过多边形顶点坐标平均值跟踪特征形心的时域漂移,获取障碍物相对于相机的横向运动趋势,并转换为确定物理避让方向的归一化基准参量。
29、进一步的,根据绝对物理距离生成与投影位移矢量反向的斥力控制矢量的步骤包括:判定绝对物理距离未达到预设系统安全物理防撞半径时,提取绝对物理距离的倒数与预设系统安全物理防撞半径的倒数之差,并将绝对物理距离的倒数与预设系统安全物理防撞半径的倒数之差与绝对物理距离平方的倒数相乘计算斥力基准标量;将斥力基准标量与势场增益系数相乘并通过符号反转映射结合逼近单位方向向量计算生成物理控制量作为斥力控制矢量;将物理控制量映射为横滚通道与俯仰通道上的姿态角控制指令,并将姿态角控制指令下发至执行器中完成避让动作。
30、此步骤的原理是,根据距离倒数之差构建非线性递增的人工势场模型;随着绝对物理距离逼近防撞半径界限,输出的斥力基准标量呈指数级增大,配合投影位移矢量的方向反转映射,转化为底层控制硬件执行躲避的控制参数。
31、本发明提供了一种动态场景下摄像模组障碍物测距避障方法。具备以下有益效果:
32、1、本发明通过利用三维线加速度序列与角速度序列求解摄像模组当前位姿并生成理论背景光流场,将理论背景光流场与实际光流场作差分处理生成残差流场,结合光流散度标量场的光流散度分布全局方差动态分配连通域边缘顶点采样策略,实现摄像模组自运动与独立动态障碍物的运动解耦,从而准确提取并构建适应障碍物平动、三维旋转或非均匀逼近等复杂位姿变化的核心特征多边形。
33、2、本发明通过提取核心特征多边形顶点的仿射尺度因子,将仿射尺度因子的几何容差权重与瞬态机械冲击强度的动力学置信度权重相乘获取总视觉门控权重,并依据总视觉门控权重对视觉测距基准项与运动学推算基准项进行加权融合求解绝对物理距离,在设备发生机械震荡或遭遇视觉尺度特征退化时自动调节融合比例,保证复杂动态场景下连续测距输出的稳定性与抗干扰能力。
34、3、本发明通过计算核心特征多边形形心在二维像素平面的投影位移矢量,以绝对物理距离作触发条件介入人工势场判断,结合绝对物理距离与预设系统安全物理防撞半径计算斥力基准标量,进而生成与投影位移矢量方向相反且幅值受限的斥力控制矢量,使避障系统直接映射输出横滚通道与俯仰通道的姿态角控制指令,建立从视觉惯性联合感知到执行器规避动作的高响应闭环控制。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com