搜索
bottom↓
回复: 6

互补滤波中,不懂加表测姿态角与陀螺积分姿态角之间的...

[复制链接]

出0入0汤圆

发表于 2016-7-24 21:08:52 | 显示全部楼层 |阅读模式
程序中,该部分误差是通过陀螺测得角速度,不断计算当前四元数,然后表示成余弦矩阵,得到陀螺姿态角下的机体系中的重力单位向量表示a,加表测得当前的加速度向量在机体下的向量表示b,然后a与b叉乘,得到两种方式的姿态角误差?
请问
1.为啥这样叉乘得到的就是姿态角误差?
2.a与b叉乘后三个向量元素对应的是哪三个姿态角的误差?

阿莫论坛20周年了!感谢大家的支持与爱护!!

一只鸟敢站在脆弱的枝条上歇脚,它依仗的不是枝条不会断,而是自己有翅膀,会飞。

出0入0汤圆

发表于 2016-7-25 09:47:36 | 显示全部楼层
1.可以了解叉乘定义就知道为什么是误差了
2.这得看你是怎么叉乘的

出0入0汤圆

 楼主| 发表于 2016-7-26 18:07:59 | 显示全部楼层
wkllq1314 发表于 2016-7-25 09:47
1.可以了解叉乘定义就知道为什么是误差了
2.这得看你是怎么叉乘的

大概明白了一些,加速度计测量的重力向量a被单位化了,陀螺测量的体坐标系下的重力向量b也被单位化了,a叉乘b的模,为a模乘b模乘sin(theta),theta是向量a,b之间的夹角。结果是一个向量,其模为sin(theta)值,theta较小时,叉积约等于theta值。
所以叉积结果的模就是向量a和b的角度偏量。
在这里,隐含了一个条件就是在计算的时候把陀螺测量的体坐标系与加速度计的体坐标系重合了,如果两者实际上的坐标系重合,那么重力向量也重合,叉乘结果为零。如果两个坐标系有角偏差,那么人为将坐标系重合后表示出来的重力向量的角偏差大小与坐标系角偏差一致。
但是理解了向量叉积的模反映了角偏差量,还是不太理解叉积结果向量含有三个元素,做imu_update,时候,三个元素分别放大或者积分后去跟陀螺仪的三个角速度去做和,这三个元素为什么这么对应还不是太了解。请大神指点

出0入0汤圆

发表于 2016-7-27 00:16:28 | 显示全部楼层
X Y方向的差乘补偿到Z轴  XZ方向的差乘补偿到Y轴 YZ方向的差乘补偿到 X轴

出0入0汤圆

发表于 2016-7-27 00:17:22 | 显示全部楼层
还有请问下 为什么我的pitch角度 最大值只有85度啊 而且接近85度的时候 ROLL变化非常快 你们有遇到这个问题吗

出0入0汤圆

 楼主| 发表于 2016-7-27 10:42:35 | 显示全部楼层
chuck__chee 发表于 2016-7-27 00:16
X Y方向的差乘补偿到Z轴  XZ方向的差乘补偿到Y轴 YZ方向的差乘补偿到 X轴

ok,昨天画了画图,对的是这样,谢谢! 刚入门,还在探索,碰到您这个问题再跟您讨论!

出0入0汤圆

发表于 2016-7-27 11:40:39 | 显示全部楼层
恩恩,我现在都不想输出欧拉角了,直接看四元数得了
回帖提示: 反政府言论将被立即封锁ID 在按“提交”前,请自问一下:我这样表达会给举报吗,会给自己惹麻烦吗? 另外:尽量不要使用Mark、顶等没有意义的回复。不得大量使用大字体和彩色字。【本论坛不允许直接上传手机拍摄图片,浪费大家下载带宽和论坛服务器空间,请压缩后(图片小于1兆)才上传。压缩方法可以在微信里面发给自己(不要勾选“原图),然后下载,就能得到压缩后的图片】。另外,手机版只能上传图片,要上传附件需要切换到电脑版(不需要使用电脑,手机上切换到电脑版就行,页面底部)。
您需要登录后才可以回帖 登录 | 注册

本版积分规则

手机版|Archiver|amobbs.com 阿莫电子技术论坛 ( 粤ICP备2022115958号, 版权所有:东莞阿莫电子贸易商行 创办于2004年 (公安交互式论坛备案:44190002001997 ) )

GMT+8, 2024-3-29 06:10

© Since 2004 www.amobbs.com, 原www.ourdev.cn, 原www.ouravr.com

快速回复 返回顶部 返回列表