- 1、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。。
- 2、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 3、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
- 4、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
- 5、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们。
- 6、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 7、VIP文档为合作方或网友上传,每下载1次, 网站将根据用户上传文档的质量评分、类型等,对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
查看更多
无迹卡尔曼滤波波器程序
clc; close all; clear all; format long g; Xo [1; 0; 0; 0; 0; 0; 0; 0; 0; 0]; nx length Xo ; beta 2; elfa 1* 10^-1 ; lambda elfa^2 * nx - nx ; mn1 mean Xo ; %FIRST STEP CV1 Xo-mn1 * Xo-mn1 ; %CV1 Xo * Xo ; PO CV1; FX size CV1 ; VTt [1 0 0 0 0 0 0 0 0 0]; ADP1 randn 1,200 ; mn2 mean VTt ; NTt [1 0 0 0 0 0 0 0 0 0]; ADP2 randn 1,200 ; mn3 mean NTt ; Qo VTt-mn2 * VTt-mn2 ; Ro NTt-mn3 * NTt-mn3 ; %Qo VTt * VTt ; %Ro NTt * NTt ; FX zeros 10,10 ; PAO [PO FX FX; FX Qo FX;FX FX Ro]; Xao [mn1 0 0]; lam sqrt elfa^2 * nx ; Wmo lambda/ nx+lambda ; Wmi 1/ 2* nx+lambda ; Wmin 1/ 2* nx+lambda ; Wco lambda/ nx+lambda + 1- elfa^2 + beta ; Wci Wmi; Wcin Wmin; %CALCULATION OF SIGMA POINTS [Sg11,Sg12,Sg13,Sg21,Sg22,Sg23,Sg31,Sg32,Sg33] sigmacal mn1,CV1,mn2,Qo,mn3,Ro,lam ; %TIME UPDATE EQUATIONS. [Xinew1,Xinew2,Xinew3,Yinew1,Yinew2,Yinew3,Xbark,Ybark,Pbark] TMUPDT Wmo,Wmi,Wmin,Wco,Wci,Wcin,Sg11,Sg12,Sg13,Sg21,Sg22,Sg23,Sg31,Sg32,Sg33 ; %MEASUREMENT UPDATE EQUATIONS. [KGain,XNEW,PT1,PT2,PT3] MSMTUPDT Xinew1,Xinew2,Xinew3,Yinew1,Yinew2,Yinew3,Xbark,Ybark,Pbark,Wco,Wci,Wcin,Xo,VTt ; for ii 1:1:100 VTt [ADP1 ii+1 0 0 0 0 0 0 0 0 0]; NTt [ADP2 ii+1 0 0 0 0 0 0 0 0 0]; %CV1 XNEW * XNEW ; mn1 mean XNEW ; mn2 mean VTt ; mn3 mean NTt ; % Qo VTt * VTt ; % Ro NTt * NTt ; CV1 XNEW-mn1 * XNEW-mn1 ; Qo VTt-mn2 * VTt-mn2 ; Ro NTt-mn3 * NTt-mn3 ; lam sqrt elfa^2 * nx ; [Sg11,Sg12,Sg13,Sg21,Sg22,Sg23,Sg31,Sg32,Sg33] sigmacal mn1,CV1,mn2,Qo,mn3,Ro,lam ; [Xinew1,Xinew2,Xinew3,Yinew1,Yinew2,Yinew3,Xbark,Ybark,Pbark] TMUPDT Wmo,Wmi,Wmin,Wco,Wci,Wcin,Sg11,Sg12,Sg13,Sg21,Sg22,Sg23,Sg31,Sg32,Sg33 ; [KGain,XNEW,PT1,PT2,PT3,YNEW] MSMTUPDT Xinew1,Xinew2,Xinew3,Yinew1,Yinew2,Yinew3,Xbark,Ybark,Pbark,Wco,Wci,Wcin,XNEW,VTt ; INP1 ii XNEW 1,1 ; INP2 ii YNEW 1,1 ; end T 1:1:100; figure 1 ; subplot 211 ; plot real INP1 ; title ORIGINAL SIGNAL ; subplot 212 ; plot real INP2 ; title
文档评论(0)