作为无人机方面做嵌入式编写的飞控总结6--IMU惯性系统和GPS导航系统融合小结2(组合导航算法)
导:3.基本理论:组合导航定义,想说的都在文献之中...重点关注红色下划线处小结:惯性系统和GPS导航系统各有优缺点,但在误差传播性能上正好是互补的,前者长期稳定性差,但短期稳定性好,而后者正好相反;组合导航技术是指使用两种或两种以上的不同导航系统对同一信息源作测量,从这些测量值的比较值中提取出各系统的误差并校正之。采用组合导航技术的系统称为组合导航系统。参与组合豹各导航系统称为子系统。注意: 由
导:


3.基本理论:组合导航定义,想说的都在文献之中...重点关注红色下划线处
4.分类
5 方程分析
(1)组合导航的系统建立
首先需建立以惯导系统误差方程为基础的组合导航系统状态方程,并在组合导航系统误差方程的基础上建立组合导航系统的量测方程。采用卡尔曼滤波器为馁导系统误差提供最小方差估计,然后利用这些误差的估计值去修正惯导系统,以减少导航误差.同时,经过校正后的惯导系统又可以提供导航信息,以辅助GPS系统提高其性能和可靠性。

间接法,估计状态的误差,可以使滤波方程化为线性。其实,每个系统的真值在卡尔曼滤波器的观测量中已经被对消,此时系统方程和量测方程一般都是线性的,采用线性卡尔曼滤波器即可。
因此,只需建立GPS误差和惯导系统误差模型就可以了.而且间接法估计过程是与原系统无关的独立过程.对原系统来说,除了接受误差估计的校正外,也保持工作的独立性,这能发挥各个系统的特点。所以通常采用间接法方案。
误差方程为变系数微分方程,一般包括速度误差微分方程、经纬度误差微分方程以及三个平台误差角微分方程等。本文采取问接法实现卡尔曼滤波处理,取系统的误差作为状态。
(2)状态方程
1)INS的状态方程
位置误差方程

平台误差角方程

速度误差方程

2).GPS的误差状态方程
定常速度情况下的系统模型。GPS的误差状态类似于INS系统,选位置误差和速度误差作为状态变。


对于分布式组合,有两个卡尔曼滤波器分别处理INS和GPS的数据,两个滤波器的误差状态方程单独建立。对于全组合方式,只有一个卡尔曼滤波器,组合系统的误差状态方程除了有INS的15个状态变量,是否需要增加有关的误差状态变量,‘要根据被观测修正信息的选择来决定。
由于本文中选取位置、速度为观测信息,而GPS接收机的位置和速度误差一般是时间相关的,所以是有色噪声,建模困难,不能用状态扩充法加以处理,只能增加迭代周期。
综上所述组合导航系统中不增加GPS的状态变量。
===============枯燥理论的结束分割线====================================
6.代码和流程分析
基本思路:用GP$和惯导输出的位置和速度信息的差值作为量测值,经卡尔曼滤波,估计惯导系统的误差,然后对惯导系统进行校正。
1.扩展卡尔曼滤波 ~~~~
openvela 操作系统专为 AIoT 领域量身定制,以轻量化、标准兼容、安全性和高度可扩展性为核心特点。openvela 以其卓越的技术优势,已成为众多物联网设备和 AI 硬件的技术首选,涵盖了智能手表、运动手环、智能音箱、耳机、智能家居设备以及机器人等多个领域。
更多推荐



所有评论(0)