专利名称：一种基于单应性变换矩阵的分段空间对准方法
技术领域：
本发明涉及无人车多传感器信息融合技术领域，具体涉及一种基于单应性变换矩阵的分段空间对准方法。
背景技术：
无人车又称室外智能移动机器人，是一种集环境感知、动态决策与规划、行为控制与执行等多功能为一体的智能化程度很高的装置，其对环境感知的快速性、准确性与多传感器信息融合技术密不可分。多传感器信息融合技术就是计算机充分利用各传感器资源，通过对各种量测信息的合理支配和使用，在空间和时间上把互补与冗余信息依据某种优化准则结合起来，产生对观测环境的一致性解释或描述，同时产生新的融合结果。在环境感知模块，视觉传感器和毫米波雷达是常用的两种传感器。视觉传感器检测范围广、能够获得外界环境中目标的尺寸和轮廓信息，但它易受外界因素影响，存在目标缺失问题。而毫米波雷达分辨率高、抗干扰能力强，可在各种天气环境下准确获得目标的距离、相对速度和方位角信息，但不能识别目标形状和大小，因此，利用这种互补特性融合两者信息，得到更加全面、可靠的环境信息。而空间对准是两者信息融合的前提。空间对准实质是估计摄像机和雷达坐标系间的变换矩阵关系。目前，传统空间对准方法中，在20米的标定距离范围内，在不同的距离点上，随机对目标上的点进行探测，分别得到目标在摄像机中的坐标系表达和雷达坐标系中的表达，根据两个传感器获取的数据，估计由缩放比例因子、焦距等构成的摄像机内部参数矩阵以及旋转矩阵、平移向量构成的摄像机外部参数矩阵，该计算过程比较繁琐，也容易引入误差；另外，根据上述算法对超过20米的标定距离的目标进行求解变换矩阵时，由于范围较大，因此巨大的误差，导致空间对准失败。
发明内容
有鉴于此，本发明提供 了一种基于单应性变换矩阵的分段空间对准方法，能够在较大的标定距离范围内实现无人车装载的摄像机和毫米波雷达的空间对准，同时还能简化求解单应性变换矩阵的计算过程。本发明的一种基于单应性变换矩阵的分段空间对准方法，包括如下步骤步骤1:建立摄像机坐标系与毫米波雷达坐标系之间的基于单应性变换矩阵的关系定义摄像机的图像坐标系O' uv，其中O'位于摄像机成像平面的左上角；u轴与摄像机扫描行方向平行轴垂直于摄像机扫描行方向；定义O" " P Θ为毫米波雷达极坐标系，O""为毫米波雷达表面的中心；P为目标与毫米波雷达间的直线距离；Θ为目标偏离毫米波雷达扫描平面中心线的角度，则摄像机的图像坐标系O' Uv与毫米波雷达极坐标系O" " P Θ之间关系表示为
权利要求
1.一种基于单应性变换矩阵的分段空间对准方法，其特征在于，包括如下步骤 步骤1:建立摄像机坐标系与毫米波雷达坐标系之间的基于单应性变换矩阵的关系定义摄像机的图像坐标系O' UV，其中O'位于摄像机成像平面的左上角；u轴与摄像机扫描行方向平行；v轴垂直于摄像机扫描行方向； 定义O" " P Θ为毫米波雷达极坐标系，O""为毫米波雷达表面的中心；P为目标与毫米波雷达间的直线距离；Θ为目标偏离毫米波雷达扫描平面中心线的角度，则摄像机的图像坐标系O' Uv与毫米波雷达极坐标系O" " P Θ之间关系表示为
2.如权利要求1所述的一种基于单应性变换矩阵的分段空间对准方法，其特征在于，当步骤2的标定距离为50米时，0-20米为近距范围，均分成4段；20-50米为远距范围，均分成3段。
3.如权利要求1所述的一种基于单应性变换矩阵的分段空间对准方法，其特征在于，所述步骤4中计算标定目标图像中的每一小段图像的质心坐标的方法如下 S40、手动选取含有标定目标的候选区域； S41、对候选区域图像进行中值滤波，消除图像中的噪声； S42、对候选区域图像进行Sobel算子边缘检测，得到二值化的标定目标边缘图像； S43、在以像素为单位的图像坐标系中，沿u轴寻找标定目标边缘图像中的坐标最小值和最大值的u轴像素点坐标Umin, Umax,沿V轴寻找标定目标边缘图像中的坐标最小值和最大值的V轴像素点坐标Vmin, Vmax，将上述4点按顺时针或者逆时针方向用直线连接,形成一个 四边形区域，在该四边形区域内，利用公式
全文摘要
本发明公开了一种基于单应性变换矩阵的分段空间对准方法，通过对较大的标定距离进行分段，针对每一分段分别求得摄像机和毫米波雷达坐标系之间的单应性变换矩阵，避免了现有技术中由于用同一个单应性变换矩阵表达两个传感器之间的坐标关系引起的误差，从而能够实现对较大标定距离目标探测的空间对准；通过推导表征摄像机和毫米波雷达的不同坐标系之间的关系，最后采用单应变换矩阵N表征两者的坐标系关系，用两个传感器分别获得的目标数据再解得单应变换矩阵N，避免了求解缩放比例因子、焦距等构成的摄像机内部参数矩阵以及旋转矩阵、平移向量构成的摄像机外部参数矩阵，大大简化了运算过程，节省运算时间。
文档编号G06T7/00GK103065323SQ20131001304
公开日2013年4月24日 申请日期2013年1月14日 优先权日2013年1月14日
发明者付梦印, 靳璐, 杨毅, 宗民 申请人:北京理工大学