【技术实现步骤摘要】
一种面向遮挡测评环境的多传感高精度融合测量方法
[0001]本专利技术属于车辆导航定位领域，具体涉及一种面向遮挡测评环境的多传感高精度融合测量方法。
技术介绍
[0002]近年来，智能交通系统在全球范围内得到了飞速的发展，它能将新进的传感器技术、数据通讯传输技术、信息技术等各种技术综合运用于交通系统中，从而有效地实现对交通系统的综合管理，最大限度地实现人、车、路的和谐统一。而对于大部分智能交通系统而言，获取准确、可靠的位置信息是发挥其功能的前提。
[0003]目前，在车辆导航定位领域中应用最为广泛的是全球导航卫星系统(GNSS)技术。在无遮挡的环境下，GNSS能全天候地为车辆提供三维的位置、速度、姿态等信息，但是在密闭的交通环境中，由于卫星信号受到遮挡，GNSS会存在长期失效的现象从而无法实现连续可靠的定位。
[0004]惯性测量单元(IMU)是一种不依赖于外部信息也不向外发射能量的自主式导航系统，它通过测量载体的加速度和角速度信息并进行积分运算后就能得到载体的位置、速度和姿态信息。由于与GNSS的互补性，通...
【技术保护点】
【技术特征摘要】
1.一种面向遮挡测评环境的多传感高精度融合测量方法，其特征在于：在GNSS信号受到遮挡而无法实现可靠定位的环境下，针对单一激光SLAM存在的误差累积以及点云稀疏场景下定位精度下降的问题，通过在路侧布设主动特征来增加激光雷达的观测量，以提升激光雷达的定位精度；同时引入UWB传感器的距离观测量来识别激光雷达扫描到的主动特征编号，并结合车载惯性传感器来提升定位频率；最后通过因子图算法来实时准确地估计出车辆的位置信息，具体步骤如下：步骤1：布置路侧主动特征与UWB基站在激光雷达点云稀疏的区域每隔10
‑
20m等间距的布置主动特征及UWB基站；其中主动特征为低成本的白色圆柱体泡沫，将主动特征安装在相应支架上，在每个主动特征的顶部都安装相应的UWB基站；以正东方向为OX，正北方向为OY，地球表面一个固定点为原点建立坐标系；各个主动特征及UWB基站在坐标系下的位置可通过提前标定获取；将UWB标签和激光雷达安装在行驶车辆的顶端；步骤2：激光雷达观测量识别根据步骤1中的布局，在同一时刻UWB标签所能接收到的观测信息为r1，r2，...，r
N
，其中r
N
表示第N个主动特征与车辆之间的距离值；激光雷达检测到主动特征后所能解算的观测信息为d、θ，其中d为路侧某个未知的主动特征与激光雷达之间的距离值，θ为该主动特征与激光雷达之间相对于正北方向的夹角的绝对值；由于激光雷达对主动特征进行检测时无法判断该主动特征的编号，而主动特征项部的UWB恰好弥补了这一缺点；通过将激光雷达解算的距离信息d与UWB标签接收到的距离信息作对比，若|d
‑
r
i
|＜ε，其中，i＝1，2，...，N，ε为事先设定的阈值，则可判定当前激光雷达检测的距离d与角度θ隶属的主动特征编号i；步骤3：构建多传感器组合导航的因子图模型假设Λ表示车辆的导航状态，包括三维位置X、三维速度V信息；定义车辆的启动时刻为初始时刻，则初始时刻到当前时刻t
k
的导航状态可表示为：相应的联合概率分布函数可表示为：P(Λ
k
|Z
k
)
ꢀꢀꢀꢀ
(2)其中Z
k
为初始时刻到当前时刻t
k
接收到的所有观测值；则待估计的导航状态的最大后验估计可表示为：联合概率分布式(2)可以因式分解为一个先验信息和独立过程及测量模型：上式中P(Λ0)表示所有可用的先验信息；表示Λ
i
中与测量模型相关的变量；表示IMU的测量值，包含比力和角速率；表示IMU的后验概率密度；P(V
i
|V
i
‑1)表示速度变量的后验概率密度；表示除IMU外所有传
感器测量值的后验概率密度的乘积；上述的因式分解可以表示成因子图模型，作为一种二分图模型，因子图包含了因子节点和状态节点两类；因子图中的每个因子节点都可以表示为式(4)中的一个独立项，并且每个因子f
i
(
·
)表示为一个应当最小化的误差函数，假设这个误差函数为则因子f
i
(
·
)可定义为：其中d(
·
)表示代价函数；假设各个传感器的误差均服从高斯分布，则因子f
i
(
·
)满足如下形式：上式中，表示马氏距离，∑
i
为传感器的误差协方差矩阵；则传感器的测量模型因子可定义为：式中，h(
·
)为非线性测量函数，Z
i
为传感器实际的测量值，因此式(4)的最大后验估计问题就变成了如下的非线性最小二乘问题：所构建的因子图模型中，X
k
和V
k
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。