一种融合速度传感器与北斗定位的多模定位工卡系统及方法与流程

文档序号:42972160发布日期:2025-09-15 11:45阅读:27来源:国知局

本发明涉及定位跟踪领域,具体涉及一种融合速度传感器与北斗定位的多模定位工卡系统及方法。


背景技术:

1、卫星导航系统(bds)作为我国自主研发的全球卫星导航系统,能够提供覆盖全球的高精度定位服务,其公开服务精度可达米级,在开阔环境下可为各类终端设备提供可靠的绝对位置信息。然而,北斗系统依赖卫星信号进行定位,在室内、隧道、高楼密集区等信号遮挡场景下,卫星信号强度显著衰减甚至完全中断,导致定位功能失效,形成所谓的"城市峡谷效应"或"室内定位盲区"。这一技术瓶颈严重制约了北斗系统在复杂环境中的应用范围,特别是在需要连续、可靠定位的隧道施工、仓储物流、室内导航等场景中,单一依赖北斗定位的技术路线已无法满足实际需求。

2、此外,现有系统在误差抑制方面仍存在技术瓶颈。一方面,imu的硬件误差(如零偏漂移、温漂等)直接影响融合定位精度,虽然可通过出厂校准降低初始误差,但在长时间运行中,环境温度变化与器件老化仍会导致误差逐渐累积,而现有系统大多缺乏有效的在线校准机制。另一方面,地图信息作为重要的先验知识,可有效约束imu的推算轨迹,避免与实际环境发生冲突,但现有技术对地理围栏的应用较为简单,通常仅设置硬性边界约束,缺乏对复杂场景(如多楼层建筑、室内障碍物分布)的精细化建模,导致轨迹校正效果有限。


技术实现思路

1、本发明的目的是为了解决现有技术中存在的缺点,而提出的一种融合速度传感器与北斗定位的多模定位工卡系统及方法。

2、为实现上述目的,本发明采用了如下技术方案:一种融合速度传感器与北斗定位的多模定位工卡系统,所述系统包括北斗定位模块、imu惯性测量单元以及数据处理模块;所述数据处理模块集成传感器校准单元、自适应卡尔曼滤波器及地图辅助校正单元,用于动态融合北斗与imu数据并输出最终定位结果;所述传感器校准单元用于对imu惯性测量单元进行误差校准,所述误差校准包括加速度计偏置校准与陀螺仪温漂抑制;所述加速度计偏置校准在北斗信号可用时通过静止或匀速运动轨迹实时计算零偏误差。

3、较佳的,所述imu惯性测量单元包含3轴陀螺仪与3轴加速度计,量程分别为±250°/s~±2000°/s与±2g~±16g,采样频率100hz~1000hz。

4、较佳的,所述自适应卡尔曼滤波根据北斗信号质量动态调整信任权重,信号良好时北斗数据主导并重置imu积分误差,信号中断时imu航位推算为主并引入运动约束模型。

5、较佳的,所述基于地图的辅助校正通过预设场景地理信息,在imu推算轨迹与地图冲突时强制校正到合理路径。

6、较佳的,所述北斗定位模块内采用混合定位模式切换机制,包括平滑过渡机制,室外进入室内时逐步提高imu权重,室内返回室外时利用首次恢复的北斗信号反向补偿imu累积误差。

7、较佳的,所述自适应卡尔曼滤波器的运动约束模型基于步频检测,通过行人步长约束imu推算轨迹。

8、较佳的,所述地图辅助校正单元预设地理围栏数据包括建筑物边界与室内外过渡区域边界。

9、一种融合速度传感器与北斗定位的多模定位工卡系统的方法,所述方法具体步骤如下:

10、s1:通过北斗定位模块获取初始位置信息,并通过传感器校准单元对imu惯性测量单元进行误差校准;

11、s2:数据处理模块实时接收北斗定位模块和imu惯性测量单元的数据,通过自适应卡尔曼滤波器动态融合数据,根据北斗信号质量调整信任权重;

12、s3:当北斗信号中断时,启动imu航位推算模式,并引入运动约束模型抑制漂移;

13、s4:通过地图辅助校正单元检测imu推算轨迹与预设地理围栏的冲突,强制校正轨迹至合理路径;

14、s5:在室内外场景切换时,执行混合定位模式切换机制,平滑调整imu权重并补偿累积误差。

15、与现有技术相比,本发明的有益效果为:本发明提出的一种融合速度传感器与北斗定位的多模定位工卡系统及方法,在定位精度方面,本发明通过自适应卡尔曼滤波动态融合北斗与imu数据,信号良好时以北斗数据为主导并重置imu误差,信号中断时启动imu航位推算并引入运动约束模型(如行人步频检测),将30分钟信号中断下的位置误差从传统方案的±50米降低至±5米;同时,基于地图的辅助校正功能通过预设地理围栏(如建筑物边界、室内外过渡区域)强制修正imu推算轨迹,进一步抑制了累积误差,使定位结果始终保持在合理路径范围内,解决了传统系统在复杂场景中的定位漂移问题。



技术特征:

1.一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述系统包括北斗定位模块、imu惯性测量单元以及数据处理模块;所述数据处理模块集成传感器校准单元、自适应卡尔曼滤波器及地图辅助校正单元,用于动态融合北斗与imu数据并输出最终定位结果;所述传感器校准单元用于对imu惯性测量单元进行误差校准,所述误差校准包括加速度计偏置校准与陀螺仪温漂抑制;所述加速度计偏置校准在北斗信号可用时通过静止或匀速运动轨迹实时计算零偏误差。

2.如权利要求1所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述imu惯性测量单元包含3轴陀螺仪与3轴加速度计,量程分别为±250°/s~±2000°/s与±2g~±16g,采样频率100hz~1000hz。

3.如权利要求1所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述自适应卡尔曼滤波根据北斗信号质量动态调整信任权重,信号良好时北斗数据主导并重置imu积分误差,信号中断时imu航位推算为主并引入运动约束模型。

4.如权利要求1所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述基于地图的辅助校正通过预设场景地理信息,在imu推算轨迹与地图冲突时强制校正到合理路径。

5.如权利要求1所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述北斗定位模块内采用混合定位模式切换机制,包括平滑过渡机制,室外进入室内时逐步提高imu权重,室内返回室外时利用首次恢复的北斗信号反向补偿imu累积误差。

6.如权利要求3所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述自适应卡尔曼滤波器的运动约束模型基于步频检测,通过行人步长约束imu推算轨迹。

7.如权利要求1所述的一种融合速度传感器与北斗定位的多模定位工卡系统,其特征在于:所述地图辅助校正单元预设地理围栏数据包括建筑物边界与室内外过渡区域边界。

8.一种融合速度传感器与北斗定位的多模定位工卡系统的方法,其特征在于:所述方法具体步骤如下:


技术总结
本发明涉及一种融合速度传感器与北斗定位的多模定位工卡系统及其方法。该系统包括北斗定位模块、IMU惯性测量单元和数据处理模块,能够动态融合北斗与IMU数据并输出精确定位结果。数据处理模块集成传感器校准单元、自适应卡尔曼滤波器和地图辅助校正单元,进行IMU误差校准、信号融合与轨迹修正。系统通过自适应卡尔曼滤波根据北斗信号质量动态调整信任权重,信号中断时启用IMU航位推算并引入步频检测等运动约束模型,显著降低定位误差。此外,地图辅助校正功能通过预设地理围栏数据校正IMU推算轨迹,解决了传统系统在复杂环境中的定位漂移问题。

技术研发人员:晏莺,周昌清
受保护的技术使用者:南京周全安全咨询有限公司
技术研发日:
技术公布日:2025/9/14
网友询问留言 留言:0条
  • 还没有人留言评论。精彩留言会获得点赞!
1