电脑桌面
添加小米粒文库到电脑桌面
安装后可以在桌面快捷访问

kalman滤波matlab实现

kalman滤波matlab实现_第1页
1/8
kalman滤波matlab实现_第2页
2/8
kalman滤波matlab实现_第3页
3/8
function S = dosim(T, cda, cdm, cm, sr_scale, sq_scale, stq_C, stq_F, stq_S) global d2r r2d; d2r = pi/180.0; % constant to convert [degree] to [radian] r2d = 180.0/pi; % constant to convert [radian] to [degree] % temporal parameters stime = T.stime; % length of sim [second] mrate = T.mrate; % measurement rate [1/second] dt = 1/mrate; % water level limits L_min = T.L_min; % where start filling, etc. [meter] L_max = T.L_max; % full [meter] % Measurement device parameters global db df ka kl; db = T.db; % Base for angular sensor, just above the max water [meter] df = T.df; % Angular sensor arm w/ float, long enough to hit bottom on empty [meter] ka = T.ka; % Angular/non-linear float scale constant kl = T.kl; % Level/linear float parameters scale constant % Sloshing (sinusoidal) parameters sf = T.sf; % slosh/sin frequency [1/second] sp = T.sp; % slosh phase [degree] % measurement noise magnitudes srl_m = sr_scale*T.srl_m; % stdev of level/linear sensor noise [meter] sra_d = sr_scale*T.sra_d; % stdev of angule/non-linear sensor noise [degree] if (nargin == 6) % normal situation stq_C(1) = 5.9609e-05; % Tuned Constant w/ linear meas stq_C(2) = 3.5936e-05; % Tuned Constant w/ angular meas sq_C = mean(stq_C); % avg of the two stq_F(1) = 1.9638; % Tuned Filling w/ linear meas stq_F(2) = 2.027; % Tuned Filling w/ angular meas sq_F = mean(stq_F); % avg of the two stq_S(1) = 5.9609e-05; % Tuned Sloshing w/ linear meas stq_S(2) = 5.9609e-05; % Tuned Sloshing w/ angular meas sq_S = mean(stq_S); % avg of the two % special tune case for filling and sloshing if (cdm == 'FS') stq_F(1) = 0.0028009; % Tuned Filling w/ linear meas stq_F(2) = 0.0021271; % Tuned Filling w/ angular meas sq_F = mean(stq...

1、当您付费下载文档后,您只拥有了使用权限,并不意味着购买了版权,文档只能用于自身使用,不得用于其他商业用途(如 [转卖]进行直接盈利或[编辑后售卖]进行间接盈利)。
2、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。
3、如文档内容存在违规,或者侵犯商业秘密、侵犯著作权等,请点击“违规举报”。

碎片内容

kalman滤波matlab实现

确认删除?
VIP
微信客服
  • 扫码咨询
会员Q群
  • 会员专属群点击这里加入QQ群
客服邮箱
回到顶部