一种用于夜视的车辆周围环境三维重构方法

1.一种用于夜视的车辆周围环境三维重构方法，其特征在于包括以下步骤：
第一步，构建基于三维激光雷达传感器的夜视系统，该系统的硬件由车载三维激光雷达传感器、计算机及显示器组成；该系统的软件为三维重构软件，由环境网格模型生成模块及模型颜色渲染模块组成；三维激光雷达传感器实时监测和感知车辆周围环境，将从周围环境获得的三维点云按固定的格式发给计算机；计算机装有三维重构软件，三维重构软件对计算机收到的激光雷达三维点云进行三维重构，生成车辆周围三维环境图像，最后将三维环境图像转换成视频流输出给显示器；显示器将视频流在屏幕上显示；在三维重构软件中，环境网格模型生成模块首先由三维点云生成环境高度图，然后对环境高度图进行三角面片化，生成三角网格环境模型，并将三角网格环境模型发送给模型颜色渲染模块；模型颜色渲染模块计算三角网格环境模型中每个三角面片的颜色后生成三维重构图像并输出给显示器；
第二步，环境网格模型生成模块首先由三维点云生成环境高度图，然后对环境高度图进行三角面片化，生成三角网格环境模型，步骤是：
步骤2.1，使用Pfaff于2007年在《机器人研究》杂志上发表的《用于户外地形建模和循环闭合的有效扩展高度图》一文中提出的扩展高度图方法建立环境高度图Pgm，环境高度图Pgm是2.5维等间距栅格地图，其数据组织结构为二维结构体，每个二维结构体代表一个栅格，有四个属性组成，分别记为x、y、z、ocp，x和y表示栅格的中心在XY平面上的坐标，z表示栅格的高度，ocp表示栅格是否有投影或者被插值；
步骤2.2，使用Der-Tsai Lee于1980年在《计算机与信息科学》杂志上发表的《构建Delaunay三角划分的两种方法》一文中提到的Delaunay三角划分方法对环境高度图Pgm进行三角划分生成三角网格环境模型Em＝{s1,s2,...,si,...,sn}，n为三角面片的总个数；Em从数据组织结构上为一维结构体，结构体si表示一个三角面片，包含三个顶点和一个颜色属性，分别记为pi1、pi2、pi3和ci，i为整数且1≤i≤n；
第三步，模型颜色渲染模块按照预定光照模型对三角网格环境模型中每个三角面片的着色，生成三维重构图像并显示，步骤是：
步骤3.1，令i＝1；
步骤3.2，计算汽车虚拟大灯到三角面片si的入射光强LIi和入射光方向vi，当三角面片面积小于0.1m2时，照射在三角面片上每个区域的光近似等于照射在三角面片中心点上的光；
步骤3.2.1，由公式(1)计算三角面片si的中心点Qi；
Qi＝(pi1+pi2+pi3)/3   公式(1)
步骤3.2.2，由公式(2)计算虚拟大灯到三角面片si的距离Li；
Li＝|P0-Qi|   公式(2)
步骤3.2.3，由公式(3)计算入射光方向vi；
   公式(3)
步骤3.2.4，由公式(4)计算虚拟大灯光轴与虚拟大灯到三角面片si入射光的夹角Ai，其中P0＝[0,1,0]T为虚拟大灯的位置，n0＝[0,1,0]T为虚拟大灯的光轴单位方向；
   公式(4)
步骤3.2.5，由公式(5)(6)分别计算距离衰减系数DAi和角度衰减系数AAi，其中Dth表示虚拟大灯的灯光最远传播距离，Ath表示虚拟大灯的散射锥角；
   公式(5)
   公式(6)
步骤3.2.6，由公式(7)计算照射到三角片面si的光强LIi，其中Llight为虚拟大灯的发光光强，
LIi＝Llight·DAi·AAi   公式(7)
步骤3.3，计算人眼接收的由三角面片si反射的光强；
步骤3.3.1，由公式(8)计算三角面片si的面法向量Ni，其中运算因子×表示向量的叉乘；
Ni＝(pi3-pi1)×(pi2-pi1)   公式(8)
步骤3.3.2，由公式(9)计算入射光方向vi和三角面片面法向量Ni之间的夹角余弦cos(θi)；
   公式(9)
步骤3.3.3，计算vi的反方向关于Ni的单位镜像Ri，Ri即为反射光方向；
步骤3.3.4，由公式(10)计算观察方向Vi，并由公式(11)反射光方向Ri和观察方向Vi之间的夹角余弦 其中H0为观察者的位置；
   公式(10)
   公式(11)
步骤3.3.5，由公式(12)计算观察者从三角面片si接收的反射光强LOi，其中Kd为漫反射系数，Km为镜面反射系数，
   (公式12)
步骤3.4，由公式(13)计算三角面片si的颜色ci，若ci＞255，则令ci＝255；
ci＝255·LOi1.5   公式(13)
步骤3.5，若i＞n，转步骤3.6；否则令i＝i+1并转步骤3.2；
步骤3.6，将着色后的三角网格环境模型Em生成三维重构图像输出给显示器。
2.如权利要求1所述的一种用于夜视的车辆周围环境三维重构方法，其特征在于所述车载三维激光雷达传感器要求帧率10Hz以上，输出大于50万点/秒。
3.如权利要求1所述的一种用于夜视的车辆周围环境三维重构方法，其特征在于2.1步建立的环境高度图具体参数为：地图X方向范围为(-30m,30m)，Y方向范围为(-30m,30m)，每个栅格的占据空间为20×20cm2。
4.如权利要求1所述的一种用于夜视的车辆周围环境三维重构方法，其特征在于所述Dth＝50，Ath＝75，Llight＝2，Kd＝0.3，Km＝0.8。

一种用于夜视的车辆周围环境三维重构方法\n技术领域\n[0001] 本发明涉及图形图像处理领域，具体地涉及一种用于夜视的车辆周围环境三维重构方法。\n背景技术\n[0002] 据统计，道路交通事故有80%以上发生在夜间，而大多数重大交通事故和逃逸案件都发生在夜间。夜间行驶最大的安全隐患是由于夜间微光或无光条件下存在许多视觉盲区，使得驾驶员无法充分观察和掌握道路走向，并且很难将车辆周围的所有具有威胁的障碍（如护栏、巨石、行人、沟渠和前向车辆等）全部掌握，导致事故频发。因此，针对车辆在夜间微光或无光条件下驾驶中存在的问题，开发相应的车辆周围环境的场景增强系统，能够有效的提高夜间行车的安全性。\n[0003] 在军事行动中，为了躲避敌方卫星的侦查，车辆（如导弹车、坦克、装甲车及运输车）需要在夜间无光的环境中进行机动；为了达到隐蔽性目的，这些车辆大多时候都要在道路结构复杂的环境中进行机动。这些限制因素综合起来，对军用车辆的驾驶带来了极大的挑战。\n[0004] 目前，用于车辆夜间辅助驾驶的传感器主要有：高动态摄像机、微光夜视仪和红外夜视仪。高动态摄像机成本低，夜间使用需要配合辅助照明，并且需要额外的对比度增强和强光抑制算法配合，鲁棒性不强；微光夜视仪具有体积小、重量轻和工作安全性很高的优点，但是其作用距离和观察效果受环境影响很大，在无光环境下不可用；主动式红外夜视图像有图像较为清晰、对比度大的优点，但其需要主动红外照明，存在特征暴露风险，且其受环境影响较大，怕强光直射。\n[0005] 传统的激光雷达数据可视化方法主要有以下两种：一是直接表示法，即将激光雷达数据转换为三维点云显示或者按照数据的逻辑关系生成二维深度图显示，这种显示方法高度抽象，人无法直接理解其含义；二是栅格地图表示法，即将数据投影到二维栅格地图，并按照栅格的某个属性对栅格赋以颜色后显示，这种方法生成的模型在空间上不连续，且着色方法不符合人类的理解方法。\n[0006] 综上所述，目前的夜视方法普遍存在分辨率不高、对比度不强和边缘不清晰的缺点，难以适应无光或微光的夜间环境，且受强光的影响很大，不能满足辅助驾驶员在夜间驾驶的全部需求。\n发明内容\n[0007] 本发明要解决的技术问题是提供一种用于夜视的车辆周围环境三维重构方法，通过此方法构建车辆周围的三维环境，为驾驶员提供驾驶辅助，使驾驶员在无光下仍然有很好的视野，并且对驾驶员的视野盲区进行显示增强。\n[0008] 本发明的技术方案如下：\n[0009] 第一步，构建基于三维激光雷达传感器的夜视系统，该系统的硬件由车载三维激光雷达传感器（帧率10Hz以上，输出大于50万点/秒）、计算机及显示器组成；该系统的软件为三维重构软件，由环境网格模型生成模块及模型颜色渲染模块组成。三维激光雷达传感器实时监测和感知车辆周围环境，将从周围环境获得的三维点云按固定的格式发给计算机；计算机装有三维重构软件，三维重构软件对计算机收到的激光雷达三维点云进行三维重构，生成车辆周围三维环境图像，最后将三维环境图像转换成视频流输出给显示器；显示器将视频流在屏幕上显示。在三维重构软件中，环境网格模型生成模块首先由三维点云生成环境高度图，然后对环境高度图进行三角面片化，生成三角网格环境模型，并将三角网格环境模型发送给模型颜色渲染模块；模型颜色渲染模块计算三角网格环境模型中每个三角面片的颜色后生成三维重构图像并输出给显示器。\n[0010] 第二步，环境网格模型生成模块首先由三维点云生成环境高度图，然后对环境高度图进行三角面片化，生成三角网格环境模型，步骤是：\n[0011] 步骤2.1，使用Pfaff等于2007年在《机器人研究》（The International Journal of Robotic Research）杂志上发表的《用于户外地形建模和循环闭合的有效扩展高度图》一文中提出的扩展高度图方法建立环境高度图Pgm。环境高度图Pgm实质上是2.5维等间距栅格地图，其数据组织结构为二维结构体，每个二维结构体代表一个栅格，有四个属性组成，分别记为x、y、z、ocp，x和y表示栅格的中心在XY平面上的坐标，z表示栅格的高度，ocp表示栅格是否有投影或者被插值。建立的环境高度图具体参数如下：地图X方向范围为(-30m,\n30m)，Y方向范围为(-30m,30m)，每个栅格的占据空间为20×20cm2；\n[0012] 步骤2.2，使用Der-Tsai Lee等于1980年在《计算机与信息科学》（International Journal of Computer and Information Sciences）杂志上发表的《构建Delaunay三角划分的两种方法》一文中提到的Delaunay三角划分方法对环境高度图Pgm进行三角划分生成三角网格环境模型Em＝{s1,s2,...,si,...,sn}，n为三角面片的总个数。Em从数据组织结构上为一维结构体，结构体si表示一个三角面片，包含三个顶点和一个颜色属性，分别记为pi1、pi2、pi3和ci，i为整数且1≤i≤n；\n[0013] 第三步，模型颜色渲染模块按照预定光照模型对三角网格环境模型中每个三角面片的着色，生成三维重构图像并显示，步骤是：\n[0014] 步骤3.1，令i＝1；\n[0015] 步骤3.2，计算汽车虚拟大灯到三角面片si的入射光强LIi和入射光方向vi，当三角面片足够小的时候（面积小于0.1m2），照射在三角面片上每个区域的光近似等于照射在三角面片中心点上的光；\n[0016] 步骤3.2.1，由公式（1）计算三角面片si的中心点Qi；\n[0017] Qi＝(pi1+pi2+pi3)/3   公式（1）\n[0018] 步骤3.2.2，由公式（2）计算虚拟大灯到三角面片si的距离Li；\n[0019] Li＝|P0-Qi|   公式（2）\n[0020] 步骤3.2.3，由公式（3）计算入射光方向vi；\n[0021]    公式（3）\n[0022] 步骤3.2.4，由公式（4）计算虚拟大灯光轴与虚拟大灯到三角面片si入射光的夹角Ai，其中P0＝[0,1,0]T为虚拟大灯的位置，n0＝[0,1,0]T为虚拟大灯的光轴单位方向；\n[0023]    公式（4）\n[0024] 步骤3.2.5，由公式（5）（6）分别计算距离衰减系数DAi和角度衰减系数AAi，其中Dth表示虚拟大灯的灯光最远传播距离，一般取Dth＝50，Ath表示虚拟大灯的散射锥角，一般取Ath＝75；\n[0025]    公式（5）\n[0026]    公式（6）\n[0027] 步骤3.2.6，由公式（7）计算照射到三角片面si的光强LIi，其中Llight为虚拟大灯的发光光强，一般取Llight＝2。\n[0028] LIi＝Llight·DAi·AAi   公式（7）\n[0029] 步骤3.3，计算人眼接收的由三角面片si反射的光强；\n[0030] 步骤3.3.1，由公式（8）计算三角面片si的面法向量Ni，其中运算因子×表示向量的叉乘；\n[0031] Ni＝(pi3-pi1)×(pi2-pi1)   公式（8）\n[0032] 步骤3.3.2，由公式（9）计算入射光方向vi和三角面片面法向量Ni之间的夹角余弦cos(θi)；\n[0033]    公式（9）\n[0034] 步骤3.3.3，计算vi的反方向关于Ni的单位镜像Ri，Ri即为反射光方向；\n[0035] 步骤3.3.4，由公式（10）计算观察方向Vi，并由公式（11）反射光方向Ri和观察方向Vi之间的夹角余弦 其中H0为观察者得位置；\n[0036]    公式（10）\n[0037]    公式（11）\n[0038] 步骤3.3.5，由公式（12）计算观察者从三角面片si接收的反射光强LOi，其中Kd为漫反射系数，一般取Kd＝0.3，Km为镜面反射系数，一般取Km＝0.8。\n[0039]    公式（12）\n[0040] 步骤3.4，由公式（13）计算三角面片si的颜色ci。若ci＞255，则令ci＝255；\n[0041] ci＝255·LOi1.5   公式（13）\n[0042] 步骤3.5，若i＞n，转步骤3.6；否则令i＝i+1并转步骤3.2；\n[0043] 步骤3.6，将着色后的三角网格环境模型Em生成三维重构图像输出给显示器。\n[0044] 采用本发明可以达到以下有益效果：\n[0045] 1、本发明通过建立光照模型和光反射模型，模拟了光产生、传播、反射和接收的全过程，使重构的颜色更接近人眼的视觉感；\n[0046] 2、采用本发明能生成车辆周围的三维渲染地形，对于路面和障碍的分辨清晰，图像具有分辨率高、对比度强和边缘清晰的优点，可以满足夜间驾驶的需求。\n附图说明\n[0047] 图1是本发明第一步构建的基于三维激光雷达传感器的夜视系统的逻辑结构图；\n[0048] 图2是本发明总体流程图；\n[0049] 图3是本发明第三步中所用的方法的原理示意图；\n[0050] 图4是本发明第三步的流程图；\n[0051] 图5是本发明三维重构图像与原始雷达图像的对比图。\n具体实施方式\n[0052] 以下将结合说明书附图和具体实施例对本发明做进一步详细说明。\n[0053] 图1是本发明第一步构建的基于三维激光雷达传感器的夜视系统的逻辑结构图。\n该系统的硬件由车载三维激光雷达传感器（帧率10Hz以上，输出大于50万点/秒）、计算机及显示器组成；该系统的软件为三维重构软件，由环境网格模型生成模块及模型颜色渲染模块组成。三维激光雷达传感器实时监测和感知车辆周围环境，将从周围环境获得的三维点云按固定的格式发给计算机；计算机装有三维重构软件，三维重构软件对计算机收到的激光雷达三维点云进行三维重构，生成车辆周围三维环境图像，将三维环境图像转换成视频流输出给显示器；显示器将视频流在屏幕上显示。在三维重构软件中，环境网格模型生成模块首先由三维点云生成环境高度图，然后对环境高度图进行三角面片化，生成三角网格环境模型，并将三角网格环境模型发送给模型颜色渲染模块；模型颜色渲染模块计算三角网格环境模型中每个三角面片的颜色后生成三维重构图像并输出给显示器。\n[0054] 本发明的总体流程图如图2所示。其流程如下：\n[0055] 第一步，构建基于三维激光雷达传感器的夜视系统；\n[0056] 第二步，三维重构软件接收从三维激光雷达回传的三维点云，环境网格模型生成模块使用三维点云生成环境高度图，之后对环境高度图进行三角面片化，生成三角网格环境模型，并将三角网格环境模型发送给模型颜色渲染模块；\n[0057] 第三步，模型颜色渲染模块按照预定光照模型对三角网格环境模型中每个三角面片的着色，生成三维重构图像并显示。\n[0058] 图3为中心点为Qi＝(xi,yi,zi)的三角面片si的模拟大灯光入射反射示意图，Ni为三角面片si面法向量，LIi为入射光，Vi为观察方向，θi为入射光LIi与面法向量Ni的夹角，为反射光LOi与观察方向Vi的夹角。光由LIi的方向入射，在三角面片si的中心点Qi处发生漫反射与镜面反射，其中漫反射方向为全方向，大小和入射光与面法向量的夹角相关，镜面反射方向为LOi的方向，大小和入射光与面法向量的夹角相关。在观察方向V接收反射光，该反射光由两部分组成，分别为漫反射光Ld与镜面反射光Lm。其中，Ld＝LIi·Kd·cosθ（i 漫反射光强度等于入射光强度乘以漫反射系数和入射光与面法向量的夹角的余弦），（镜面反射光强度等于入射光强度乘以镜面反射系数和反射光与观察\n向量的夹角的余弦的k次幂，k常取4）。因此，在观察方向V接收的反射光强度可以表示为：\n图4是本发明方法第三步的流程图。\n[0059] 第三步，模型颜色渲染模块按照预定光照模型对三角网格环境模型中每个三角面片的着色，生成三维重构图像并显示，其步骤是：\n[0060] 步骤3.1，令i＝1；\n[0061] 步骤3.2，计算汽车虚拟大灯到三角面片si的入射光强LIi和入射光方向vi，当三角面片足够小的时候（面积小于0.1m2），照射在三角面片上每个区域的光都等于照射在三角面片中心点上的光；\n[0062] 步骤3.2.1，由公式（1）计算三角面片si的中心点Qi；\n[0063] 步骤3.2.2，由公式（2）计算虚拟大灯到三角面片si的距离Li；\n[0064] 步骤3.2.3，由公式（3）计算入射光方向vi；\n[0065] 步骤3.2.4，由公式（4）计算虚拟大灯光轴与虚拟大灯到三角面片si入射光的夹角T T\nAi，其中P0＝[0,1,0]为虚拟大灯的位置，n0＝[0,1,0]为虚拟大灯的光轴单位方向；\n[0066] 步骤3.2.5，由公式（5）（6）分别计算距离衰减系数DAi和角度衰减系数AAi，其中Dth表示虚拟大灯的灯光最远传播距离，一般取Dth＝50，Ath表示虚拟大灯的散射锥角，一般取Ath＝75；\n[0067] 步骤3.2.6，由公式（7）计算照射到三角片面si的光强LIi，其中Llight为虚拟大灯的发光光强，一般取Llight＝2。\n[0068] Qi＝(pi1+pi2+pi3)/3   公式（1）\n[0069] Li＝|P0-Qi|   公式（2）\n[0070]    公式（3）\n[0071]    公式（4）\n[0072]    公式（5）\n[0073]    公式（6）\n[0074] LIi＝Llight·DAi·AAi   公式（7）\n[0075] 步骤3.3，计算人眼接收的由三角面片si反射的光强；\n[0076] 步骤3.3.1，由公式（8）计算三角面片si的面法向量Ni，其中运算因子×表示向量的叉乘；\n[0077] 步骤3.3.2，由公式（9）计算入射光方向vi和三角面片面法向量Ni之间的夹角余弦cos(θi)；\n[0078] 步骤3.3.3，计算vi的反方向关于Ni的单位镜像Ri，Ri即为反射光方向；\n[0079] 步骤3.3.4，由公式（10）计算观察方向Vi，并由公式（11）反射光方向Ri和观察方向Vi之间的夹角余弦 其中H0为观察者得位置；\n[0080] 步骤3.3.5，由公式（12）计算观察者从三角面片si接收的反射光强LOi，其中Kd为漫反射系数，一般取Kd＝0.3，Km为镜面反射系数，一般取Km＝0.8。\n[0081] Ni＝(pi3-pi1)×(pi2-pi1)   公式（8）\n[0082]    公式（9）\n[0083]    公式（10）\n[0084]    公式（11）\n[0085]    公式（12）\n[0086] 步骤3.4，由公式（13）计算三角面片si的颜色ci。若ci＞255，则令ci＝255；\n[0087] ci＝255·LOi1.5   公式（13）\n[0088] 步骤3.5，若i＞n，转步骤3.6；否则令i＝i+1并转步骤3.2；\n[0089] 步骤3.6，将着色后的三角网格环境模型Em生成三维重构图像输出给显示器。\n[0090] 图5是本发明的输出三维重构图像与三维点云的对比图。左侧为三维点云，右侧为采用本方法进行三维重构后的图像。由左图可以看出，三维点云图不连续，在空间上存在很多的空洞，且垂直障碍（白色椭圆内的电线杆）很难辨认；在右图中，环境由相连的三角面片组成，因此三维重构图像像素连续，垂直障碍（白色椭圆内的电线杆）清晰可辨。因此，本方法的处理结果分辨率高、对比度强并且边缘清晰，能够很好得辅助驾驶员在恶劣光照条件下驾驶。