完善资料让更多小伙伴认识你,还能领取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大范围变化,很不正常,这究竟怎么回事呢? |
|
相关推荐 |
|
只有小组成员才能发言,加入小组>>
5305 浏览 0 评论
11532 浏览 9 评论
4664 浏览 1 评论
13946 浏览 0 评论
14250 浏览 0 评论
FRSE 2023 | 机器人与软件工程前沿国际会议诚征优秀稿件
2934浏览 0评论
哪位大哥有库卡KUKA.EtherNetIP MS(2.X版本)软件包?
4241浏览 0评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-8-22 07:41 , Processed in 0.369502 second(s), Total 44, Slave 38 queries .
Powered by 电子发烧友网
© 2015 www.ws-dc.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号