一种基于单目相机和主动结构光的障碍探测方法
【技术领域】
[0001] 本发明涉及一种基于单目相机和主动结构光的障碍探测方法，适用于在月球、火 星等外星球表面进行探测任务的巡视器的障碍识别，也可用于在野外恶劣环境进行作业的 移动机器人的障碍识别。
【背景技术】
[0002] 巡视探测器在行星工作阶段，需要控制巡视探测器在非结构复杂地面环境中实现 长距离行驶，并安全到达预先指定的工作点，以完成特定的科学考察任务，并保障自身的安 全和稳定工作。由于行星表面环境的不可预知性，巡视器必须具有环境感知的能力，在选择 配备了立体相机作为环境感知的主要手段之后，考虑到行星表面阴影区完全无光照，巡视 器进入阴影区或背对太阳时无法探测环境进行安全行走，所以考虑增加主动结构光，利用 投射出的离散激光点进行阴影区内的障碍识别判断，保证行走安全。
[0003] 针对相机和主动结构光的障碍探测方式，考虑冗余配置问题，设计了主动结构光 分别和双目相机、左单目、右单目相机配合的三种工作方式。其中双目相机的方式类似立体 视觉重建，而单目相机和主动结构光的配合使用，就需要用到结构光本身的信息，为此提出 了激光点空间出射方程的高精度标定方法，在主动结构光加工完成后，在地面进行了离散 激光出射线的标定，通过标定结果和相机拍摄的激光点图像实现了主动结构光和左相机或 者右相机的激光点坐标解算，保证在任何一个相机失效的情况下，主动结构光探测仍能进 行，提高了结构光探测的可靠性和安全性。
【发明内容】
[0004] 本发明要解决的技术问题是：为克服现有技术的不足，提出一种基于单目相机和 主动结构光的障碍探测方法，在基准相机失效的情况下，利用备份相机仍能实现障碍物的 快速识别和判断。
[0005] 本发明技术解决方案：
[0006] 一种基于单目相机和主动结构光的障碍探测方法，具体步骤如下：
[0007] (1)基准相机与主动结构光坐标标定
[0008] 在主动结构光的外部粘接基准镜作为外测基准建立基准镜下坐标系，同时将 基准镜作为基准相机虚拟坐标系的外引基准，建立与主动结构光外测基准之间的关系， 得到基准相机坐标系下主动结构光出射线的标定方程；假设主动结构光一共设计有N 个激光出射点，标定得到的主动结构光的出射线方程在基准相机坐标系下的描述如下
【主权项】
1. 一种基于单目相机和主动结构光的障碍探测方法，其特征在于，具体步骤如下： (1) 基准相机与主动结构光坐标标定 在主动结构光的外部粘接基准镜作为外测基准建立基准镜下坐标系，同时将基准 镜作为基准相机虚拟坐标系的外引基准，建立与主动结构光外测基准之间的关系，得 到基准相机坐标系下主动结构光出射线的标定方程；假设主动结构光一共设计有N个 激光出射点，标定得到的主动结构光的出射线方程在基准相机坐标系下的描述如下
(A0i，B0i，C0i)为直线上一点坐标，（Pi，qi，ri)为直 线的矢量方向；用基准相机对激光点成像，得到基准图像； (2) 备份相机与基准相机坐标转换 可另设备份相机，备份相机到基准相机坐标系的转换矩阵为
，平移 矩阵为
，同时用备份相机对激光点成像，得到备份图像； (3) 激光图像处理 将步骤（1)及步骤（2)得到的基准图像和备份图像中灰度值大于灰度阈值的像素点分 割出来，剔除伪激光点及由其他杂光在图像中引起的噪点； 根据从图像中提取出的激光点的能量中心，得到激光点能量中心在基准图像中的坐标 和备份图像中的坐标，并确定图像中的激光点对应的编号； (4) 激光点三维恢复 结合相机参数，对步骤（3)中识别出的各激光点的坐标进行校正，消除其畸变误差，进 行基准相机、备份相机与主动结构光的坐标解算，激光点在基准图像上三维坐标确定方法 为：
其中为基准相机焦距，（xli,ylDi= 1?N为基准图像中激光点坐标，
M= (A)_1C 其中M= 〇^)6><1，（A)4表示对矩阵A进行逆运算
得到激光点的三维坐标； 其中（xp(i),yp(i),zp⑴）i= 1?N为地面投射的主动结构光点在基准相机坐标系下 的坐标； 激光点在备份图像上二维坐标确定方法为：
其中： f2为备份相机焦距，（x2i，y2i)i= 1?N为备份图像中激光点的坐标， Ll-(r 23X2i+r2lf2) * (r33y2i+r32f2) _ (r33X2i+r3lf2) * (r23y2i+r22f2) [2 - _(r 33X2i+r3lf2) * (ri3y2i+ri2f2) + (ri3X2i+rilf2) * (r33y2i+r32f2) L3- _(r 13X2i+rilf2) * (r23y2i+r22f2) + (r23X2i+r2lf2) * (ri3y2i+ri2f2)
M= (A)_1C 其中M= (11^)6><1，（Ar1表示对矩阵A进行逆运算
得到激光点的三维坐标； 其中（xp(i),yp(i),zp⑴）i= 1?N为地面投射的主动结构光点在备份相机坐标系下 的坐标； (5)障碍判断 结合相机的安装及巡视器的姿态，得到由相机坐标系到水平坐标系的转换矩阵，然后 进行平面拟合，得到各激光点到拟合平面的距离，进而判断激光投射区域是否存在障碍。
2.根据权利要求1所述的一种基于单目相机和主动结构光的障碍探测方法，其特征在 于：所述步骤（5)中相机坐标系的定义为：原点位于相机光心，Z。轴沿相机的光轴向前，与 图像平面垂直，X。轴与Z。轴垂直，指向相机系统的右侧，Y。轴与X。轴、Z。轴满足右手定则。
【专利摘要】本发明公开了一种基于单目相机和主动结构光的障碍探测方法，实现步骤包括基准相机与主动结构光坐标标定、备份相机与基准相机坐标转换、激光图像处理、激光点三维恢复、障碍判断。本发明能够在阴影区域或者缺乏纹理特征区域进行环境感知；利用结构光的先验信息和单个相机配合进行快速三维恢复，计算量小，处理时间短，能够实现障碍物的快速识别和判断。
【IPC分类】G01V8-10, G01C3-00
【公开号】CN104570147
【申请号】CN201410829101
【发明人】毛晓艳, 邢琰, 刘祥, 滕宝毅, 贾永
【申请人】北京控制工程研究所
【公开日】2015年4月29日
【申请日】2014年12月26日