多旋翼无人机组合导航系统-多源信息融合算法附Matlab代码

✅作者简介：热爱科研的Matlab仿真开发者，修心和技术同步精进，matlab项目合作可私信。

🍎个人主页：Matlab科研工作室

🍊个人信条：格物致知。

更多Matlab仿真内容点击👇

智能优化算法  神经网络预测 雷达通信  无线传感器

信号处理 图像处理 路径规划 元胞自动机 无人机  电力系统

⛄ 内容介绍

ITS(智能交通系统)是一个开放的复杂巨系统,是新兴的交叉学科研究领域。ITS是将先进的信息处理技术、数据通信技术、电子控制技术以及计算机处理技术等有效的综合运用于整个运输管理体系,从而建立起大范围内、全方位发挥作用的实时、准确、高效的管理运输系统。而车辆导航系统时ITS应用研究的一个主要方面,是集定位系统、地理信息系统、数据库查询系统、数字蜂窝通讯技术等于一体的综合系统。近年来,如何使GPS定位技术与INS惯性导航系统更好的结合起来已经成为车辆导航系统研究中的一个重要内容。本文首先介绍了GPS定位的基本原理。然后重点研究的内容是通过信息融合,使得在定位卫星信号接收差的场合工作更可靠。在GPS/INS组合导航系统中利用卡尔曼滤波去估计系统的各种状态,并用状态的估计值去校正系统。卡尔曼滤波算法的基本思想是:采用信号与噪声的状态空间模型,利用前一时刻的估计值和现在时刻的观测值来更新对状态变量的估计,求现在时刻的估计值。它是一种递推估计算法,通过处理一系列带有误差的实际测量数据而得到的物理参数的最佳估算。最大的特点是能够剔除随机干扰噪声,从而获取逼近真实情况的有用信息。

⛄ 部分代码

function [ qbn ] = rv2q( rv )

% 名称：Rotation Vector to Quaternion

% 功能：将等效旋转矢量转化为姿态四元数

%

% Inputs:

%        rv: 3×1 vector, 其模表示转动角度的大小，rv/norm(rv) 为转动轴在两个

%            坐标系下的坐标。 

% Outputs:

%       qbn: rn = qbn*rb*qbn

nm2 = rv'*rv ;

if nm2 < 1e-8       % 如果模方很小，可以用泰勒级数展开求前几项三角函数

    q0 = 1 - nm2*(1/8 - nm2/384);

    s = 1/2 - nm2*(1/48 - nm2/3840);

else

    nm = sqrt(nm2);

    q0 = cos(nm/2);

    s = sin(nm/2)/nm;

end

qbn = [q0, s*rv']';

end

⛄ 运行结果

⛄ 参考文献

[1]张欣. 多旋翼无人机的姿态与导航信息融合算法研究[D]. 中国科学院大学.

⛄ Matlab代码关注

❤️部分理论引用网络文献，若有侵权联系博主删除

❤️ 关注我领取海量matlab电子书和数学建模资料