本文主要是介绍协同导航的MATLAB程序,采用EKF作为滤波算法,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!
背景
单领航者,跟踪者对领航者进行测距
基于移动向量的协同定位
系统逻辑
两个节点,一个有GNSS和INS,是经典的导航,作为领航者。另一个节点为跟踪者,仅有INS,同时可以测量与领航者之间的距离。
使用协同导航的思想,对跟踪者试试确定位置。
滤波方法使用扩展卡尔曼滤波EKF。
程序源码
% 单领航者 仅测距,基于移动向量(Moving Radius Vector,MRV)的协同定位
% author:Evand
% 作者联系方式:evandjiang@qq.com(除前期达成一致外,付费咨询)
% date: 2024-3-4
% Ver2,添加轨迹
clear;clc;close all;
T = 0.1; %采样率
这篇关于协同导航的MATLAB程序,采用EKF作为滤波算法的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!