打印
[四轴技术交流]

四元数初始化的程序问题.

[复制链接]
2740|5
手机看帖
扫描二维码
随时随地手机跟帖
跳转到指定楼层
楼主
352308347|  楼主 | 2016-10-12 22:08 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
ni, PITCH, tc, pi, os
        //陀螺仪x轴为前进方向
                  init_Roll  = atan2(init_ay, init_az);
                  init_Pitch = -asin(init_ax);              //init_Pitch = asin(ax / 1);      
                  init_Yaw   = -atan2(init_mx*cos(init_Roll) + init_my*sin(init_Roll)*sin(init_Pitch) + init_mz*sin(init_Roll)*cos(init_Pitch),
                                      init_my*cos(init_Pitch) - init_mz*sin(init_Pitch));                       //atan2(mx, my);
                  q0 = cos(0.5*init_Roll)*cos(0.5*init_Pitch)*cos(0.5*init_Yaw) + sin(0.5*init_Roll)*sin(0.5*init_Pitch)*sin(0.5*init_Yaw);  //w
                  q1 = sin(0.5*init_Roll)*cos(0.5*init_Pitch)*cos(0.5*init_Yaw) - cos(0.5*init_Roll)*sin(0.5*init_Pitch)*sin(0.5*init_Yaw);  //x   绕x轴旋转是roll
                  q2 = cos(0.5*init_Roll)*sin(0.5*init_Pitch)*cos(0.5*init_Yaw) + sin(0.5*init_Roll)*cos(0.5*init_Pitch)*sin(0.5*init_Yaw);  //y   绕y轴旋转是pitch
                  q3 = cos(0.5*init_Roll)*cos(0.5*init_Pitch)*sin(0.5*init_Yaw) - sin(0.5*init_Roll)*sin(0.5*init_Pitch)*cos(0.5*init_Yaw);  //z   绕z轴旋转是Yaw


研究了两天。。。谁能告诉我这怎么来的吗??????。。。

相关帖子

沙发
352308347|  楼主 | 2016-10-12 22:08 | 只看该作者
三个角的初始化怎么来的?有公式吗?

使用特权

评论回复
板凳
renxiaolin| | 2016-12-9 14:02 | 只看该作者
那虽然你研究两天,但方向错啦,你就看那几个式子是看不出什么的

使用特权

评论回复
地板
无为之益| | 2018-1-27 10:47 | 只看该作者
本帖最后由 无为之益 于 2018-1-27 10:49 编辑

1、自己先定义两个纯粹的四元数,然后算成它们相乘的结果。2、再根据自己定义的三个欧拉角(轴向定义和旋转顺规),套用那个结果乘2次就出来了

使用特权

评论回复
5
啦儿啦| | 2018-4-8 10:53 | 只看该作者
你看看原理再看代码就明白了

使用特权

评论回复
发新帖 我要提问
您需要登录后才可以回帖 登录 | 注册

本版积分规则

2

主题

6

帖子

3

粉丝