找回密码
 立即注册
搜索
查看: 9734|回复: 1

MPU6050 X Y Z 轴的数据提取问题

[复制链接]

2

主题

2

帖子

18

积分

新手上路

Rank: 1

积分
18
发表于 2017-9-28 22:24:11 | 显示全部楼层 |阅读模式
void Read_DMP(void)
{       
          unsigned long sensor_timestamp;
                unsigned char more;
                long quat[4];

                                dmp_read_fifo(gyro, accel, quat, &sensor_timestamp, &sensors, &more);               
                                if (sensors & INV_WXYZ_QUAT )
                                {   
                                         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
                                }

}
这个程序读的是X轴数据,如果我改成Y轴数据,麻烦店主讲解下(看了看程序没怎么懂)?

回复

使用道具 举报

5

主题

231

帖子

1556

积分

管理员

Rank: 9Rank: 9Rank: 9

积分
1556
发表于 2017-10-10 20:40:32 | 显示全部楼层
这是X 和 Y轴的哈。
回复

使用道具 举报

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

本版积分规则

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

GMT+8, 2024-12-27 11:24 , Processed in 0.053396 second(s), 21 queries .

Powered by Discuz! X3.4

Copyright © 2001-2021, Tencent Cloud.

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