Advertisement

扩展卡尔曼滤波器(EKF)

阅读量:

首先执行** 文档下载**

认真研读相关文件,深入领会其中阐述的各项内容。

针对文档中所附的matlab代码,我对其中的部分内容进行了简易的修改,具体如下:

复制代码
  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

    
  %日 期: 	2015.10.12
    
  %程序功能:	使用扩展卡尔曼滤波器(EKF)估计平抛物体的运动
    
  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
    
 kx = .01; ky = .05; 	% 阻尼系数
    
     g = 9.8; 		% 重力
    
     t = 10; 		% 仿真时间
    
     Ts = 0.1; 		% 采样周期
    
     len = fix(t/Ts);    % 仿真步数
    
 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
    
     %(真实轨

全部评论 (0)

还没有任何评论哟~