[问答]

MPU6050卡尔曼滤波C语言实现函数参数是哈意思？

4919 C语言

问答对人有帮助，内容完整，我也想知道答案 0 以下是实现的函数，但是n,m,k,f,q,r,h,y,x,p,g 这些参数是什么，哪位大神给讲讲 #include "stdlib.h" #include "rinv.c" int lman(n,m,k,f,q,r,h,y,x,p,g) //int n,m,k; //double f[],q[],r[],h[],y[],x[],p[],g[]; { int i,j,kk,ii,l,jj,js; double e,a,b; e=malloc(mmsizeof(double)); l=m; if (l l=n; a=malloc(llsizeof(double)); b=malloc(llsizeof(double)); for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { ii=il+j; a[ii]=0.0; for (kk=0; kk<=n-1; kk++) a[ii]=a[ii]+p[in+kk]f[jn+kk]; } for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { ii=in+j; p[ii]=q[ii]; for (kk=0; kk<=n-1; kk++) p[ii]=p[ii]+f[in+kk]a[kkl+j]; } for (ii=2; ii<=k; ii++) { for (i=0; i<=n-1; i++) for (j=0; j<=m-1; j++) { jj=il+j; a[jj]=0.0; for (kk=0; kk<=n-1; kk++) a[jj]=a[jj]+p[in+kk]h[jn+kk]; } for (i=0; i<=m-1; i++) for (j=0; j<=m-1; j++) { jj=im+j; e[jj]=r[jj]; for (kk=0; kk<=n-1; kk++) e[jj]=e[jj]+h[in+kk]a[kkl+j]; } js=rinv(e,m); if (js==0) { free(e); free(a); free(b); return(js); } for (i=0; i<=n-1; i++) for (j=0; j<=m-1; j++) { jj=im+j; g[jj]=0.0; for (kk=0; kk<=m-1; kk++) g[jj]=g[jj]+a[il+kk]e[jm+kk]; } for (i=0; i<=n-1; i++) { jj=(ii-1)n+i; x[jj]=0.0; for (j=0; j<=n-1; j++) x[jj]=x[jj]+f[in+j]x[(ii-2)n+j]; } for (i=0; i<=m-1; i++) { jj=il; b[jj]=y[(ii-1)m+i]; for (j=0; j<=n-1; j++) b[jj]=b[jj]-h[in+j]x[(ii-1)n+j]; } for (i=0; i<=n-1; i++) { jj=(ii-1)n+i; for (j=0; j<=m-1; j++) x[jj]=x[jj]+g[im+j]b[jl]; } if (ii { for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { jj=il+j; a[jj]=0.0; for (kk=0; kk<=m-1; kk++) a[jj]=a[jj]-g[im+kk]h[kkn+j]; if (i==j) a[jj]=1.0+a[jj]; } for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { jj=il+j; b[jj]=0.0; for (kk=0; kk<=n-1; kk++) b[jj]=b[jj]+a[il+kk]p[kkn+j]; } for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { jj=il+j; a[jj]=0.0; for (kk=0; kk<=n-1; kk++) a[jj]=a[jj]+b[il+kk]f[jn+kk]; } for (i=0; i<=n-1; i++) for (j=0; j<=n-1; j++) { jj=in+j; p[jj]=q[jj]; for (kk=0; kk<=n-1; kk++) p[jj]=p[jj]+f[in+kk]a[jl+kk]; } } } free(e); free(a); free(b); return(js); } 0 已退回5积分
2015-12-24 17:25:18　　评论淘帖0 邀请回答您可以邀请以下用户，快速回答问题 × richthoffen 该类别下有 182 个回答。邀请回答 7vyydyfwef 该类别下有 57 个回答。邀请回答我是卖报的小男孩该类别下有 32 个回答，其中被选为最佳答案 1 次。邀请回答 chenbingjy 该类别下有 31 个回答。邀请回答谦谦三君子该类别下有 27 个回答。邀请回答短短该类别下有 25 个回答。邀请回答 dingyang598 该类别下有 22 个回答，其中被选为最佳答案 1 次。邀请回答 nvuuweew 该类别下有 22 个回答。邀请回答 YY599566 该类别下有 22 个回答。邀请回答 h1654155957.9572 该类别下有 19 个回答。邀请回答 hapyy 该类别下有 19 个回答。邀请回答 60user16 该类别下有 19 个回答。邀请回答 HEHELA 该类别下有 18 个回答。邀请回答 DerSohn 该类别下有 18 个回答。邀请回答 huhu12 该类别下有 18 个回答。邀请回答 dull20112011 该类别下有 15 个回答。邀请回答天地直方该类别下有 15 个回答。邀请回答 csz9981 该类别下有 15 个回答。邀请回答陈军该类别下有 15 个回答。邀请回答 sfafa 该类别下有 14 个回答。邀请回答举报 dream397942797 相关推荐 • 如何去实现一种基于MPU6050及卡尔曼滤波的平衡小车呢 1395 • 关于卡尔曼滤波的问题。（八百里加急般的急） 5574 • MPU6050模块自己写卡尔曼滤波和姿态解算难吗？ 7342 • 请问MPU6050能将数据耦合成一个物体的振动波形吗？ 3237 • 请问大四轴倾角滤波用卡尔曼和二阶互补哪个好？ 1325 • 在进行卡尔曼滤时程序老是显示Target not created 3519 • 什么是卡尔曼滤波？具有哪些参数？ 1738 • mpu6050数据处理 3302 • 关于mpu6050问题 1292 • 为什么我的mpu6050读数有时候读不出？还有对角速度进行积分算出的角度不是有很大缺陷吗？ 5866 1个回答