一种面向同构IMU的分布式协同互校准定位方法技术

本发明专利技术公开了一种面向同构IMU的分布式协同互校准定位方法，属于导航定位技术领域。其包括以下步骤：建立平台之间的相对测距关系；各平台将自身的IMU互校准后定位信息进行广播或发送到指定平台；各平台执行IMU互校准计算，然后将计算得到的定位结果进行播发；各平台根据使用需求选择相应的定位结果。本方法简单易行，对保障室内、城市峡谷等仅能依赖IMU实现定位的应用场景下的有效定位具有重要意义。

【技术实现步骤摘要】
一种面向同构IMU的分布式协同互校准定位方法
本专利技术属于导航定位
，特别是指一种面向同构IMU的分布式协同互校准定位方法。
技术介绍
当前大部分中小微平台使用IMU(InertialMeasurementUnit，惯性测量单元)和卫星导航接收机作为导航传感器，并通过松耦合、紧耦合或深耦合的算法途径实现两种传感器的组合导航。在卫星导航不可用、或难以连续输出定位信息的应用环境，这些导航系统将退变为仅依赖IMU定位，定位误差随着时间迅速发散，导致定位信息不可用。同构IMU是指微陀螺、微加速度计加工工艺技术相近，具有相同结构形态、器件组成、内嵌程序的IMU。同构IMU定位误差具有相似的随机特征，若多个同构IMU近似同时进入独立定位状态，当其数量趋于无限大时，其误差值的统计值趋近于0。基于这一客观条件，利用协同导航思维，通过平台间测距量不发散的特性，在多平台搭载IMU之间建立误差耦合关系来抑制其误差发散，最终通过互校准过程达到提升多平台IMU定位性能的效果。当前国内外已有部分关于IMU协同互校准的技术途径，其特点是通过卡尔曼滤波估计的方式建立多个IMU之间的误差递推方程来估计和抑制IMU的误差，但其需要存在一个集中式计算平台、或在预先知悉全部IMU误差的互相关特征的基础上由各个平台分别完成计算，因而在实际应用中并不方便且需要占用较高的通信带宽。
技术实现思路
本专利技术的目的在于提供一种面向同构IMU的分布式协同互校准定位方法，本方法可面向仅能依赖IMU实现定位的应用场景，实现多个搭载同构IMU的平台间的协同定位。为了实现上述目的，本专利技术采用的技术方案为：一种面向同构IMU的分布式协同互校准定位方法，包括以下步骤：(1)在多个平台间建立相对测距关系，每个平台均可在本地获取与其他一个、数个或全部节点的几何观测距离；(2)每个平台通过通信链路将自身的IMU互校准后定位信息进行广播或发送到指定平台；(3)每个平台根据获取到的与其他平台的测距值以及对应平台的IMU互校准后定位信息的情况，执行并完成IMU互校准计算；(4)每个平台执行互校准计算后，将计算得到的本地定位结果作为自身的IMU互校准后定位信息通过通信链路进行播发；(5)当卫星导航可用时，各平台使用本地IMU输出的原始定位值参与组合定位；当卫星导航不可用时，各平台使用互校准计算的定位值进行定位。进一步的，所述平台是指通过IMU实现定位的应用个体，包括车辆与机器人、飞行器、航行器、人员设备中的一种或多种。进一步的，步骤(3)的具体方式为：(301)若平台获得了与其他平台的测距值，并获得对应平台的IMU互校准后定位信息，则执行步骤(302)～(306)；若平台在当前时刻t1未获得与其他平台的测距值或对应平台的IMU互校准后定位信息，但本地在此前的t0时刻执行过步骤(302)～(306)的互校准计算过程，则执行步骤(307)；若平台在当前时刻未获得与其他平台的测距值或对应平台的IMU互校准后定位信息，且本地此前未执行过步骤(302)～(306)的互校准计算过程，则执行步骤(308)；(302)获取当前本地IMU输出的互校准定位结果P；当首次执行协同过程尚不具有互校准定位结果时，取当前本地IMU输出的原始定位值作为P；(303)本地获取测距值L并通过通信链路读取与测距值相对应的平台的IMU互校准定位信息Q；(304)将P和Q转换至本地坐标系或其他用XYZ表示的坐标系下，分别得到[Px，Py，Pz]和[Qx，Qy，Qz]；(305)根据下式计算坐标(306)将计算得到的坐标转换回IMU原始输出值对应的坐标系下，得到将其作为当前获得的IMU互校准定位结果；(307)按照下式计算t1时刻本地的IMU互校准定位结果：其中，W(t1)表示本地IMU在t1时刻输出的原始定位值，W(t0)表示本地IMU在t0时刻输出的原始定位值；(308)将本地IMU输出的原始定位值作为互校准定位结果。本专利技术与现有技术相比所取得的有益效果为：(1)本专利技术不需要在应用区域中安装用于定位的基础设施，平台通过IMU协同互校准过程即可实现对IMU定位性能的提升。(2)本专利技术不需要远程后台服务器及与其相连的通信网络支持，可在缺乏稳定的远程通信中实现协同定位。(3)本专利技术具有分布式应用特征，不需要特定平台实现集中解算；同时应用方式简易、计算复杂度低、占用通信资源少、不依赖于对IMU的反馈校正过程，无需获知IMU之间的误差互相关特性。附图说明图1是本专利技术实例中同构IMU协同互校准定位方法的流程图。具体实施方式以下结合附图和具体实施方式对本专利技术做进一步的说明。一种面向同构IMU的分布式协同互校准定位方法，包括以下步骤：(1)多个平台间通过无线测量、光测量等技术途径建立相对测距关系，每个平台可在本地获取与其他一个、数个或全部节点的几何观测距离；(2)每个平台通过通信链路将自身的IMU互校准后定位信息进行广播或发送到指定平台；(3)每个平台当获取到与其他平台的测距值、并且获知对应平台的IMU互校准后定位信息时，执行并完成IMU互校准计算，具体包括：(301)获取当前本地IMU输出的互校准定位结果P；当首次执行协同过程尚不具有互校准定位结果时，取当前本地IMU输出的原始定位值作为P；(302)本地获取测距值L并通过通信链路读取与测距值相对应的平台的IMU互校准定位信息Q；(303)将P和Q转换为本地坐标系或其他用XYZ表示的坐标系下，分别得到[Px，Py，Pz]和[Qx，Qy，Qz]；(304)计算如下公式：(305)将计算得到的转换回IMU原始输出值对应的坐标系表示方法，得到将其作为当前获得的IMU互校准定位结果；(306)若平台当前t1时刻未获得有效测距值或与其对应的其他平台的互校准后定位信息，但本地执行过互校准计算过程，按照如下公式计算t1时刻本地的IMU互校准定位结果：其中，t0表示上一次执行过互校准计算过程的时刻，W(t1)表示本地IMU在t1时刻输出的原始定位值，W(t0)表示本地IMU在t0时刻输出的原始定位值；(307)若平台当前时刻未获得有效测距值或与其对应的其他平台的互校准后定位信息，且本地未执行过互校准计算过程，则将本地IMU输出的原始定位解作为互校准定位结果；(4)每个平台执行互校准计算后，将计算得到的本地定位结果作为自身的IMU互校准后定位信息通过通信链路进行播发；(5)由此每个平台本地可获得两个定位值：本地搭载的IMU的原始定位值、经过互校准计算的定位值，可根据使用需求选择相应的定位结果。进一步的，所述平台是指通过IMU实现定位的应用个体，包括车辆与机器人、飞行器、航行器、人员设备等。<本文档来自技高网...

【技术保护点】
1.一种面向同构IMU的分布式协同互校准定位方法，其特征在于，包括以下步骤：/n(1)在多个平台间建立相对测距关系，每个平台均可在本地获取与其他一个、数个或全部节点的几何观测距离；/n(2)每个平台通过通信链路将自身的IMU互校准后定位信息进行广播或发送到指定平台；/n(3)每个平台根据获取到的与其他平台的测距值以及对应平台的IMU互校准后定位信息的情况，执行并完成IMU互校准计算；/n(4)每个平台执行互校准计算后，将计算得到的本地定位结果作为自身的IMU互校准后定位信息通过通信链路进行播发；/n(5)当卫星导航可用时，各平台使用本地IMU输出的原始定位值参与组合定位；当卫星导航不可用时，各平台使用互校准计算的定位值进行定位。/n

【技术特征摘要】
1.一种面向同构IMU的分布式协同互校准定位方法，其特征在于，包括以下步骤：
(1)在多个平台间建立相对测距关系，每个平台均可在本地获取与其他一个、数个或全部节点的几何观测距离；
(2)每个平台通过通信链路将自身的IMU互校准后定位信息进行广播或发送到指定平台；
(3)每个平台根据获取到的与其他平台的测距值以及对应平台的IMU互校准后定位信息的情况，执行并完成IMU互校准计算；
(4)每个平台执行互校准计算后，将计算得到的本地定位结果作为自身的IMU互校准后定位信息通过通信链路进行播发；
(5)当卫星导航可用时，各平台使用本地IMU输出的原始定位值参与组合定位；当卫星导航不可用时，各平台使用互校准计算的定位值进行定位。


2.根据权利要求1所述的一种面向同构IMU的分布式协同互校准定位方法，其特征在于，所述平台是指通过IMU实现定位的应用个体，包括车辆与机器人、飞行器、航行器、人员设备中的一种或多种。


3.根据权利要求1所述的一种面向同构IMU的分布式协同互校准定位方法，其特征在于，步骤(3)的具体方式为：
(301)若平台获得了与其他平台的测距值，并获得对应平台的IMU互校准后定位信息，则执行步骤(302)～(306)；若平台在当前时刻t1未获得与其他平台的测...

【专利技术属性】
技术研发人员：何成龙，蔚保国，易卿武，赵麟，郝菁，
申请(专利权)人：中国电子科技集团公司第五十四研究所，
类型：发明
国别省市：河北;13