matlab 状态估计,基于_当前_统计模型的目标状态估计MATLAB 实现
% 基于_当前_统计模型的目标状态估计
% 主要靠 kalman滤波实现对物体运动轨迹的估计
%已知运动状态
%初始速度
600 1.匀速10s 2.加速度5,持续10s 3. 匀速5s
%采样周期 1s
% 程序代写&算法设计,联系qq:380238062,转载时请保留
clc
clear
close all
jiasudu=5;%加速度
R1=40; %观测噪声方差
R2=50;
V1=normrnd(0,R1,[25 1]); % A 观测噪声,服从高斯分布,零均值,方差为R1
V2=normrnd(0,R2,[25,1]);
for i=1:25
if
i<=10 %匀速
X(1,i)=600*i; %位置
X(2,i)=600; %速度
X(3,i)=0; %加速度
elseif
i<=20 %匀加速
X(1,i)=6000+600*(i-10)+0.5*jiasudu*(i-10)^2;
X(2,i)=600+jiasudu*(i-10);
X(3,i)=jiasudu;
else
%匀速
X(1,i)=14500+650*(i-20);
X(2,i)=650;
X(3,i)=0;
end
end
[weizhi1,P_P1,X_X1]=kalman_f(X,R1,V1,jiasudu); % kalman滤波
[weizhi2,P_P2,X_X2]=kalman_f(X,R2,V2,jiasudu);
for k=1:25
P1=P_P1{k};
P2=P_P2{k};
X1=X_X1{k};
X2=X_X2{k};
X_zuiyou(:,k)=pinv(P1+P2)*(P2*X1+P1*X2);
%最优加权估计 end
% 程序代写&算法设计,联系qq:380238062,转载时请保留
error1=X(1,:)'-weizhi1';%估计误差
error2=X(1,:)'-weizhi2';
error3=X(1,:)'-X_zuiyou(1,:)';
figure;
plot(error1);
hold on
plot(error2);
plot(error3,':');
text(3,2000,'最优加权误差 - - - - - - - - - - - - - -')
title('估计误差');
function [weizhi,P_P,X_X]=kalman_f(X,R1,V1,jiasudu);
% kalman滤波算法的实现
% 程序代写&算法设计,联系qq:380238062,转载时请保留
a=1/60;
fai=[1 1 (-1+a+exp(a))/(a^2);0 1 (1-exp(-a))/a;0 0
exp(-a)]; % Φ
U=[(-1+a/2+(1-exp(-a))/a)/a 1-(1-exp(-a))/a 1-exp(-a)]';
H=[1 0 0];
I=ones(3,3);
q11=(1-exp(-2*a)+2*a+2*(a^3)/3-2*(a^2)-4*a*exp(-a))/(2*a^5);
q12=(1+exp(-2*a)-2*exp(-a)+2*a*exp(-a)-2*a+a^2)/(2*a^4);
q13=(1-exp(-2*a)-2*a*exp(-a))/(2*a^3);
q22=(4*exp(-a)-3-exp(-2*a)+2*a)/(2*a^3);
q23=(exp(-2*a)+1-2*exp(-a))/(2*a^3);
q33=(1-exp(-2*a))/(2*a);
Q=[q11 q12 q13;
q12 q22
q23;
q13 q23
q33];
X0=[0 600 0]';
P0=1; %初始值
for k=1:25
if
i<=10
a_k=0;
elseif
i<=20
a_k=jiasudu;
else
a_k=0;
end
a_mean=X(1,k)/(k*k); %"当前"平均加速度
if
a_mean==0
sigma_a=1;
else
sigma_a=(4-pi)*(a_mean^2)/2;%“当前”加速度方差
end
Q=2*a*sigma_a*Q;
x_k_k_1=fai*X0+U*a_k;
p_k_k_1=fai*P0*(fai')+Q;
k_k=p_k_k_1*H'/(H*p_k_k_1*H'+R1);
y_k=H*X(:,k)+V1(k);
x_k_k=x_k_k_1+k_k*(y_k-H*x_k_k_1);
p_k_k=(I-k_k*H)*p_k_k_1;
X0=x_k_k;
P0=p_k_k;
P_P{k}=P0;
X_X{k}=x_k_k_1;
weizhi(k)=x_k_k_1(1);
end
matlab 状态估计,基于_当前_统计模型的目标状态估计MATLAB 实现相关推荐
- 两电平变流器matlab仿真,基于H桥级联型五电平逆变器Matlab仿真分析.doc
基于H桥级联型五电平逆变器Matlab仿真分析 基于H桥级联型五电平逆变器Matlab仿真分析 [摘 要]多电平逆变器广泛应用于电机调速等领域,本文在分析级联型逆变器的基础上,深入分析了SPWM控制技 ...
- 【优化求解】基于无序灰狼算法求解多目标问题matlab代码
1 简介 Mirjalili 等人提出了一种新的群体智能算法---灰狼优化算法(GWO),并通过多个基准测试函数进行测试,从结果上验证了该算法的可行性,通过对比,GWO 算法已被证明在算法对函数求解精 ...
- matlab计算空间桁架,基于MATLAB的三维桁架有限元分析_宋志安.pdf
基于MATLAB的三维桁架有限元分析_宋志安 DOI :10.16452/j.cnki .s kjzk.2010.03.002 29 3 Vol.29 No.3 Journal of Shandong ...
- 基于matlab的脑瘤mr图像处理_基于Matlab GUI的医学图像处理课程虚拟实验平台设计...
论文写作指导:请加QQ229366758 摘 要:针对医学生工程技术缺乏的状况,分析医学生学习医学图像处理存在的困难,提出利用Matlab图像处理工具和简单的GUI界面,设计和构建包含医学图像处理教学 ...
- 将数学模型用matlab,matlab课件第3章_控制系统的数学模型及其转换.ppt
matlab课件第3章_控制系统的数学模型及其转换 3.1.1 传递函数 传递函数输入举例 3.1.2 零极点增益形式 3)零极点增益模型: 3.1.3 部分分式形式 2.1.4 状态空间表达式 3. ...
- 程序阅读_全面详解LTE:MATLAB建模仿真与实现_自学笔记(1)调制与编码_程序阅读
程序阅读_全面详解LTE:MATLAB建模仿真与实现_自学笔记(1)调制与编码_程序阅读 在粗浅地掌握了LTE知识后,从今天开始对<全面详解LTE:MATLAB建模仿真与实现>一书的学习. ...
- 基于OpenGL的雷达P显的系统设计与仿真 PPI_雷达仿真_雷达模拟器_雷达目标_雷达ppi_PPI显示器_源码
基于OpenGL 开发的雷达P显 可以设置各种参数 源码下载链接 PPI_雷达仿真_雷达模拟器_雷达目标_雷达ppi_PPI显示器_源码-C++文档类资源-CSDN下载
- matlab stem 属性,matlab中stem函数用法_常见问题解析
matlab中如何自定义图例_常见问题解析 matlab中自定义图例的方法:首先打开matlab软件:然后点击勾选按钮,新建一个文件并输入代码为"x = 0:pi/50:2*pi;" ...
- stem什么意思matlab,matlab中stem函数用法_常见问题解析,matlab
matlab中如何自定义图例_常见问题解析 matlab中自定义图例的方法:首先打开matlab软件:然后点击勾选按钮,新建一个文件并输入代码为"x = 0:pi/50:2*pi;" ...
最新文章
- 测试ESP32S基本模块的功能,并验证是否可以应用在AI智能车竞赛检测激光信号中
- golang中的strings.IndexAny
- Dubbo的核心玩法三
- 来聊一聊Cookie(小甜饼),及其涉及到的web安全吧
- matlab火箭升空问题,困扰火箭的三大问题终于要解决了!球迷:我都要膨胀了!...
- python 中的三元表达式(三目运算符)
- wangeditor修改图片上传和视频上传
- set java底层实现_Java:List,Map,Set底层实现
- the difference between a material and an effect
- 12.Linux 高性能服务器编程 --- 高性能 IO 框架库 Libevent
- python足球数据分析_我用Python对科比NBA生涯进行了一个数据分析
- Keil5的安装破解,包含MDK-ARM和C51
- oracle 7天密码过期,oracle密码过期ORA-28002: 7天之后口令将过期的解决方法
- HTML网易云音乐首页动画,仿网易云音乐广告页的转场动画
- 图像处理-灰度图像转化为伪彩图像
- 【寒江雪】LookRotation详解
- 计算机无法启动怎么重装系统,电脑无法启动系统怎么重装
- 汽车维修企业管理【12】
- Java 试试多线程
- 2021年小目标检测最新研究综述 很全面值得收藏
热门文章
- c语言330转化成字符,c/字符串,字符转数字,数字转字符(转)
- PHP中利用header设置content-type和常见文件类型的content-type
- css hot loader,解决安装react-hot-loader后修改css/less文件不会热更新问题
- android捕获线程异常,android - 终结器引发的未捕获的异常:所有WebView方法必须在同一线程上调用。 (预期的Looper) - 堆栈内存溢出...
- pb mysql odbc_PB 连接Mysql ODBC/JDBC
- mysql性能优化:my.cnf配置文件
- python累积和_python – 如何维持累积总和?
- bios文件查看工具_何必花钱升级显卡!AMD鸡血BIOS杀到
- pyqt 把控制台信息显示到_内网渗透初识—信息收集
- phpstorm遍历PHP数组,使用PHPStorm对齐数组的键值对