全文预览已结束
下载本文档
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
.扩展卡尔曼滤波算法作者, niewei120 , nuaaEKF 算法是在标准 Kalman 滤波算法的基础上发展起来的, 它的基本思想是: 在滤波值附近,应用泰勒展开算法将非线性系统展开, 对于二阶以上的高阶项全部都省去, 从而原系统就变成了一个线性系统,再利用标准Kalman 滤波算法的思想对系统线性化模型进行滤波。.滤波过程如下:其 matlab 程序如下:For t=1: N%预测更新mu_ekfPred(t) = feval('ffun',mu_ekf(t-1),t);%状态量的一步预测,ffun为状态方程PPred(t) = Q + Jx*P_ekf(t-1)*Jx'一步预测方差阵,Jx 为状态量的雅可比矩阵%修正阶段yPred(t) = feval('hfun',mu_ekfPred(t),t);%量测量的一步预测,hfun为量测方程.M = R + Jy*PPred(t)*Jy' %CkPkCk+Rk的误差反差计算,Jy 为量测量的雅可比矩阵K = PPred(t)*Jy'*inv(M); %卡尔曼滤波增益mu_ekf(t) = mu_ekfPred(t) + K*(y(t)-yPred(t);%状态估计量,y(t)为实际测量值。P_ekf(t) = PPred(t) -
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 沙子矿山转让合同模板
- 澄海租房合同模板
- 中学听评课实施方案
- 总合同与分项合同模板
- 健康技术咨询合同模板
- 中国腹腔镜吻合器行业分析报告:进出口贸易、行业现状、前景研究(智研咨询发布)
- 智研咨询发布:中国真空采血管行业市场现状、发展概况、未来前景分析报告
- 业务合伙合同模板
- 网络平台股转让合同模板
- 停车位产权转让合同模板
- 占用消防通道施工方案
- 酒店安全员岗位职责
- 中国石化加油卡办理委托书
- 四年级上册英语说课稿-Unit3 How many?Period3 Cartoon time-译林版
- 【急性肾衰竭患者的护理研究进展综述】
- 科技创新与农业现代化的协同发展
- 部编人教版初中《道德与法治》七年级上册《做更好的自己》说课稿课件
- 六年级下册数学试题-小升初应用题专项练习 人教新课标
- 大学生劳动教育通论智慧树知到答案章节测试2023年大连海洋大学
- 2023年全国自学考试物理工试题及其答案
- GB/T 6495.7-2006光伏器件第7部分:光伏器件测量过程中引起的光谱失配误差的计算
评论
0/150
提交评论