|
原帖由 md35 于 2011-3-18 12:48 发表 
固定翼的陀螺算法必须是四元数算法,这个和四轴还不一样。否则搞不成。还是红外的简单。
如果不是标准的AHRS算法的话,我建议你还是算了。这些路我都走过了!呵呵
倒也没这么死板吧,我就没用四元数法,依然用的欧拉角表达的,而且也没有欧拉矩阵方程,纯三角函数推算出的公式,相对精度照样达到了0.1度
不过这个东西的确难啊!难如登天的感觉,各个变量的三维同时旋转,还要同时用加速度计来修正。我是想啊想啊想了足足一个礼拜,白天黑夜的想,脑袋都想爆了,才把公式弄对。这东西很难检验的原因在于,三维旋转的3个轴是联动的,公式对不对,很难调试的,任何一轴的错误,都将导致其他轴计算出错。开始无论如何输出结果都不对,全乱套的,反复检查之后,修改了一个变量的正负号,突然间三个轴计算都全对了,那种如释重负的感觉哎~~~OSD系统其他地方的编程,相对于这个来说,完全就是一碟泡菜~~
楼主,你要加油哦!等你好消息~~ |
|