组合导航(八):INS/GPS组合导航

2023-05-16

  • INS/GPS组合导航
  • 1 误差反馈
    • 1.1 开环INS/GPS架构
    • 1.2 闭环INS/GPS架构
  • 2 组合导航的类型
    • 2.1 松耦合 的INS/GPS组合导航
    • 2.2 紧耦合 的INS/GPS组合导航
    • 2.3 深度耦合的 INS/GPS组合导航
  • 3 INS方程的动态误差模型
  • 4 松耦合的INS/GPS组合导航模型
    • 4.1 系统模型
    • 4.2 测量模型
    • 4.3 INS/GPS松耦合总框图
  • 5 紧耦合的INS/GPS组合导航模型
    • 5.1 系统模型
    • 5.2 测量模型
    • 5.3 总体测量模型

INS/GPS组合导航

对比INS与GPS导航方法,二者都有其各自的优缺点。
惯性导航系统INS是一种全自主的导航系统,可以输出超过200Hz的高频信号,并且具有较高的短期测量精度。除了提供位置与速度之外还可以提供姿态信息。但由于算法内部存在积分,惯性传感器的误差会不断累积,使得长期导航误差无限制增长。
与INS相反,GPS具有良好的长期精度,导航误差大致为几米,设备成本低于100美元。但是,它短期精度与输出频率较低。一个常规的GPS接收机通常无法提供姿态信息,除非采用一些额外的硬件或软件。此外,全球卫星导航系统需要依靠至少3颗卫星(4颗)的信号,而卫星信号通常会受到高层建筑、树木、隧道、大气以及多路径效应的干扰。
从上述特点来看,INS与GPS具有较好的互补特性,将二者集成可以得到比单一导航系统稳定性更好、精度更高的导航方案。INS/GPS的组合导航系统可以输出高频率的导航参数信息(位置、速度、姿态),并且在长、短期的导航过程中均能具备较高精度。采用基于卡尔曼滤波的最优估计方法,对GPS和INS定位导航信息进行融合,可以得到可靠的导航解。GPS能够防止惯性数据漂移,INS能在GPS信号中断时提供位置、速度、姿态信息。
典型的INS/GPS组合如图所示:
在这里插入图片描述
滤波器可以采用传统的kalman滤波器、其衍生的LKF、EKF,或者其他滤波算法(粒子滤波)。
滤波器通过比较惯导与GPS的输出,估计出惯导系统中位置,速度和姿态的误差,该误差对惯性输出进行校正。

1 误差反馈

基于状态误差卡尔曼滤波的INS/GPS组合导航系统,可采用两种误差反馈机制:开环和闭环。

1.1 开环INS/GPS架构

在开环结构中,位置校正、速度校正和姿态校正均在INS外部完成,其中估计误差在每次迭代时从INS解中减去。在这一过程中,误差与状态校正不会反馈给INS系统。
在这里插入图片描述
开环结构的优点:
在kalman滤波出现问题时,还可以通过原始的INS导航系统继续支持导航工作。
但是,由于惯性漂移没有进行补偿,惯导误差随时间不断增大,使得线性假设失效。
因此开环的结构更容易导致kalman滤波器性能下降。

1.2 闭环INS/GPS架构

在闭环结构中,KF估计的误差通过反馈的形式对INS进行校正。在误差估计反馈后,KF的位置、速度和姿态估计被重置为零。
由下图以看出,kalman滤波估计的加速度计误差与陀螺仪误差在每个周期内都通过反馈以矫正IMU测量,继而作用于系统模型的计算。在这里插入图片描述

2 组合导航的类型

为了最大限度地发挥GPS和INS的互补特性,提出了各种INS/GPS集成架构。
可分为:松耦合、紧耦合和深耦合。

2.1 松耦合 的INS/GPS组合导航

在这里插入图片描述
在松耦合的结构中,GPS与INS均独立工作并各自提供导航参数的结果。为了提高导航精度,通常将GPS的位置与速度输入到滤波器中,同时,INS的位置、速度、姿态也作为滤波器的输入,滤波器通过比较二者的差值,建立误差模型以估计INS的误差。利用这些误差对惯导结果进行修正,得到速度、位置、姿态的组合导航结果。
松耦合的结构框图 如上所示。
松耦合的组合结构易于实现,并且比较稳定。当它为开环时,可以提供三个独立的导航结果(原始INS、原始GPS和组合结果),当它为闭环时可以提供两个独立的导航结果(原始GPS、组合结果)。
一个主要的缺点,当卫星数量低于最低数量时,GPS会暂时失效。并且GPS KF的输出是时间相关的,那么KF对于测量噪声不相关的假设就会受到影响,从而影响系统性能。

2.2 紧耦合 的INS/GPS组合导航

在紧耦合的导航系统中,GPS的伪距以及伪距速率的测量 将与INS预测的相应值 进行做差,并将差值反馈给kalman滤波器,用来估计惯导系统的误差。惯导系统的输出经过误差的校正之后,得到组合导航的解。
紧耦合的系统结构如图所示。
在这里插入图片描述
紧耦合的组合方式消除了松耦合方法中因卡尔曼滤波级联而产生的测量关联问题。除此之外,在卫星信号消失的情况下,紧耦合的组合模式依然能够提供GPS信号更新。
由于紧耦合方法涉及对原始GPS数据的处理,因此在结构上相对于松耦合来说更加复杂。
另一个局限在于,紧耦合结构无法得到独立的GPS导航结果。
在INS/GPS组合导航使用相同硬件条件下,紧耦合的方式在精度与鲁棒性上均优于松耦合的结果。

2.3 深度耦合的 INS/GPS组合导航

在这里插入图片描述
深度耦合结构与紧耦合、松耦合主要存在两个区别
1.GPS接收机采用了回环校正的结构
2.INS的信息作为GPS接收机的一个组成部分
因此,在深耦合的结构中,INS与GPS将不再是独立的系统。
该方案通常需要接入内部GPS硬件,实现起来比较复杂。
深组合的优点是:这种方式降低了跟踪频率,提高了抗干扰能力。使得导航系统可以在较低的信噪比下工作,并且在卫星信号拒止的情况下GPS依然能够得到导航解。

3 INS方程的动态误差模型

在INS/GPS组合导航中,需要一个最优估计器来进行数据融合与估计。根据不同系统的需求,估计器的选择也有所不同。传统上,常用kalman滤波器进行惯性传感器的融合,因此,在后续主要针对这一组合进行研究。
在导航坐标系的选择上,根据第(五)讲的内容,通常选用local-level坐标系(当地坐标系)来实现导航解算。第(六)讲分析了导航初始化误差、惯性传感器误差、算法误差等对惯性导航系统误差的影响。
因此,此处要使用误差模型来分析和估计与INS相关的各种误差源,总结误差模型,以便于对组合导航的不同结构进行分析。

在第6讲曾分析过,L系的状态误差矢量方程中,包含了沿大地曲面的误差(纬度误差、精度误差、海拔误差)、沿地球系的速度误差(东向速度误差Ve、北向速度误差Vn、天向速度误差Vu)、以及三个姿态角的误差(俯仰pitch、横滚roll、航向yaw)、同时还包括加速度计的bias和陀螺仪的drift。
因此,完整的误差状态矢量表述为:
在这里插入图片描述
在这里插入图片描述
(在L系下)上式中,各部分的误差线性化模型为:

位置误差:在这里插入图片描述
速度误差:
在这里插入图片描述
姿态误差:
在这里插入图片描述
加速度误差:
在这里插入图片描述
角速度误差:
在这里插入图片描述

4 松耦合的INS/GPS组合导航模型

4.1 系统模型

连续时间卡尔曼滤波的系统模型:
在这里插入图片描述
其中,G为噪声分布矢量,包含了与状态矢量相关的方差:
在这里插入图片描述
F为动态协方差矩阵,包含了INS误差模型的各个部分【也就是之前的线性化模型】,可以总结为以下形式:
在这里插入图片描述
状态矢量为 位置、速度、姿态、加速度计、陀螺仪的误差分量:
在这里插入图片描述

因此,INS/GPS 松耦合组合导航的系统模型 可以写成:
在这里插入图片描述
将上式进行展开,可以较为清楚地看到系统状态是如何通过动态矩阵进行耦合的:
在这里插入图片描述
同理,离散时间的系统模型为:
在这里插入图片描述
在这里插入图片描述

4.2 测量模型

离散的KF测量模型表示为:
在这里插入图片描述
其中,等式右侧第二项代表零均值的测量噪声,协方差为Rk。
由于KF的状态矢量包含INS中的误差,因此对应的测量矢量由INS预测的速度、位置与GPS测量的位置、速度之差组成:
在这里插入图片描述
Hk是tk时刻的测量矩阵,描述了在无噪声情况下通过状态变量的线性组合得到测量值Zk:
在这里插入图片描述
那么,完整的松耦合测量模型可写为:
在这里插入图片描述
将其展开得到:
在这里插入图片描述
此外,还有两个重要的协方差矩阵Rk、Pk
Rk包含测量状态对角线上的方差,定义为:
在这里插入图片描述
预测状态的协方差Pk同样是一个对角矩阵,由对角线上的方差组成:
在这里插入图片描述
其中,每一个对角元素的方差项也是3x3的对角矩阵,分别与位置,速度,姿态,陀螺仪偏差和加速度计偏差有关。

4.3 INS/GPS松耦合总框图

在这里插入图片描述

5 紧耦合的INS/GPS组合导航模型

此处讨论紧耦合的组合导航模型。
与第4部分类似,首先讨论从L系下的INS动态误差和测量模型;
接着给出GPS误差和测量误差模型;
最后通过kalman滤波实现综合系统模型与测量模型。

5.1 系统模型

INS part
连续时间kalman滤波 INS系统模型(与松耦合相同):
在这里插入图片描述
FI:动态协方差矩阵
G:噪声分布矩阵
wI:白噪声

GPS part
kalman滤波GPS系统模型:
在这里插入图片描述
状态矢量中包含:GPS接收机时钟误差和漂移,通过随机游走建模:
在这里插入图片描述
动态协方差矩阵为:
在这里插入图片描述
噪声分布矢量:
在这里插入图片描述
各分量分别为:时钟偏差的白噪声标准差,时钟漂移的白噪声标准差
因此,完整的系统模型可以表示为:
在这里插入图片描述

结合INS与GPS的系统模型
在这里插入图片描述
将 INS part 与 GPS part 的方程代入,得到上式的展开式:
在这里插入图片描述
在这里插入图片描述

离散时间的系统模型:
在这里插入图片描述
在这里插入图片描述

5.2 测量模型

kalman滤波的测量模型在离散时间上的表达式为:
在这里插入图片描述
对于紧耦合的系统来说,可用的观测数据为GPS的伪距以及伪距速率等测量值,因此,测量矢量即为INS估计值与GPS测量值之差:
在这里插入图片描述
对于M个卫星来说,方程又可写为:
在这里插入图片描述

伪距测量值【具体内容在第三章】
在这里插入图片描述
GPS接收机获得第m个卫星的信号,可以通过以下模型来表示:
在这里插入图片描述
在这里插入图片描述
利用卫星导航信息可以计算出卫星的钟差和电离层误差,对流层误差也可以通过建立适当的模型进行计算。因此,在对GPS误差进行校正之后,可以将校正后的伪距写成:
在这里插入图片描述
等式右侧第三项为各种剩余误差。

第m个卫星到GPS接收机的实际物理距离为:
在这里插入图片描述
其中:在这里插入图片描述
则,伪距方程可重写为:
在这里插入图片描述
其中:
在这里插入图片描述
校正后的接收机位置定义为:
在这里插入图片描述
其中:
在这里插入图片描述
由于伪距测量方程是非线性的,因此在进行kalman滤波之前需要进行线性化(在xINS附近泰勒展开),对于函数 F(x,y,z)在线性化点(xi,yi.zi)的展开式为:
在这里插入图片描述
将伪距方程在当前最优估计值(xINS, yINS, zINS)处线性化后,得到:
在这里插入图片描述
由INS的输出定义的伪距测量为:
在这里插入图片描述
因此,可以得到二者的差值:
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
所以,伪距测量误差可归结为:
在这里插入图片描述
对于M个可被观测的卫星,测量误差方程可表示为:
在这里插入图片描述
对于ECEF大地坐标中的位置,需要使用以下关系将其转换成ECEF直角坐标:
在这里插入图片描述
为了在kalman滤波中使用,上述方程组必须通过泰勒级数线性化:
在这里插入图片描述
在这里插入图片描述
将上式代入到测量误差方程中,
在这里插入图片描述得到最终的伪距测量模型:
在这里插入图片描述
伪距速率测量
在这里插入图片描述
卫星和接收器运动产生的多普勒频移是二者相对速度在连线上的投影,与发射频率成正比,与光速成反比
在这里插入图片描述
在这里插入图片描述
其中:
在这里插入图片描述
根据多普勒测量,伪距速率可以通过下式进行计算:
在这里插入图片描述
而实际的伪距速率为:
在这里插入图片描述建立伪距测量的模型:
在这里插入图片描述
令接收机时间漂移:
在这里插入图片描述

在这里插入图片描述由于我们想要得到的测量模型是关于deta(Vx)、deta(Vy)、deta(Vz)的函数,因此需要将上式转化为状态误差的形式。
由INS测量得到的伪距速率为:
在这里插入图片描述
其中,Vx,INS、Vy,INS、Vz,INS是INS在e坐标系下估计的接收机速率。
将(8.66)与(8.67)式做差,得到:
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
(8.70)中
在这里插入图片描述
将(8.70)写成状态空间的形式:
在这里插入图片描述
对于M个可被观测的卫星,伪距速率的测量误差方程可表示为:
在这里插入图片描述
在这里插入图片描述
速度在L系与e系之间的关系可通过下式表示:
在这里插入图片描述
代入R矩阵,得到:
在这里插入图片描述
因此,伪距速率测量模型最终可写为:
在这里插入图片描述
在这里插入图片描述

5.3 总体测量模型

将5.2提供的伪距误差和伪距速率误差的测量模型结合起来,可以得到整体测量模型为:
在这里插入图片描述
紧耦合集成实现的框图如图所示:
在这里插入图片描述

本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)

组合导航(八):INS/GPS组合导航 的相关文章

随机推荐

  • 【面试】C/C++面试宝典一

    1 const 修饰变量 xff0c 说明该变量不可以被改变 xff1b 修饰指针 xff0c 分为指向常量的指针 xff08 pointer to const xff09 和自身是常量的指针 xff08 常量指针 xff0c const
  • Docker安装Xfce桌面环境(轻量可视化操作系统)

    0 Xfce是什么 xff1f Xfce是一个适用于类UNIX操作系统的轻量级桌面环境 它的目标是快速而低廉的系统资源 xff0c 同时仍然具有视觉吸引力和用户友好性 具体参考官网 https www xfce org 项目地址 xff1a
  • Linux系统常用快捷键及VNC基本使用命令

    Linux系统常用快捷键及VNC基本使用命令 文章目录 Linux系统常用快捷键及VNC基本使用命令Linux系统的特点Linux树型目录结构Linux系统常用命令VNC常用命令 Linux系统的特点 多任务系统 在linux系统中可以同时
  • 【docker】docker学习(3)——Dockerfile的常用语法和编写实战

    大家好 xff0c 我是好学的小师弟 xff0c 今天和大家分享下Dockerfile的常用语法和编写实战 插曲 xff1a 在学习Dockerfile之前 xff0c 我们先讲解下docker save 和docker load 这两个命
  • 1.2 安装 docker 容器并配置镜像加速器

    1 2 1 实验环境准备 实验环境 xff1a CENTOS7 9 64 位 主机名 xff1a hou 主机 ip 10 0 8 120 xff08 这个 ip 大家可以根据自己所在环境去配置 xff0c 配置成静态 IP xff09 4
  • 弯管参数计算及编程实现

    船舶软件建立三维管道模型后 xff0c 需要自动生成管子加工信息 xff0c 这样就提高了设计效率 其中弯管参数主要是下料长度 xff0c 弯角和转角 下料长度是由各管段实长 xff0c 即管子中心线长度 xff0c 减去弯管部分切线长再加
  • 完整版数据库系统概论(第五版)-课后答案-免费网盘自提

    包含全部的课后答案与复习笔记 xff01 大家伙不挂科不被刷 xff0c 一起冲 xff01 虽然这个我也是找的别人的 xff0c 但是真的好用 xff01 百度网盘 https pan baidu com s 1Ux07PWvPb k3l
  • 踩坑笔记:安装Gazebo11

    安装环境 xff1a ubuntu18 04 在我上一篇博客中 xff0c 我们安装了ROS Melodic amp amp Ros2 Dashing 在我想要安装Gazebo11时候出现了错误 一 依赖错误 安装Gazebo11 xff1
  • 在keil5中调试串口遇到的问题

    1 问题 在keil5中调试stm32串口实验时 xff0c 向单片机的串口1发送数据 xff0c 观察串口1的寄存器 xff0c 此时串口1的中断服务函数会遇到无法进入下图if 的情况 xff0c 此时观察串口1寄存器 RXEN 的值 由
  • 树莓派在上电后一直重启进入不了系统桌面

    问题描述 树莓派在上电后一直重启进入不了系统桌面 xff0c 在检查了各种接口没问题后解决办法 原因分析与解决方案 xff1a 用了键盘 鼠标 显示器后5v 1A的插头不行 xff0c 换了ipad用的5V 2A的充电器后就可以开启了 xf
  • 树莓派连接“手机热点“或“WiFi“ 后无法上网,以及连接“手机热点“或“WiFi“时VNC连接失败问题

    问题描述 之前一直在开热点 xff0c 通过电脑端VNC控制树莓派拍摄照片 xff0c 今天突然发现树莓派上不去网 xff0c 所以就试着尝试解决了一下 xff0c 心路历程如下 xff1a 要么就是树莓派连不上网 xff0c 要么就是连上
  • 相机标定和双目相机标定标定原理推导及效果展示

    文章目录 前言一 相机标定1 相机的四个坐标系2 相机的畸变 二 张正友标定法1 求解内参矩阵与外参矩阵的积2 求解内参矩阵3 求解外参矩阵4 标定相机的畸变参数5 双目标定6 极线矫正 xff08 立体校正 xff09 三 视差图与深度图
  • keras:tensor从全连接层输出到卷积层

    一 tensor从卷积层输出到全连接层 用过keras的都知道 xff0c 想从卷积层输出tensor到全连接层 xff0c 只需加一层 xff1a model add Flatten shape就不会出现错误 二 但是如果从全连接层输出t
  • 保研面试复习之数据结构篇

    数据项 数据元素和数据结构的概念 数据项是组成数据元素的 xff0c 有独立含义的 xff0c 不可分割的最小单位 数据元素是数据的基本单位 数据结构是带结构的数据元素的集合 数据结构包括逻辑结构和存储结构两个层次 数据结构的三要素是逻辑结
  • 视觉里程计的重定位问题1——SVO的重定位部分

    SVO的重定位部分代码解析与分析 SVO的重定位功能体现在 xff1a 运动跟踪丢失后通过与上一关键帧匹配以及地图点投影 xff0c 找回当前相机位姿 由于没有后端和回环 xff0c SVO的重定位并不是回环校正后的重定位 代码部分被放在运
  • 组合导航(一):定位技术分类与介绍

    组合导航 xff08 一 xff09 xff1a 导航定位技术分类与介绍 一 定位技术分类1 1 基于相对测量的定位 xff08 航位推算 xff09 1 2 基于绝对测量的定位1 3 组合定位 一 定位技术分类 1 1 基于相对测量的定位
  • git bash可以正常commit,但是 VSCode 里不能正常commit使用的解决方法

    问题描述 同一路径下的源码 xff0c 使用git bash可以正常commit xff0c 但是使用vscode提交commit就会一直卡住 xff0c 转圈圈 参考方案链接 xff1a VS CODE GIT 500 问题处理 pudn
  • 组合导航(四):惯性导航系统

    1 惯性导航系统的物理平台2 惯性测量单元IMU3 惯性传感器的测量值3 1静止状态下的加速度测量3 2静止与运动状态下的角速度测量 4 惯性传感器误差4 1 系统误差 xff08 可通过实验进行校正 xff09 4 2 随机误差4 3 惯
  • 组合导航(七):卡尔曼滤波

    Kalman滤波1 离散卡尔曼滤波2 卡尔曼滤波的流程2 1 预测与时间更新2 2 测量更新与校正 3 卡尔曼滤波 算法步骤4 非线性卡尔曼滤波4 1 线性化kalman滤波4 2 扩展kalman滤波 5 卡尔曼滤波发散控制5 1 KF过
  • 组合导航(八):INS/GPS组合导航

    INS GPS组合导航1 误差反馈1 1 开环INS GPS架构1 2 闭环INS GPS架构 2 组合导航的类型2 1 松耦合 的INS GPS组合导航2 2 紧耦合 的INS GPS组合导航2 3 深度耦合的 INS GPS组合导航 3