完善资料让更多小伙伴认识你,还能领取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大范围变化,很不正常,这究竟怎么回事呢? |
|
相关推荐 |
|
只有小组成员才能发言,加入小组>>
5498 浏览 0 评论
11759 浏览 9 评论
4859 浏览 1 评论
14115 浏览 0 评论
14399 浏览 0 评论
FRSE 2023 | 机器人与软件工程前沿国际会议诚征优秀稿件
3150浏览 0评论
哪位大哥有库卡KUKA.EtherNetIP MS(2.X版本)软件包?
4469浏览 0评论
如果设计一款桌面款的机器玩具,最吸引人的外观与功能要有哪些?
2498浏览 0评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-11-25 01:17 , Processed in 0.521387 second(s), Total 78, Slave 59 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号