一种小型半自动无人驾驶配送车及配送路径规划方法技术

本发明专利技术公开了一种小型半自动无人驾驶配送车及其配送路径规划方法，利用姿态角传感器获取相机的姿态角信息，对图像中的深度信息和颜色信息、姿态角信息进行处理，检测出图像中的地面和障碍物，最后生成路径信息，结合定位系统获得的位置信息，控制小型无人驾驶车辆运行的系统。在复杂条件下，实现远程的实时控制。本发明专利技术可以用来实现自动和半自动的无人驾驶配送。

【技术实现步骤摘要】
一种小型半自动无人驾驶配送车及配送路径规划方法
本专利技术属于无人驾驶技术、双目视觉技术、三维环境感知
本专利技术包含一种新型小型半自动无人驾驶配送车系统，涉及一种利用两个红外相机和一个彩色相机采集图像，利用姿态角传感器获取相机的姿态角信息，对图像中的深度信息和颜色信息、姿态角信息进行处理，检测出图像中的地面和障碍物，最后生成路径信息，结合定位系统获得的位置信息，控制小型无人驾驶车辆运行的系统。在复杂条件下，实现远程的实时控制。
技术介绍
随着社会的发展，快递、外卖等行业方兴未艾，对配送的需求也日益增加。但是随着人力成本的上涨，“最后一公里”配送占到物流成本的30％左右，同时，配送行业还存在服务水平低等问题。同时，随着配送人员的增加，相关的交通事故也逐渐提高，对配送人员以及社会都是威胁。现有的无人驾驶利用激光雷达、图像传感技术，设备笨重，实现成本高；基于超声波技术和激光测距技术的测距范围有限，只能实现单点测距，获取的信息量太少；全自动驾驶目前技术还难以适应安全保障。
技术实现思路
本专利技术的目的在于提供一种小型半自动无人驾驶配送车，它可以解决当前人力配送存在的弊端，同时解决无人驾驶的安全性问题。本专利技术是目的是通过以下技术方案实现的：一种小型半自动无人驾驶配送车的配送路径规划方法，包括如下步骤：(1)通过定位模块获取当前位置的经纬度信息，通过通信模块将当前位置的经纬度信息上传至服务器，根据目标位置经纬度信息与当前经纬度信息，进行路径规划，形成目标路径；上位机通过通信模块获得该目标路径；(2)姿态角传感器采集X，Y，Z三轴方向的转角AngleX＝α，AngleY＝β，AngleZ＝γ。通过电子罗盘获得地磁场数据，包括x方向的磁场强度BX、y方向的磁场强度BY和z方向磁场强度BZ。(3)通过姿态角度对电子罗盘获得X、Y、Z磁场方向数据Bx、By、Bz进行补偿，解算出较为精确的航向角ε。其中中间变量θ、Xh、Yh分别如下所示：θ＝arctan(Xh*Yh)(1)Xh＝Bx*cos(α)+By*sin(β)-Bz*cos(β)*sin(α)(2)Yh＝By*cos(β)+Bz*sin(β)(3)(4)根据路径规划方向和当前车辆方向ε，调整车头角度，使得当前车辆朝向为路径规划方向。(5)红外投射器实时地向前方投射不可见的静态近红外散斑到前方的三维场景中。两个红外相机采集三维场景的两张红外图像IRleft和IRright。彩色相机采集三维场景的彩色图像Color。(6)处理器根据图像信息，分析得到可通行区域和非可通行区域；(7)对可通行区域和非可通行区域进行凸包检测，将凸点记为p＝1，2，……m,m表示凸点的个数；将凹点记为n表示凹点个数；对于可通行区域的第j行像素点有分别代表当前行的左右两端像素点，对于第j行中的像素点(xij,yij)(其中i和j分别代表行和列的标号)，利用以下计算公式求出T的评分：其中和βp为评分参数。利用以下公式求出O的评分：其中γq为评分参数。(8)对于步骤7获得的可通行区域以内的像素，由以下公式可算出像素点(xij,yij)的总评分G：G＝BT+CO(7)其中B、C分别为T、O的评分参数。对于所有属于通行区域的像素进行评分得到像素的评分集合{Gij}。取每一行的所有像素取评分最高的像素从而得到从远到近的最高评分像素合集{Gmax}。将相邻行最高分像素点用平滑曲线相连，即可获得基于当前的通行路径。(9)实时根据步骤3-8更新当前的通行路径，直到到达目标位置。一种小型半自动无人驾驶配送车，该配送车按照上述的路径规划方法规划配送路径，实现配送。进一步地，包含一个红外投射器、两个相同的红外相机、一个彩色相机、一个姿态角传感器、一个GNSS模块、一个通信模块、一个电池模块、上位机、下位机、一个电子罗盘。红外投射器、红外相机、彩色相机、姿态角传感器、GNSS模块、通信模块、分别与上位机相连，下位机与上位机相连，用于接收上位机指令，驱动配送车前进、后退、左转、右转等操作。通信模块与服务器远程通讯。进一步地，红外投射器、相同的红外相机、彩色相机、姿态角传感器、GNSS模块、通信模块、电池模块、上位机、下位机、电子罗盘均上设置在配送车前部，后部分割为多个独立储物空间。进一步地，配送车前端配置灯光模块。本专利技术的优势主要在于：(1)极大降低成本。由于使用RGB-D相机替代雷达，在实现完整功能的情况下，极大降低了系统的成本。(2)环境适应性。由于使用红外投射器和两个红外传感器，该方法在室内室外都可以使用。在室内时，红外投射器投射的静态近红外光斑给三维场景增加了纹理，有利于获取稠密的深度图像。在室外时，阳光的近红外部分和三维场景结合，有利于获取稠密的深度图像。(3)快速检测。使用深度学习对图像数据进行实时处理，提高了响应速度，有效提高了系统的响应时间。(4)安全性。在复杂条件下，通过远程控制替代全自动驾驶，保障了系统的安全性，扩展了系统的适用范围。附图说明图1为初始规划的路径；图2为航向角示意图；图3为调整后的车头朝向；图4为优化有的路径；图5为小型半自动无人驾驶配送车的立体示意图；图6为图5小型半自动无人驾驶配送车的爆炸视图；图7为小型半自动无人驾驶配送车电路结构示意图；图8为小型半自动无人驾驶配送车工作流程图；图9为小型半自动无人驾驶配送车电子罗盘三轴方向示意图。其中：1-前部外壳、2-后部外壳、3-后部外壳盖子、4-左侧前车轮、41-右侧前车轮、42-右侧后车轮、43-左侧后车轮、5-左车灯、51-右车灯、6-前车轴、61-后车轴、7-底盘、8-电池、81-上位机、82-定位模块、83-通信模块、84-开关、85-主控、86-驱动、91-彩色相机、92-红外相机、93-红外投射器、94-姿态角传感器、95-电子罗盘。具体实现方式为使本专利技术的目的、技术方案和有点更加清晰明了，下面结合实例和附图，对本专利技术作进一步的详细说明，本专利技术的示意性实施方式及其说明仅用于解释本专利技术，并不作为对本专利技术的限定。下面结合附图，通过实施例对本专利技术作进一步详细说明：一种小型半自动无人驾驶配送车的组成部分：一种小型半自动无人驾驶配送车，包括一个红外投射器、两个相同的红外相机、一个彩色相机、一个姿态角传感器、一个GNSS模块、一个网络通信模块、一个电池模块、外壳、底盘、上位机、下位机、一个电子罗盘。外壳由前部外壳和后部外壳组成；在前部外壳安装内部电路，前部外壳前方配置灯光模块；后部外壳存放配送货品，分割为独立空间，每个空间由独立的盖子机械连接；底座由底盘、车轮、车轴组成。一种小型半自动无人驾驶配送车各组成部分的功能：外壳实现系统保护功能。底盘实现系统支撑。红外投射器向三维场景中投射不可见的静态近红外散斑。两个红外相机实时地采集三维场景的两幅红外图像。彩色相机实时地采集三维场景的一幅彩色图像。姿态角传感器实时地获取相机三个方向的姿态角。上位机对红外相机、彩色相机获取的数据实时处理，获取点云数据，并利用姿态角传感器获取的姿态数据纠正三维空间真实坐标，通过计算最终获得可通行区域范围。并通过串口通信传递给下位机。定位模块实时获取系统位置。下位机接收上位机指令，并控制驱动控制系统前进、后退、左转、右转等操作。通信模块实现系统与远程服务器的本文档来自技高网...

【技术保护点】
1.一种小型半自动无人驾驶配送车的配送路径规划方法，其特征在于，包括如下步骤：(1)通过定位模块获取当前位置的经纬度信息，通过通信模块将当前位置的经纬度信息上传至服务器，根据目标位置经纬度信息与当前经纬度信息，进行路径规划，形成目标路径；上位机通过通信模块获得该目标路径；(2)姿态角传感器采集X，Y，Z三轴方向的转角AngleX＝α，AngleY＝β，AngleZ＝γ。通过电子罗盘获得地磁场数据，包括x方向的磁场强度BX、y方向的磁场强度BY和z方向磁场强度BZ。(3)通过姿态角度对电子罗盘获得X、Y、Z磁场方向数据Bx、By、Bz进行补偿，解算出较为精确的航向角ε。其中中间变量θ、Xh、Yh分别如下所示：θ＝arctan(Xh*Yh)    (1)Xh＝Bx*cos(α)+By*sin(β)‑Bz*cos(β)*sin(α)    (2)Yh＝By*cos(β)+Bz*sin(β)    (3)

【技术特征摘要】
1.一种小型半自动无人驾驶配送车的配送路径规划方法，其特征在于，包括如下步骤：(1)通过定位模块获取当前位置的经纬度信息，通过通信模块将当前位置的经纬度信息上传至服务器，根据目标位置经纬度信息与当前经纬度信息，进行路径规划，形成目标路径；上位机通过通信模块获得该目标路径；(2)姿态角传感器采集X，Y，Z三轴方向的转角AngleX＝α，AngleY＝β，AngleZ＝γ。通过电子罗盘获得地磁场数据，包括x方向的磁场强度BX、y方向的磁场强度BY和z方向磁场强度BZ。(3)通过姿态角度对电子罗盘获得X、Y、Z磁场方向数据Bx、By、Bz进行补偿，解算出较为精确的航向角ε。其中中间变量θ、Xh、Yh分别如下所示：θ＝arctan(Xh*Yh)(1)Xh＝Bx*cos(α)+By*sin(β)-Bz*cos(β)*sin(α)(2)Yh＝By*cos(β)+Bz*sin(β)(3)(4)根据路径规划方向和当前车辆方向ε，调整车头角度，使得当前车辆朝向为路径规划方向。(5)红外投射器实时地向前方投射不可见的静态近红外散斑到前方的三维场景中。两个红外相机采集三维场景的两张红外图像IRleft和IRright。彩色相机采集三维场景的彩色图像Color。(6)处理器根据图像信息，分析得到可通行区域和非可通行区域；(7)对可通行区域和非可通行区域进行凸包检测，将凸点记为p＝1，2，……m,m表示凸点的个数；将凹点记为q＝1,2……n，n表示凹点个数；对于可通行区域的第j行像素点有分别代表当前行的左右两端像素点，对于第j行中的像素点(xij,yij)(其...

【专利技术属性】
技术研发人员：李艳宾，汪凯巍，冯逸鹤，王之丰，
申请(专利权)人：浙江大学，
类型：发明
国别省市：浙江,33