免费刷推广链接的网站,计算机ui设计是什么,上海网站seoseodian,建筑工找活哪个平台好1 前言2 典型的单个定位方式2.1 基于通信的定位方法2.1.1 GNSS 全球卫星导航系统2.1.1.1 gnss的优点与缺点2.1.1.2 gnss定位技术2.1.1.2.1 RTK定位技术2.1.1.2.2 PPP定位技术 2.1.1.2 gnss定位技术总结 2.1.2 车联网定位 2.1 基于航位推算的定位方法2.1.1 惯性测试单元定位IMU2… 1 前言2 典型的单个定位方式2.1 基于通信的定位方法2.1.1 GNSS 全球卫星导航系统2.1.1.1 gnss的优点与缺点2.1.1.2 gnss定位技术2.1.1.2.1 RTK定位技术2.1.1.2.2 PPP定位技术 2.1.1.2 gnss定位技术总结 2.1.2 车联网定位 2.1 基于航位推算的定位方法2.1.1 惯性测试单元定位IMU2.1.1.1 IMU陀螺仪的三个角度2.1.1.2 IMU的优缺点2.1.1.3 IMU的预积分算法2.1.1.4 IMU的构成2.1.1.5 IMU的输出信号 2.1.2 里程计估计定位Odometry2.1.2.1 轮式里程计轮速计2.1.2.2 激光里程计2.1.2.3 视觉里程计2.1.2.4 惯性里程计 2.3 **基于特征匹配的定位方式**2.3.1 高精地图2.3.2 激光雷达定位2.3.3 雷达定位2.3.4 超声波定位2.3.5 相机定位 2.4 单个定位技术对比 3 融合定位技术**3.1 GPS/IMU融合定位****3.2 Camera/IMU融合定位**3.2.1 特性互补3.2.2 视觉与 IMU 松耦合3.2.3 视觉与 IMU 紧耦合3.2.4 融合视觉 与 IMU 数据的 SLAM 系统 **3.3 LiDAR/Camera融合定位****3.4 多种方式混合定位** **4 SLAM系统**5 ADAS ICA 等自动驾驶专有名词 1 前言
自动驾驶技术主要分为四个部分环境感知、地图定位、决策规划、控制执行。环境感知是指对车辆周围环境信息进行采集和处理主要包含车辆与行人的识别检测车道线检测等。定位是指以精确的方式确定车辆在环境中的当前位姿。决策与规划是在感知和定位的前提下根据环境和定位信息进行路径规划并实施相应的控制策略来代替人类的驾驶决策。控制与执行则是负责车辆的加速、减速与转向。
所以定位目的在于明确车辆相对于全局的绝对位置或相对于周边环境道路、行人等的相对位置以及车子的朝向、前后左右的倾斜程度也就是说定位是知道车在哪以及车的姿态也就是车的位姿定位精度直接决定了自动驾驶的安全性和准确性。 下面对已有的定位方法进行系统的梳理重点分析各种定位方式的基本原理和优缺点以及对现阶段典型的组合定位方式进行梳理最后做出了定性和定量的对比。
2 典型的单个定位方式
从所使用的方法层面上单个定位方式可以划分成三类基于通信、基于航位推算和基于特征匹配的方式下图为自动驾驶中单个定位方式概览图 2.1 基于通信的定位方法
2.1.1 GNSS 全球卫星导航系统
全球卫星导航系统(Global Navigation Satellite SystemGNSS)包含了以下几种定位系统
美国的全球定位系统Global Positioning SystemGPS中国的北斗卫星导航系统欧洲的伽利略Galileo俄罗斯的格洛纳斯GLONASS
是目前自动驾驶中最常用最基本的定位方式 2.1.1.1 gnss的优点与缺点
优势GNSS是在高精度地图生产过程中唯一可以提供绝对位置的传感器。所以现在的自动驾驶方案都会有GNSS传感器的身影
缺点因为gnss需要接收来自卫星微弱的信号来实现定位很容易受环境的影响。城市峡谷或者林荫路会导致定位精度的急速下降甚至在隧道等场景下完全不可用。所以单独的GNSS传感器肯定无法满足我们L4/L5级别的自动驾驶需求所以在自动驾驶的定位系统中一般采用组合定位方式来增强定位的精确性和稳定性。
2.1.1.2 gnss定位技术
GNSS传感器可以提供高精度位置的技术主要有两种这两种技术也可以说是GNSS技术的辅助技术载波相位差分定位RTK和精密单点定位PPP
2.1.1.2.1 RTK定位技术
RTK英文全名叫做Real-time kinematic也就是实时动态载波相位差分定位技术可以说RTK技术一个对GNSS进行辅助的技术
什么是RTK技术
先了解下GNSS技术GNSS卫星之所以能够对地球上的终端例如手机、汽车、轮船、飞机等进行定位依靠的是三维坐标系。
它是通过测量已知卫星到接收机之间的距离这个距离也被称为“伪距”然后综合多颗卫星的数据进行计算就可以知道接收机的具体位置。当然这个定位是存在误差的
卫星星载时钟和接收机上的时钟不可能总是同步所以会造成时间上的偏差。卫星信号在经过大气层、对流层以及遇到障碍物时会出现各种反射导致传播路径变长出现测距误差 这些原因造成的误差高达2~10m 此时出现RTK技术能够更好地消除误差、提高定位精度。
RTK技术通过基准站和流动站同时接收来自多颗卫星的观测数据基准站把接收到的数据实时发送到流动站流动站结合自身接收数据和基准站发射数据完成差分计算从而精确地计算出流动站的三维坐标和精度。这种方法能够消费大气层、对流层以及时钟等误差从而获得高定位精度达到厘米级。 第①步基准站先观测和接收卫星数据。 第②步基准站通过旁边的无线电台数据链将观测数据实时发送给流动站距离一般不超过20公里。 第③步流动站收到基准站数据的同时也观测和接收了卫星数据。 第④步流动站在基准站数据和自身数据的基础上根据相对定位原理进行实时差分运算从而解算出流动站的三维坐标及其精度其定位精度可达1cm~2cm。至此测量完成
传统的RTK技术流动站和基准站之间存在距离限制
距离越远误差因素差异变大定位精度就会下降。而且距离远了超过了无线电台的通信范围也就无法工作了
网络RTK技术在网络RTK技术中在一个较大的区域内均匀分散设置多个基准站3个或以上构成一个基准站网
网络RTK相比传统RTK其实是用区域型的GNSS网络误差模型取代了单点GNSS误差模型
多个基准站组成的基准站网它们将数据发给中央服务器。中央服务器会根据数据模拟出一个“虚拟基准站”。所以网络RTK也被称为“虚拟基准站技术”或“虚拟参考站技术” 其次对于用户来说不需要自建基准站节约了大量成本只需要支付一些通讯费用 RTK定位技术已经非常成熟而且国内也存在多家差分数据提供商以及国内外存在不下数十家的定位模组提供商简单配置即可获得绝对的高精度位置存在大量的商业应用案例
2.1.1.2.2 PPP定位技术
PPP定位技术或者说延伸的PPP-RTK定位技术个人看到的明显优于RTK技术的两个方面
第一可以在没有网络的情况下依然可以获取高精度位置
第二存在比较明朗的完好性技术路线。
PPP技术除了需要处理卫星信号也需要接收服务商提供的精密卫星轨道钟差/伪距载波偏差/大气改正信息修正后固定单差模糊度进而获得高精度的位置。
当然也有部分主机厂选择使用PPP-RTK技术。PPP-RTK技术可以认为是PPP的高级形态也有人认为是PPP与RTK的融合更有人吹嘘说是下一代的定位技术暂时没有一个很明确的定义。
2.1.1.2 gnss定位技术总结
GNSS传感器基本上是自动驾驶不可或缺的硬件之一RTK技术基本上是现在的主流自动驾驶采用的定位技术也存在部分厂家采用了成本相对较高的PPP-RTK技术。
2.1.2 车联网定位
车联网(Vehicle to EverythingV2X)指车辆与其他一切事物的连接和信息交互包含车辆对车辆通信Vehicle to VehicleV2V、车辆对基础设施通信Vehicle to InfrastructureV2I、车辆对行人通信Vehicle to PedestrianV2P等实现“聪明的车智能的路”的协同。目前主流的通信标准有两个一个是专用短程通信技术 Dedicated Short-Range Communications, DSRC它多应用在碰撞预警等场合另一个是采用蜂窝通信网络的长期演进技术-车辆通信 Long Term Evolution - VehicleLTE-V标准该标准在从LTE-V2X逐步向NR-V2X演进发展
V2V定位的基本原理是利用车辆自组网Vehicular Ad-hoc NetworkVANET整合相邻车辆的位置信息进行定位。优点是1可以获取视野以外的车辆位置, 2成本低3数据处理量小。缺点是在高速移动场景下车辆与车辆之间的连接切换频繁导致稳定性低。
V2I定位采用与路边单元 (Road Side UnitRSU)或者蜂窝基站通信的方式获取位置信息。它有以下优点1因使用固定安装的RSU,定位精度高2稳定性好。当然也有缺点1为实现连续通信需要安装大量的RSU,因此成本较高。
所以车联网定位在自动驾驶中用的较少。
2.1 基于航位推算的定位方法
利用物体的初始位置通过观测物体的移动方向和距离推测下一时刻位置的方法。此种方法是比较传统的定位方式主要分为惯性导航定位系统Inertial Navigation SystemINS和里程计定位两种方式
2.1.1 惯性测试单元定位IMU
惯导系统不是IMUIMU只是惯导系统里面最常用的器件但一般我们将IMU出来的数据称为Inertial data 惯导数据
在惯性导航定位系统中最常用的器件是惯性测量单元Inertial Measurement UnitIMU。它通过测量出物体的三个轴上的加速度和角速度加速度用加速度计角速度用陀螺仪实现相对定位其坐标系示意图如图4所示。一般情况它包含3个方向的加速度计用于获取加速度积分后得到速度和3个单轴的陀螺仪用于获得方位角角速度积分后得到俯仰角pitch和横滚角roll。为了提高姿态的估计精度一些IMU内还会添加磁力计估计偏航角yaw
加速度积分得到该物体的速度。再积分得到该物体的位置或者说距离。角速度得到物体在旋转过程中所转过的角度也就是角位移。所以IMU可以得到位置和姿态分别由加速度计和陀螺机获得但是是相对定位 2.1.1.1 IMU陀螺仪的三个角度
IMU中有三个角度rollpitch和yaw yaw:即偏航角ψ,围绕Z轴旋转的角度 pitch:即俯仰角0,围绕Y轴旋转的 roll:滚转角Ф,围绕X轴旋转的角度 在自动驾驶汽车来说的话在平面上跑的话不会存在roll和pitch只有yaw偏航角类似于左转右转这种
2.1.1.2 IMU的优缺点
该定位方式重要有以下优点1不依赖于外部环境可独立工作也可复杂环境条件下工作2更新频率高100Hz3可获取六个自由度的信息。主要缺点有1长里程定位误差会累计存在漂移现象2) 精度受环境温度影响。因GPS没有累计误差IMU不受多路效应和遮挡的影响所以IMU常与GPS结合一起定位
2.1.1.3 IMU的预积分算法
预积分的目的
IMU通过加速度计和陀螺仪测出的是加速度和角速度通过积分获得两帧之间的旋转和位移的变换在后端非线性优化的时候需要优化位姿每次调整位姿都需要在它们之间重新传递IMU测量值需要重新积分这将非常耗时为了避免重新传递测量值所以采取预积分策略
2.1.1.4 IMU的构成
IMU是通过测量出物体的三个轴上的加速度和角速度加速度用加速度计角速度用陀螺仪实现相对定位的所以常见的IMU是由三轴的加速度计和三轴的陀螺仪构成的也成为**六轴的IMU有些还包含三轴的磁力计成为九轴的IMU。用于自动驾驶中的航位推算**。
2.1.1.5 IMU的输出信号
IMU输出的不是位置信号经纬度信息是GNSS输出的部分信号而IMU输出的是六个2组信号分别是3个加速度信号和3个角速度信号这两组信号互相取长补短以此来解算所测试物体的位姿
2.1.2 里程计估计定位Odometry
里程计是一种利用从移动传感器获得的数据来估计物体位姿随时间的变化而改变的**方法**请注意他并不是某个物件。
他的输出是{pose[0],pose[1],pose[2]}
各种里程计分类就是通过不同的传感器类型去估计物体的位姿随时间的变化的算法
比如说轮式里程计他并不是某个具体的传感器而是通过轮速编码器去计算车辆底盘位姿的一种算法
里程计信息是指车辆行驶的距离通常以米为单位。为了得到里程计信息需要对 yawrate 和 speed 信息进行积分
具体来说对 speed 信息进行积分可以得到车辆行驶的距离对 yawrate 信息进行积分可以得到车辆的航向角度。将这两个积分结果结合起来就可以得到车辆的里程计信息
需要注意的是积分过程中会存在误差累积的问题因此需要对积分结果进行修正和校准以提高里程计信息的准确性 里程估计odometry的方式分为内部感知和外部感知相当于人闭着眼睛和睁开眼睛走路的两种模式内部感知有电机码盘和IMU外部感知有激光里程计和视觉里程计如下图
目前来讲视觉里程计是最为热点的研究 2.1.2.1 轮式里程计轮速计
轮式里程计是一种通过安装在轮子上的传感器轮速编码器获取车辆速度和位移的信息的一种算法。它一般分为三类纯机械式、机械-电子式和纯电子式。例如纯电子式旋转编码器根据电磁感应原理将轮胎转动圈数转变成电压信号以此测量行驶速度和角度再通过对速度在时间轴上的积分通过积分处理之后的数据才是里程计信息实现定位的目的
轮式里程计定位优点在于1简单易用2体积小、成本低3短距离内定位精确高。与IMU定位类似该方法也有类似的缺点1误差会随时间而累积2轮子滑动或者道路不平情况下会导致定位精度降低。因此在行人导航和室内导航中应用较多在自动驾驶中常用作辅助定位
2.1.2.2 激光里程计
LO laser odometry是通过激光雷达的方式去做里程估计的。激光雷达又是通过产生3D点云地图然后使用特定的算法如基于REGISTRATION的方法、基于FEATURES的方法或基于DEEP LEARNING的方法对比当前采集的点云数据特征找出车辆所在的位置和朝向位姿。
激光雷达是通过点云信息进行处理视觉里程计是通过图像信息进行处理
2.1.2.3 视觉里程计
研究热点
VO visual odometry视觉里程计是通过车辆卸载的摄像头传感器得到的图像信息来估计自身的运动的算法
2.1.2.4 惯性里程计
惯性里程计也就是我们说的IMU IMU是一个集成的模块直接放在车里面就可以。
2.3 基于特征匹配的定位方式
2.3.1 高精地图
为了实现高度自动驾驶业界普遍认为高精地图High Definition MapHD Map是必不可少的。对于基于特征匹配的定位方式更是如此。高精地图直接影响定位的精度同时为规划模块提供基本的数据支持。
但对于高精地图的具体形式目前还没有统一的标准。目前高精地图分为两类平面分层地图和3D点云地图。前者通过卫星和航空影像获取基本的地图图层信息再加上车道级别路网信息形成HD Map。它在不同的地图层上显示不同的道路环境信息后者通过3D传感器如激光雷达、相机等获取地图中元素的三维信息形成HD Map如图5所示。Liu 等出了类似但不完全相同的分类方式。它将高精地图分为三个子模型用于导航整体路线的道路模型Road Model、用于车道局部路线规划的车道模型Lane Model,及用于辅助定位的定位模型Localization Model同样具有重要的参考意义。 高精地图示例。绿色点为道路及周边点云模型带箭头的直线和弧线为车道矢量模型
关于HD Map的数据格式标准目前有2种较为流行导航数据标准Navigation Data StandardNDS和开放驾驶标准OpenDRIVE。这两者与传统的地理数据文件Geographic Data FileGDF标准对比如表1所示。不论使用哪一种分类方式高精地图在基于特征匹配定位的方式上都起重要作用 值得说明的是高精地图区别于传统地图的重要一方面是地图的精度从米级上升到厘米级。一个典型的例子是定位精度从道路级别上升到车道级别。同时未来的高清地图需要依靠空中下载技术Over The AirOTA进行实时动态更新5G技术和云计算的发展将推动其快速前进
2.3.2 激光雷达定位 激光雷达Light Detection and RangingLiDAR是由传统的雷达技术和现代的激光技术结合而成通过发射“激光”检测飞行时间以确定自身到测量物之间的距离。根据测量维数的不同LiDAR可分为线性、平面和三维3种类型
使用激光雷达进行定位时首先通过采集车获取道路信息利用建图技术生产出3D点云地图然后使用特定的算法如基于REGISTRATION的方法、基于FEATURES的方法或基于DEEP LEARNING的方法对比当前采集的点云数据特征找出车辆所在的位置和朝向
激光雷达具有如下优点1可直接产生丰富的空间数据如点的3D坐标和纹理等2因为分辨率较高距离、角度和速度所以精度高、实时性好3抗干扰能力强因激光波长较短一定程度减小了多路效应4不受光照强度影响5体积小安装方便。但也有一些缺点1受环境中气候的影响较大如在雨、雪、雾、尘等极端天气下传播距离会急剧衰减2价格高这是目前很多汽车厂商如TESLA试图寻找其他定位方案的重要原因3数据量较大需要高效的处理流程。
因自动驾驶对定位精度有较高的要求所以激光雷达发挥越来越重要的作用。目前在RTK信号缺失时使用激光雷达和高精地图进行匹配是主流的高精定位方式。机械式的激光雷达现阶段比较成熟但因其旋转部件成本较高低成本的固态式的激光雷达获得了逐步发展的机会。不过固态激光雷达也有自身的局限性如水平视角小于180°不如机械式的激光雷达。所以多个固态激光雷达组合使用可能是未来一种成本低、覆盖范围广的高精度定位方式
2.3.3 雷达定位
雷达Radio Detection and RangingRADAR是利用“电磁波”探测物体的距离、方向、速度或高度等的设备。按照波长它可划分为毫米波雷达、分米波雷达等。目前在自动驾驶领域应用较广泛的是毫米波雷达频率范围10GHz~300GHz其中常用的频段有24GHz和77GHz。根据传播的距离可将毫米波雷达分为短程雷达 (Short Range RADARSRR)、 中距雷达 (Medium Range RADARMRR)和长程雷达 (Long Range RADARLRR)。
整体来说毫米波雷达有如下优点1可全天候工作因其对烟雾和灰尘等有较强的穿透能力除大雨天2空间分辨率高3)相对视觉和激光雷达而言可以用来测量物体速度4天线尺寸较小功耗低。当然它也有自身的缺点1探测距离受制于频段损耗即频段越高探测距离才有可能越远2现阶段高频如77GHz的毫米波技术发展不成熟。
1SRR
短程雷达主要使用24GHz的频段。它的探测距离较近有30m左右不过探测角度相对较大最高可达120°左右。短程雷达有成本低技术发展相对成熟的优点同时也有体积相对较大的缺点。鉴于上述情况短程雷达主要用于盲区检测、车道保持、变道辅助和泊车辅助等场合。
2MRR/LRR
中程雷达主要使用76-77GHz的频段探测距离在60m左右探测角度可达60°左右。对于长程雷达主要使用77GHz频段探测距离一般可达在200m左右探测角度一般只有20°左右。中长程雷达相对短程雷达具有1检测精度较高2体积小的优点但同时也有1制作工艺要求高2目前发展还不够成熟的缺点。鉴于此它一般应用场合有辅助刹车、和紧急制动等。图7为三种车载毫米波雷达探测范围的一个示例
2.3.4 超声波定位
超声波Ultrasound又称超声波雷达定位即使用发射探头发出频率大于20KHz的声波和计算飞行时间来探测距离。常用的超声波频率有40KHz、48KHz和58KHz其中最常用的频率是40KHz。使用超声波定位一般精度在1cm3cm之间探测适用范围在0.2m5m之间。
优点如下1穿透能力强一定程度上可以防水、防沙、防尘2成本低3不受电磁效应的干扰。这种方式也有一些缺点1检测角度小、探测距离短因此一辆车上会选择安装多个超声波传感器并在低速行驶中使用2无法精确描述障碍物的位置如两个障碍物同时返回相同的探测距离时3抗干扰能力差易受到车速、震动、温度及湿度的影响。
由于以上特点超声波在倒车、自动泊车、盲区检测等方面广泛应用如图8所示。常用的超声波雷达有两种停车辅助Ultrasonic Parking AssistanceUPA超声波雷达和自动泊车Automatic Parking AssistanceAPA超声波雷达。UPA超声波雷达探测范围较近一般在0.1m2.5m常安装在车辆的前后保险杠上辅助倒车。APA超声波雷达探测距离稍远在0.3m5m左右一般安装在车辆的侧面且具有较强的指向性用于探测车辆左右两侧的障碍物。不过相比之下APA功率略大成本略高 超声波在倒车时的应用示意图。蓝色扇形区域为APA超声波雷达探测范围透明扇形区域为UPA超声波雷达探测范围
2.3.5 相机定位
基于图像的相机定位是基于视觉的定位Vision-Based LocalizationVBL中的一个重要研究领域。视觉定位是指在一个已知的空间表示如矢量地图、点云地图等中使用视觉类的数据元素检索出物体位姿位置和朝向的方法。这些视觉元素有图像、3D模型和彩色点云等它们包含光学信息、几何信息和语义信息等。
总体来说视觉定位有以下优点1硬件成本低技术相对成熟2特定场合精度高如交通标示识别3提供的信息量充足4信息直观方便。但也有缺点1对光照依赖较大在逆光、强光、黑夜、雾、霾及雨雪天气情况下定位困难2纹理少的区域定位精度低3精度依赖图像分辨率、计算量较大距离较远时物体分辨困难。
这里主要讨论自动驾驶应用场景下的基于图像的视觉定位的几个重要方法多点透视问题Perspective n PointPnP问题、视觉里程计Visual OdometryVO、路标定位以及与此关系密切的基于视觉的同步定位与地图构建技术Visual Simultaneous Localization And MappingV-SLAM或称为视觉SLAM
2.4 单个定位技术对比
GPS在大场景室外定位中扮演重要角色V2X提供的精确的信息对车辆定位有较大帮助IMU因其独立作业的优点对环境的**鲁棒性**较好LiDAR在获取精确的尺度信息和地图构建上很有优势RADAR定位在兼顾精度和距离的同时对天气的适应能力更强相机定位在精度和距离上有很大的发展空间。当然没有哪种定位方式可以适用于所有场景最终的决定因素在于用户的需求
3 融合定位技术 3.1 GPS/IMU融合定位
融合GPS和IMU进行定位是较典型的方式。一方面GPS依赖于外部卫星信号易受天气、电磁波等的干扰面临隧道无信号、有多路效应等问题而IMU不依赖于外部信号不会受上述因素的影响。一方面IMU有累计误差而GPS的误差不会累计,所以两者取长补短IMU每5ms更新一次但是误差不断累计每100ms可以得到一次GPS数据更新对IMU累计的误差进行校正。但是在这种融合方式下IMU在匀速运动时加速度计失效的情况只能靠GPS单方面进行速度估计不过普通GPS的米级精度对自动驾驶来说是不够的。然而随着RTK-GPS技术的发展和普及低成本的厘米级精度的方案也是可以预见的事情。
GPS和IMU的融合方式有两种松耦合和紧耦合。松耦合的工作原理是两个系统单独工作得到最终结果位置和速度后再进行卡尔曼滤波对IMU进行补偿校验。它具有简单易实现的优点也有定位精度低的缺点。紧耦合将接收到的GPS原始数据直接与IMU的输出一起进行校正最终得到一个统一的估计结果。它具有精度高的优点但实现较复杂。基于**GPS/IMU定位的方式还可以与轮式里程计定位相结合**。如冼承钧等[40]提出的多传感器融合导航方法Dedicated Short-Range Communications, DSRC当GPS有效时使用GPS/IMU定位当GPS失效时使用里程计抑制IMU误差的累计进行定位。
此外人们还提出了不依赖与GNSS的定位如下面两种融合方式。
3.2 Camera/IMU融合定位
将相机单目相机、双目相机和RGB-D相机与惯性测量单元IMU进行融合形成的视觉惯性里程计Visual-Inertial OdometryVIO,也是目前较为经典的、低成本的融合定位方式。它们组合在一起的导航系统被称之为视觉惯性导航系统Visual-Inertial Navigation SystemVINS。
相机类别优点缺点单目相机成本低、计算量少、使用方便具有尺度不确定性、初始化容易漂移双目相机可通过双目计算深度计算量较大RGB-D 相机测距准确成本高、受日光干扰、测量范围小
融合的主要原因在于相机可以提供丰富的场景信息但获取尺度信息困难且受环境光照、天气等影响较大而IMU可提供尺度信息基本不受环境影响。同时两者成本都较低、功耗小所以常被用作GNSS无效的情况下隧道、地下停车场等环境下、低成本、高精度的定位方案。
3.2.1 特性互补
IMU 在长时间运动情况下累积误差会越来越大而短时间内对 IMU 数据进行处理可以得到较准确的位姿信息。因此视觉与 IMU 能有效地进行优势互补可根据视觉信息估计 IMU 的噪声同理可知IMU 可为视觉提供图像模糊时的定位。融合 IMU 和视觉可以得到更高的定位精度、提高系统鲁棒性IMU 数据与视觉数据融合的方式可分为松耦合和紧耦合
3.2.2 视觉与 IMU 松耦合 将 IMU 积分得到的位姿与视觉求解出来的位姿直接融合一般使用卡尔曼滤波的方法对这两种数据进行处理
3.2.3 视觉与 IMU 紧耦合 一般使用非线性优化的方法处理视觉与 IMU 数据并且能优化传感器的参数。
松耦合时 视觉定位和 IMU 定位单独计算将结果数据融合计算较为简单。而紧耦合将两传感器的原始数据进行融合考虑了两传感器噪声的互相影响 充分利用了数据更易达到全局最优解
所以一般选择视觉与惯导的紧耦合实 现车辆在没有 GPS 信号场景下的定位
3.2.4 融合视觉 与 IMU 数据的 SLAM 系统
相机与 IMU 具有互补性融合视觉 与 IMU 数据的 SLAM 系统拥有更好的鲁棒性和更高的精度
(鲁棒性是指系统在面对不确定性因素时仍能保持稳定和性能的能力) 3.3 LiDAR/Camera融合定位
相机可以获取丰富的信息但尺度信息获取较为困难但LiDAR能获取精确的尺度信息两者可以优势互补。在制作HD Map过程中两者都发挥着不可或缺的作用。在车辆行驶过程中可以通过LiDAR和Camera获取当前位置的特征如点云信息、车道信息等然后跟事先已经建立好的HD Map进行对比实现精确定位。
Xu等人提出使用立体图像匹配3D点云数据位置、强度等信息的定位方法。该方法首先将3D点坐标从世界坐标系转换到相机坐标系然后与图像上对应的点进行对比定位。其定位误差可达0.08m~0.25m。为满足在不同季节变化环境中的定位Viswanathan等人[44]首先采集不同季节的卫星图像然后依据LiDAR数据将车辆全景相机拍摄的图像分成地面和非地面部分再进行变换得到鸟瞰图最后对比卫星图像的地面部分和上述鸟瞰图以实现定位。Zuo等人为了提高定位的鲁棒性和精度提出LIC-Fusion使用多状态约束卡尔曼滤波器Multi-State Constraint Kalman FilterMSCKF架构将LiDAR、IMU和Camera进行数据融合。与此融合方式类似的工作还有Zhao提出的融合了VIO和激光里程计Lidar Odometry and MappingLOAM、将精度优化到1cm的VIL-SLAM。
当然欲达到自动驾驶的高精度、高可靠性定位信息应该有冗余以便于在某一个传感器失效时系统还能正常工作。下面探讨多种传感器混合的定位方式。
3.4 多种方式混合定位
自动驾驶是一个综合性的任务同一个传感器不一定只能满足一种需求如使用相机可以用于定位也可以用于检测目标、分析语义同样多个传感器可能都具备某一种功能如定位。所以充分发挥每一种传感器的功能是十分有意义的。
百度Apollo项目组的Wan等人提出基于RTK-GNSS/IMU/LiDAR融合的定位方案。其充分利用LiDAR的强度和高度信息在预先建立好的GMMGaussian Mixture Model网格单元地图上进行初步定位然后融合RTK和IMU的定位结果在复杂场景下市区道路、隧道达到5cm~10cm的横向和纵向精度。与此类似Levinson等人同样使用GPS/IMU/LiDAR及概率网格地图以实现高精度的定位不同的是该方法使用Bayes推理以减少地图元素的不确定性并试图通过离线SLAM方法对地图中的环境元素作对齐操作以提高在动态环境中定位的鲁棒性。
但是使用RTK或者LiDAR意味着成本较高。Suhr等人提出基于粒子滤波Particle FilterPF的GPS/IMU/Camera融合的低成本定位方式。其使用道路标记(symbolic road markingSRM如车道线、直行箭头和左转箭头等)制作轻量级的地图再使用相机检测这些特定标记得到初步的位置信息然后融合GPS/IMU/里程计的信息实现定位。不过该方式在没有道路标记的地方精度会有所下降。
4 SLAM系统
同步定位与建图Simultaneous Localization And MappingSLAM技术
已经在移动机器人领域活跃了几十年移动机器人领域的成功与解决 SLAM 问题紧密相关即通过逐步构建的环境地图来定位机器人。SLAM 可以应用在许多方向从空间探索到自动驾驶。近些年人们对智能汽车的关注进一步推动了汽车制造商对智能汽车的研究SLAM 也成为了自动驾驶研究的重要方向之一。目前智能汽车使用的 SLAM 技术按传感器的不同可分为激光 SLAM 和视觉SLAMVisual SLAMSLAM。使用激光雷达等距离传感器在构建 2D 地图方面已经比较成熟但激光雷达成本高、易受干扰、没有周围环境的语义信息。随着计算机视觉技术的发展与 GPU 算力的提升相机凭借其信息丰富、便携、成本低等优势在自动驾驶领域得到了广泛的研究与应用例如车道线检测、行人车辆的目标检测、交通标志识别等。因此 视觉 SLAM 的研究有着非常重要的意义。
5 ADAS ICA 等自动驾驶专有名词
高级驾驶辅助系统(Advanced Driving Assistance SystemADAS
ADAS 通过安装在车辆上的各类传感器获得汽车周围的环境信息识别静态和动态物体并结合地图导航定位数据分析这些数据以确定潜在危险将其与预先设定的预警等级对比从而发出警报提示驾驶员采取必要措施。因此ADAS 能有效的提高驾驶的安全性。高级驾驶辅助系统在实际应用中有着非常优异的表现 需求迅速增长比较常用的高级驾驶辅助系统有盲区检测系统、自动紧急制动、车道偏离警示系统、自动泊车系统、前向碰撞预警系统、防抱死系统等。
ICAIntegrated Cruise Assist集成式巡航辅助系统这是一种高速辅助驾驶功能它在车速较高时一般大于60Km/h为驾驶员提供横向和纵向的辅助驾驶。ICA可以看作是ACC自适应巡航控制和LKA车道保持辅助功能的组合它控制车辆以一定的车速在车道线内行驶。与TJA交通拥堵辅助不同的是ICA的工作车速更高而且始终把车辆维持在车道中心附近行驶不具备无车道线时的跟车行驶功能。
NOANavigate on Autopilot自动辅助导航驾驶这种功能结合了“导航”和“辅助驾驶”在原来L2辅助驾驶的基础上如车道线保持、自动跟车加上车机的导航信息如百度地图实现从A点到B点的自动驾驶。这种功能允许车辆自动变道并根据导航信息行驶。
