[发明专利]一种导航定位方法及设备

摘要

本发明实施例公开了一种导航定位方法及设备，包括：当检测到卫星信号失效时，以第k个计算周期的磁航向角为观测量，通过DR/磁航向组合导航算法模型得到第一状态量组合，以第k个计算周期的横向速度为观测量，通过DR/车辆运动组合导航算法模型得到第二状态量组合；根据第k个计算周期的系统状态方程，针对第一状态量组合和第二状态量组合进行闭环卡尔曼组合滤波得到第一误差修正值；根据第一误差修正值修正第k个计算周期的初始航向角得到目标航向角，根据目标航向角和第k个计算周期的DR模型，计算得到目标速度和目标位置。采用本发明实施例，实现了卫星信号无效时的车辆定位导航，提高了车载定位的准确性。