【滤波跟踪】捷联惯导纯惯导解算matlab实现
1 简介
捷联式导航系统是惯性导航系统中的一种,它与平台式导航系统相比具有体积小、重量轻、成本低的特点,是今后惯性导航系统的发展方向。 本文首先介绍了捷联惯性导航系统(SINS)的导航原理,探讨了捷联惯性导航系统初始对准和导航解算的算法、飞行轨迹数据生成算法,然后利用MATLAB/Simulink仿真软件,对捷联惯导系统的导航工作过程进行了仿真计算。由于惯导系统导航参数的误差随着时间而积累,纯捷联惯导系统无法满足长时间、远距离的导航要求。实际中常采用GPS/SINS组合导航技术来提高系统的精度及可靠性,本文采用卡尔曼滤波方法对其进行了仿真研究。实验结果显示仿真系统工作稳定可靠,仿真结果达到预期效果。 初始对准是捷联惯导系统的关键技术之一,它直接影响捷联惯导系统的导航性能。考虑到低精度的捷联惯导系统,其陀螺精度较低,初始对准时方位失准角的估计精度往往不高;另外,进行初始对准的常用方法是采用卡尔曼滤波技术,但在实际应用时,其鲁棒性不高,因此迫切需要一种能够改善低精度捷联惯导系统方位失准角的估计精度且兼具鲁棒性的初始对准方法。
2 部分代码
function [Cbn]=QuaternionToDCM(qbn)
%姿态四元数转方向余弦矩阵
Cbn(1,1)=qbn(1)*qbn(1)+qbn(2)*qbn(2)-qbn(3)*qbn(3)-qbn(4)*qbn(4);
Cbn(1,2)=2*(qbn(2)*qbn(3)-qbn(1)*qbn(4));
Cbn(1,3)=2*(qbn(2)*qbn(4)+qbn(1)*qbn(3));
Cbn(2,1)=2*(qbn(2)*qbn(3)+qbn(1)*qbn(4));
Cbn(2,2)=qbn(1)*qbn(1)-qbn(2)*qbn(2)+qbn(3)*qbn(3)-qbn(4)*qbn(4);
Cbn(2,3)=2*(qbn(3)*qbn(4)-qbn(1)*qbn(2));
Cbn(3,1)=2*(qbn(2)*qbn(4)-qbn(1)*qbn(3));
Cbn(3,2)=2*(qbn(3)*qbn(4)+qbn(1)*qbn(2));
Cbn(3,3)=qbn(1)*qbn(1)-qbn(2)*qbn(2)-qbn(3)*qbn(3)+qbn(4)*qbn(4);
end
3 仿真结果
4 参考文献
[1]张燕. 捷联惯导系统的算法研究及其仿真实现. Diss. 大连理工大学, 2008.
博主简介:擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真,相关matlab代码问题可私信交流。
部分理论引用网络文献,若有侵权联系博主删除。
【滤波跟踪】捷联惯导纯惯导解算matlab实现相关推荐
- 低成本MEMS惯导系统的捷联惯导解算MATLAB仿真
低成本MEMS惯导系统的捷联惯导解算MATLAB仿真 一.姿态角转换为四元数 二.四元数转换为姿态角 三.反对称阵 四.位置更新 五.姿态更新 六.程序及数据 主程序: 子程序: 数据及完整程序 之前 ...
- 【滤波跟踪】基于matlab捷联惯导仿真【含Matlab源码 1935期】
⛄一.获取代码方式 获取代码方式1: 完整代码已上传我的资源:[滤波跟踪]基于matlab捷联惯导仿真[含Matlab源码 1935期] 点击上面蓝色字体,直接付费下载,即可. 获取代码方式2: 付费 ...
- 捷联惯导圆锥误差补偿--读书笔记
严恭敏,2013-11-11 ------------------ Savage P G. A new second-order solution for strapped-down attitude ...
- 捷联惯导总结--初始对准,位置标定,INS姿态更新,GPS/INS组合
惯导及组合导航回顾 2018.09.16 今天和17系的同学一起把惯导的流程捋了一遍,为了加深自己的记忆,这里在前面把心得大致列出来. 我们这里只考虑捷联式惯导及松组合 首先拿到惯性传感器(加速度计 ...
- 捷联惯导基础知识解析之五(低成本姿态航向参考系统)
陀螺仪精度0.1°/s:加速度计精度5mg:主要指零偏重复性! 一.简化的惯导算法 1.姿态更新 陀螺仪输出直接进行积分,得到角增量: 2.速度更新: 在导航系下,完整的速度微分方程,如下: 其中,在 ...
- 组合导航算法(一)之捷联惯导更新及组合模式
捷联惯导基本算法 惯性导航技术于20世纪50年代最初开始投入使用,可分为物理平台与模拟平台.物理平台就是平台式惯性导航系统(PINS).模拟平台又称捷联式惯性导航系统(SINS),它以计算机为平台,随 ...
- 基于matlab的捷联惯导算法设计及仿真,基于 Matlab 的捷联惯导算法设计及仿真1doc.doc...
基于 Matlab 的捷联惯导算法设计及仿真1doc 基于 Matlab 的捷联惯导算法设计及仿真1 严恭敏 西北工业大学航海学院,西安 (710072) E-mail:yangongmin@163. ...
- 捷联惯导算法--体会与心得
本文转自:http://www.amobbs.com/thread-5492189-1-1.html,收藏学习! 1.四个概念:"地理"坐标系."机体"坐标系. ...
- 【算法学习笔记001】捷联惯导算法心得
1.四个概念:"地理"坐标系."机体"坐标系.他们之间换算公式.换算公式用的系数. 地理坐标系:东.北.天,以下简称地理.在这个坐标系里有重力永远是(0,0,1 ...
- 捷联惯导知识点之非直角坐标系到直角坐标系
1.从非直角坐标系到直角坐标系的矩阵变换 2.以正交三角分解为例: 根据矩阵的 QR 分解理论,非奇异阵 Cba 总可以分解为单位正交阵 CbB和上三角阵CBa 之乘积的形式, 即 在偏差角为小量情形 ...
最新文章
- Android 获取手机系统信息
- First Unique Character in a String(字符串中的第一个唯一字符)
- 社交网站将推动手游发展
- 使用itextpdf操作pdf
- AUTOSAR从入门到精通100讲(十三)-autosar架构中的ASPICE模块
- 【WPF】WPF 命令
- memcached安装和使用
- Android热修复核心原理介绍
- 基础平台系列-1-第三方服务
- 【测试Demo】JavaAPI操作阿里云对象存储(OSS)
- 规则库捕获漏洞信息专用脚本
- LaTex---在图片或表格上方、下方添加字体
- HOW TO LEECH USING IRC
- python在哪里学比较好,python从哪里学起
- android平板电脑 微信,安卓微信重大更新,手机和平板可同时登录
- PARWAN处理器架构特点
- 里氏代换原则(The Liskov Substitution Principle)
- tensorflow--猫狗识别
- Layui hint: is not a valid module
- 在KEIL中生成bin文件的方法