完善资料让更多小伙伴认识你,还能领取20积分哦, 立即完善>
近来搞姿态发现这样的问题希望有大神解答下:
gx-=gyo_offset[0]; gy-=gyo_offset[1]; gz-=gyo_offset[2]; gx*=sampletime; gy*=sampletime; gz*=sampletime; q0+=0.5*(-q1*gx-q2*gy-q3*gz); q1+=0.5*(q0*gx+q2*gz-q3*gy); q2+=0.5*(q0*gy-q1*gz+q3*gx); q3+=0.5*(q0*gz+q1*gy-q2*gx); recipNorm = invSqrt(q0*q0 + q1*q1 + q2*q2 + q3*q3); q0 = q0 * recipNorm; q1 = q1 * recipNorm; q2 = q2 * recipNorm; q3 = q3 * recipNorm; 我参考网上广泛流传的微分四元数IMU程序,想单纯用陀螺仪来解算姿态,当静止时,gx、gy、gz减去偏差后输出值很小,四元数q0不应该变化很小在0.8~0.9的范围吗?但是q0变化很大,从-0.9~+0.9的变化。。。 在程序中读俯仰角q_1=2 * q1 * q3 - 2 * q0 * q2;静止时它是从-0.9~+0.9大范围变化,很不正常,这究竟怎么回事呢? |
|
相关推荐
1个回答
|
|
帮顶.....
|
|
|
|
只有小组成员才能发言,加入小组>>
请问下图大疆lightbridge2遥控器主板电源芯片型号是什么?
4467 浏览 1 评论
使用常见的二极管、三极管和mos做MCU和模组的电平转换电路,但是模组和MCU无法正常通信,为什么?
342浏览 2评论
为了提高USIM卡电路的可靠性和稳定性,在电路设计中须注意的点有哪些?
345浏览 2评论
369浏览 2评论
363浏览 2评论
407浏览 2评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-12-22 15:46 , Processed in 0.978780 second(s), Total 76, Slave 59 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号