车载单目摄像头与六轴传感器结合测距系统的制作方法

本实用新型属于汽车技术领域，涉及监测，尤其是涉及一种车载单目摄像头与六轴传感器结合测距系统。

背景技术：

目前利用摄像头拍摄当前道路画面并进行行人、车辆等目标的检测与识别，同时利用此摄像头测量当前车辆与目标车辆之间的距离，单纯利用单目摄像头测距会因为摄像头成像质量等问题存在较大的误差；还例如利用双目摄像头测量当前车辆与目标车辆之间的距离，而利用双目摄像头测距又会比摄像头测距增加很多成本，并且数据处理也会较为复杂。

例如，中国专利文献公开了一种车载摄像头[申请号：201380015847.0]，车载摄像头由于在从车载摄像头主体的上面突出的突设部设置透镜，所以与将车载摄像头主体整体配置于托架的下方时相比，能够在距离挡风玻璃最短的位置配置透镜。

上述方案虽然能够通过在用来拍摄监测。但是，仍然存在着在误差较大等技术问题。

技术实现要素：

本实用新型的目的是针对上述问题，提供一种设计合理，能够提高单目摄像头测距精度的车载单目摄像头与六轴传感器结合测距系统。

为达到上述目的，本实用新型采用了下列技术方案：本车载单目摄像头与六轴传感器结合测距系统，设置于车体上，其特征在于，本系统包括单目摄像头、六轴传感器和控制电路，所述的六轴传感器集成安装于车体的仪表盘上且六轴传感器包括能够测量车体的俯仰角、倾斜角、偏航角的陀螺仪和能够测量车体的x轴方向加速度矢量、y轴方向加速度矢量、z轴方向加速度矢量的加速度计，所述的加速度计的x轴与车体高度方向中轴线相互平行、y轴与车体宽度方向中轴线相互平行、z轴与车体长度方向中轴线相互平行，所述的单目摄像头安装于车体的前部，所述的控制电路分别与单目摄像头和六轴传感器相连，所述的单目摄像头的像素主点位于单目摄像头的镜头中心轴线上。

在上述的车载单目摄像头与六轴传感器结合测距系统中，所述的单目摄像头至少能实现相对于车体上下转动以实现上下拍摄角度的修正和/或能实现相对于车体左右转动以实现左右拍摄角度的修正。

在上述的车载单目摄像头与六轴传感器结合测距系统中，所述的单目摄像头包括安装座和镜头，所述的安装座上设有左右转动控制机构且所述的左右转动控制机构由第一伺服电机驱动，所述的左右转动控制机构上设有上下转动控制机构且所述的上下转动控制机构由第二伺服电机驱动，所述的镜头设置在上下转动控制机构上。

在上述的车载单目摄像头与六轴传感器结合测距系统中，所述的单目摄像头安装于车体的前挡风玻璃上且为窄角镜头摄像头，所述的安装座与前挡风玻璃之间设有能使单目摄像头沿着前挡风玻璃横向左右移动的活动连接机构，所述的左右转动控制机构、上下转动控制机构和活动连接机构均与控制电路相连。

与现有的技术相比，本车载单目摄像头与六轴传感器结合测距系统的优点在于：1、设计合理，能够提高单目摄像头测距精度；2、在提高检测性能的同时，降低了制造和使用成本；3、实时监测车子的姿态，根据车子的姿态角度实时修正摄像头的拍摄角度，以避免因视觉盲区造成的目标漏检情况,保障监测正确性，安全可靠。

附图说明

图1是本实用新型提供的结构框图。

图2是本实用新型提供的结构示意图。

图中，车体 1、单目摄像头 2、六轴传感器 3、控制电路 4、陀螺仪 5、加速度计 6。

具体实施方式

如图1、2所示，本车载单目摄像头与六轴传感器结合测距系统，设置于车体1上，包括单目摄像头2、六轴传感器3和控制电路4，六轴传感器3集成安装于车体1的仪表盘上且六轴传感器3包括能够测量车体1的俯仰角、倾斜角、偏航角的陀螺仪5和能够测量车体1的x轴方向加速度矢量、y轴方向加速度矢量、z轴方向加速度矢量的加速度计6，加速度计6的x轴与车体1高度方向中轴线相互平行、y轴与车体1宽度方向中轴线相互平行、z轴与车体1长度方向中轴线相互平行，单目摄像头2安装于车体1的前部，控制电路4分别与单目摄像头2和六轴传感器3相连，单目摄像头2的像素主点位于单目摄像头2的镜头中心轴线上。

更具体的说，单目摄像头2至少能实现相对于车体1上下转动以实现上下拍摄角度的修正和/或能实现相对于车体1左右转动以实现左右拍摄角度的修正。汽车在即将到达坡顶/坡底的瞬间，如果摄像头固定不动，则其视野范围大部分拍到的是天空/地面部分，坡顶/底的路面就会成为视觉盲区，此刻检测不到前车图像，存在隐患，但是根据六轴传感器3进行位置感应后能够实时调整摄像头角度，则可以拍到坡顶/底的路面，检测出存在的障碍物等目标，以保证安全，即：在上坡时，到达坡顶时摄像头向下倾斜，这样可以避免之前摄像头不动只能拍摄到天空而造成的目标漏检情况；在转弯时，如果摄像头固定不动，则弯道上的车或者其他目标检测不到，产生视觉盲区漏检目标而造成危险。

当车体1即将到达坡顶的瞬间，根据设置于车体1前部的六轴传感器1采集到的实时姿态数据控制单目摄像头2的拍摄角度相对于车体1向下调整以使单目摄像头2及时调整至能够拍摄坡顶道路的位置；当车体1即将到达坡底的瞬间，根据设置于车体1前部的六轴传感器1采集到的实时姿态数据控制单目摄像头2的拍摄角度相对于车体1向上调整以使单目摄像头2及时调整至能够拍摄坡底道路的位置；当车体1行驶于弯道时，根据设置于车体1前部的六轴传感器1采集到的实时姿态数据控制单目摄像头2的拍摄角度随着弯道的弯曲方向相对于车体1左右调整以使单目摄像头2及时调整至能够拍摄到弯道的拍摄角度。

当车体1即将到达坡底的瞬间且处于弯道时，根据设置于车体1前部的六轴传感器3采集到的实时姿态数据控制六轴传感器3相对于车体1向上且随着弯道的弯曲方向左右调整以使单目摄像头2及时调整至能够拍摄弯道坡底道路的位置；当车体1即将到达坡底的瞬间且处于弯道时，根据设置于车体1前部的六轴传感器1采集到的实时姿态数据控制单目摄像头2相对于车体1向上且随着弯道的弯曲方向左右调整以使单目摄像头2及时调整至能够拍摄弯道坡底道路的位置。

单目摄像头2包括安装座和镜头，安装座上设有左右转动控制机构且左右转动控制机构由第一伺服电机驱动，左右转动控制机构上设有上下转动控制机构且上下转动控制机构由第二伺服电机驱动，镜头设置在上下转动控制机构上。

单目摄像头2安装于车体1的前挡风玻璃上且为窄角镜头摄像头，安装座与前挡风玻璃之间设有能使单目摄像头2沿着前挡风玻璃横向左右移动的活动连接机构，左右转动控制机构、上下转动控制机构和活动连接机构均与控制电路4相连。

前一时刻加速度计6测得车体1在此时刻的x轴方向加速度矢量为v_0x、y轴方向加速度矢量为v_0y、z轴方向加速度矢量为v_0z，陀螺仪5测得车体1在此时刻的俯仰角为倾斜角为ω₁、偏航角为κ₁，且此时刻目标点的像点坐标为(x₁,y₁)；后一时刻加速度计6测得车体1在此时刻的x轴方向加速度矢量为a_x、y轴方向加速度矢量为a_y、z轴方向加速度矢量为a_z，陀螺仪5测得车体1在此时刻的俯仰角为倾斜角为ω₂、偏航角为κ₂，且此时刻目标点的像点坐标为(x₂,y₂)；前一时刻与后一时刻的时间间隔为t；前一时刻单目摄像头2所在大地坐标为S(X,Y,Z)和后一时刻单目摄像头2所在大地坐标为S'(X',Y',Z')，则由测距算法计算出目标点与单目摄像头2之间的间距为(ΔX,ΔY,ΔZ)。

测距算法如下：前一时刻大地坐标S(X,Y,Z)与后一时刻大地坐标S'(X',Y',Z')之间的距离为(B_X,B_Y,B_Z)，则：大地坐标S(X,Y,Z)与大地坐标S'(X',Y',Z')之间的距离(B_X,B_Y,B_Z)的值计算公式如下：

分别计算大地坐标S(X,Y,Z)与大地坐标S'(X',Y',Z')的旋转矩阵R、R'，从而求得大地坐标S(X,Y,Z)与大地坐标S'(X',Y',Z')的值，计算公式分别如下：

其中，f是单目摄像头2的焦距；

投影系数N和N'的计算公式分别如下：

则单目摄像头2与车体1之间的距离为

本文中所描述的具体实施例仅仅是对本实用新型精神作举例说明。本实用新型所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代，但并不会偏离本实用新型的精神或者超越所附权利要求书所定义的范围。

尽管本文较多地使用了车体1、单目摄像头2、六轴传感器3、控制电路4、陀螺仪5、加速度计6等术语，但并不排除使用其它术语的可能性。使用这些术语仅仅是为了更方便地描述和解释本实用新型的本质；把它们解释成任何一种附加的限制都是与本实用新型精神相违背的。