基于车体约束的INS辅助定位
在传统的车载导航中，车辆有一些约束，比如正常情况下Z轴方向不会快速变大或者变化不大；比如在红绿灯等待的时候，车辆其实是静止的，可以结合INS的加速度，加速度信息去统计性的检测车速为零的情况，进而去约束车辆的状态。
1. 零速修正
英文Zero Velocity Update，缩写ZUPT，当载体处于静止状态时，载体此时的速度为零，利用载体中的惯性系统的解算速度作为系统速度误差的观测量，对其他误差量进行修正，改善静止状态下的组合导航结果，不需要增加外部传感器，因而是一种有效且廉价易实现的技术。常用的零速修正估计算法为：曲线拟合法和卡尔曼滤波法，曲线拟合法虽然相对简单，但修正间隔短且修正时间长，因此通常采用卡尔曼滤波法进行零速修正估计。当检测到载体处于静止状态时，利用SINS子系统解算的速度作为系统速度误差的观测量，进行卡尔曼滤波估计，利用更新后的状态估计值反馈校正SINS子系统内部的导航参数误差，完成静态零速修正。
零速状态判断准则：
- 加速度幅值检测：载体处于静止状态时，惯性测量器件中加速度计的三轴输出矢量和应稳定在当地重力加速度值附近，通过设定比力阈值检测零速状态。
- 加速度滑动方差检测：载体处于静止状态时，惯性测量器件中加速度计三个轴的输出值的方差应该近似于0，，设置一定大小的滑动窗口，通过比力方差阈值对加速度计三个轴分别检测零速状态。
- 角速度幅值检测: 同加速度幅值检测，载体处于静止状态时，惯性测量器件中陀螺仪的三轴输出矢量和应近似为零，通过设定角速率阈值检测零速状态。
- 角速度滑动方差检测: 同加速度滑动方差检测，载体处于静止状态时，惯性测量器件中陀螺仪三个轴的输出值的方差应该近似于0，，设置一定大小的滑动窗口，通过角速率方差阈值对陀螺仪三个轴分别检测零速状态。
2. 动态零速修正
英文Dynamic Zero Velocity Update，缩写DZUPT，静态零速修正需要载体处于静止状态，且需要每隔一定的时间停车修正，限制了车辆的机动性。这里借用零速修正的思想，利用运动学约束信息对载体进行动态零速修正(Dynamic Zero Velocity Update, DZUPT)，在丢失卫星信号情况下，可使得导航误差得到有效抑制，保证了导航信息的精度和实时性，并且用在静态零速修正中可以减少停车次数，延长停车时间间隔。根据车辆在道路上行驶特点，当车辆在道路上正常行驶时，理想情况下不发生侧滑(即车辆的侧向)和跳跃（即车辆的高度方向）。
- ZIHR: 在着地静止阶段，理论上在前后两个采样点上单兵的航向角不会发生改变，但是由于MEMS 微惯性元件的测量误差较大，导致前后两个采样点上单兵导航系统求解出的航向角差值并不为零，借鉴 ZUPT 方法的思想，将前后两个采样点上的航向角差值作为量测量对航向误差角施加抑制。
- ZARU: 航向角修正方法思想是在指在着地静止阶段，捆绑在单兵脚上的 MEMS 陀螺仪的三轴角速度输出理论上都应该为 0。然而，因为 MEMS 陀螺仪的测量噪声比较大，这使得 MEMS 陀螺仪的角速度输出并不为0。因此将着地静止阶段的 MEMS 陀螺仪的测量值作为量测量，对 MEMS 陀螺仪测量噪声进行修正。而航向误差角和陀螺仪的测量噪声存在直接的联系，因此 ZARU 方法同样也可以达到对航向误差角的修正作用。
总结与思考：ZUPT， DZUPT等约束不依赖于其他的传感器，在GNSS/INS组合导航的问题上。
- 关于ZUPT，可有效的减小车辆静止时的定位误差，同时静态约束可以很好地用于估计INS的bias。
- 关于DZUPT：Z轴方向的约束在车辆上坡的时候会带来较大的误差，另外，当车辆转弯或者换车道的时候，车辆侧向的约束也会带来较大的误差。因此如何有效的检测DZUPT的可靠性，也是一个很好的科学问题。
- 针对应用来说：L2.5或者以下的自动驾驶或者辅助驾驶，对导航定位的精度没有那么高，比比如横向误差约30cm，纵向误差约60cm，使用ZUPT等约束可帮助提高导航定位效果。
- 语义信息辅助的导航：随着环境感知能力的不断增强，不管是基于视觉还是基于激光雷达，有效地结合语义信息来辅助导航将会是一个比较有潜力的方向。比如上述ZUPT约束，其实也是一个语义信息（即速度为零的信息），该约束也可以通过视觉等传感器来捕捉，毕竟在L2.5的无人车导航定位解决方案中，相机一般都是有的！
基于车体约束的INS辅助定位相关推荐
- SemSegMap ：基于3D点云语义信息的定位
点云PCL免费知识星球,点云论文速读. 文章:SemSegMap - 3D Segment-Based Semantic Localization 作者:Andrei Cramariuc, Flori ...
- 基于FPGA的单目内窥镜定位系统设计（上）
今天给大侠带来基于FPGA的单目内窥镜定位系统设计,由于篇幅较长,分三篇.今天带来第一篇,上篇,话不多说,上货. 导读 随着现科技的发展和社会的进步,信息科技迅速发展,我们可从互联网.电台等媒体获取大 ...
- 基于FPGA的单目内窥镜定位系统设计（中）
今天给大侠带来基于FPGA的单目内窥镜定位系统设计,由于篇幅较长,分三篇.今天带来第二篇,中篇,话不多说,上货. 导读 随着现科技的发展和社会的进步,信息科技迅速发展,我们可从互联网.电台等媒体获取大 ...
- 最新agps位置服务器,GPS辅助定位的方式-AGPS/EPO/HOTSTILL|AssistNow Online/Offline/Autonomous...
通过与众多客户的沟通,很多人搞不清这些GPS定位方式的概念,达盟GPS小编整理一下, 试图用简单的语言让大家都能了解这些概念. 所谓GPS辅助定位,就是在GPS设备在定位之前,通过网络获取当前GPS设 ...
- （四） AGPS辅助定位
AGPS辅助定位 AGPS是Assisted Global Positioning System辅助全球定位系统的缩写,是手机开始内置GPS芯片以后发展起来的技术.关于这个名词,国内有些"小 ...
- 基于Powell共轭方向法的UWB室内定位构型优化算法
基于Powell共轭方向法的UWB室内定位构型优化算法 阚昊宇 摘要: UWB室内定位系统的服务性能及定位精度很大程度上受UWB基站构型影响,而GDOP是衡量系统定位服务性能的重要指标.目前关于UWB ...
- 【数字图像处理课程设计】基于非深度学习方法实现身份证定位与正反面识别
文章目录 基于透视矫正与区域特征匹配的身份证图像定位与正反面识别 摘要 实现细节 1.总体流程 2.前景背景分割 3.身份证角点定位 4.透视变换 5.模板匹配 5.1 基于区域颜色匹配的国徽检测 5 ...
- 基于FPGA的单目内窥镜定位系统设计（下）
今天给大侠带来基于FPGA的单目内窥镜定位系统设计,由于篇幅较长,分三篇.今天带来第三篇,下篇,话不多说,上货. 导读 随着现科技的发展和社会的进步,信息科技迅速发展,我们可从互联网.电台等媒体获取大 ...
- 5 个 APP 自动化测试辅助定位工具，你用过几个？
UI 自动化测试时,先要定位到需要操作的元素,然后才能执行指令. 在网页端可以非常方便的通过 devtools 工具(也就是经常说的 F12) 获取和编写元素定位表达式. 但是在移动端自动化时,这种辅 ...
最新文章
- [置顶] Hibernate从入门到精通（十）多对多单向关联映射
- mysql中FIND_IN_SET的使用方法
- 手把手教你Tableau高级数据分析功能（附数据集）
- PAT L2-014. 列车调度
- Android百度地图悬浮窗样式,JS百度地图搜索悬浮窗功能
- linux dd 截文件,Linux使用dd命令快速生成大文件（转）
- ubuntu添加dvd光盘源
- iptables之iptables命令详解
- 探索Apache Camel Core –文件组件
- 再看那个用代码把人类送上月球的女人——Margaret Hamilton
- docker容器构建_我如何容器化构建系统
- 异常概念和处理机制，try-catch-finally，throw和throws，自定义异常
- 机器学习的几种主要学习方法
- mac git 拉代码太慢或是拉不下来，可能是这个原因
- 说说Thread的interrupt()
- c语言实现猜数字游戏
- 几种反函数和差角公式的推导
- 八卦罗盘动态时钟（C语言）
- 阿尔兹海默症AD最新研究进展（2021年7月）
- 直播系统解决方案：直播平台如何开发搭建