完善资料让更多小伙伴认识你,还能领取20积分哦, 立即完善>
我的一阶和二阶互补滤波公式是在网上找的
但是滤波后出来的角度不对 不知道是我公式用错了还是变量问题 求救 或者加我QQ*** 这是一阶,realVals[5]是陀螺仪角速度,fRoll是加速度计求出来的角度 float k=0.075; float a=k/(k+dt); float fNewRoll=a*(fNewRoll+realVals[5])+(1-a)*fRoll; 最后滤波后的角度完全和角速度计的角度对不上 这是二阶, float x1=(fRoll-fNewRoll)*k*k; //fRoll:根据加速度计算出来的角度 float y1=y1+x1*dt; float x2=y1+2*k*(fRoll-fNewRoll)+realVals[5]; fNewRoll=fNewRoll+x2*dt; |
|
相关推荐
1个回答
|
|
搞定了,我的fNewRoll声明放LOOP里面了,搬出去就好了,,,,囧
|
|
|
|
只有小组成员才能发言,加入小组>>
请问下图大疆lightbridge2遥控器主板电源芯片型号是什么?
4466 浏览 1 评论
使用常见的二极管、三极管和mos做MCU和模组的电平转换电路,但是模组和MCU无法正常通信,为什么?
342浏览 2评论
为了提高USIM卡电路的可靠性和稳定性,在电路设计中须注意的点有哪些?
344浏览 2评论
368浏览 2评论
362浏览 2评论
407浏览 2评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-12-21 22:55 , Processed in 0.781340 second(s), Total 49, Slave 42 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号