资源简介
不要写EKF代码，只要输入系统方程和量测方程即可滤波
代码片段和文件信息
function [x_kP_k]=ekf_rn（fxPhzQR）
% EKF Extended Kalman Filter for nonlinear dynamic systems
% [x P] = ekf（fxPhzQR） returns state estimate x and state covariance P
% for nonlinear dynamic system:
% x_k+1 = f（x_k） + w_k
% z_k = h（x_k） + v_k
% where w ~ N（0Q） meaning w is gaussian noise with covariance Q
% v ~ N（0R） meaning v is gaussian noise with covariance R
% Inputs: f: function handle for f（x）
% x: “a priori“ state estimate
% P: “a priori“ estimated state covariance
% h: fanction handle for h（x）
% z: current measurement
% - 上一篇：手写数字识别matlab实现（原代码）
- 下一篇：Matlab粗糙表面数字仿真
川公网安备 51152502000135号
评论
共有 条评论