完善资料让更多小伙伴认识你,还能领取20积分哦, 立即完善>
estimator.accZ = accZRemovalDead;
estimator.accZ -= 0.02f * errorZ * weight * weight * dt; /*补偿加速度*/ /*位置和速度估测*/ estimator.positonZ += estimator.velocityZ * dt + estimator.accZ * dt * dt / 2.0f; estimator.velocityZ += estimator.accZ * dt; /*高度误差*/ errorZ = fusedHeight - estimator.positonZ; 以上是原子四轴V1.2版本中的程序,errorZ 为实际高度-估算高度,如果errorZ>0,则说明估算高度偏小,由估算高度的计算公式可知:estimator.positonZ += estimator.velocityZ * dt + estimator.accZ * dt * dt / 2.0f;是估算加速度偏小造成的,所以补偿加速度应该让估算的加速度值变大一点,而补偿加速度的公式为estimator.accZ -= 0.02f * errorZ * weight * weight * dt;这样计算不是会让估算加速度的值更小吗?是我哪里理解错了呢?请教各位大佬 |
|
相关推荐
2个回答
|
|
帮顶!
|
|
|
|
注意 estimator.positonZ += estimator.velocityZ * dt + estimator.accZ * dt * dt / 2.0f; 是 estimator.positonZ +=,是一个增量, 而不是 estimator.positonZ =简单赋值
|
|
|
|
只有小组成员才能发言,加入小组>>
请问下图大疆lightbridge2遥控器主板电源芯片型号是什么?
4449 浏览 1 评论
使用常见的二极管、三极管和mos做MCU和模组的电平转换电路,但是模组和MCU无法正常通信,为什么?
326浏览 2评论
为了提高USIM卡电路的可靠性和稳定性,在电路设计中须注意的点有哪些?
318浏览 2评论
334浏览 2评论
338浏览 2评论
374浏览 2评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-12-2 16:18 , Processed in 0.928356 second(s), Total 81, Slave 64 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号