找回密码
 立即注册
搜索
查看: 10636|回复: 8

关于Read_DMP函数

[复制链接]

2

主题

5

帖子

13

积分

新手上路

Rank: 1

积分
13
发表于 2018-5-14 01:20:43 | 显示全部楼层 |阅读模式
这个函数里:

                                {   
                                         q0=quat[0] / q30;
                                         q1=quat[1] / q30;
                                         q2=quat[2] / q30;
                                         q3=quat[3] / q30;
                                         Pitch = asin(-2 * q1 * q3 + 2 * q0* q2)* 57.3;        
                                         Roll = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2* q2 + 1)* 57.3; // roll
                                }


PITCH是指俯仰角,还是指绕X轴旋转的倾角。
我觉得是俯仰角的意思,主要是去百度搜索资料,都把这个算作绕x轴旋转的角。但是会本设计中,x轴是小车前进方向,所以读程序读下去感觉不大对,这个参数控制的是直立环,感觉应该是俯仰角。希望得到确认
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

粤ICP备20017043号|小黑屋|手机版|Archiver|轮趣科技(东莞)有限公司  

GMT+8, 2024-11-25 21:35 , Processed in 0.052872 second(s), 21 queries .

Powered by Discuz! X3.4

Copyright © 2001-2021, Tencent Cloud.

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