MPU6500模块调试

VIO里的惯性数据，这里通过MPU6500输出姿态数据。

1. 配置方式和数据读取方式

SPI或者IIC都可以，但对我算法来说，低速的IIC就可以，400KHz.

/** 函数名：MPU6500_Init* 描述  ：MPU6500初始化函数* 输入  ：无* 输出  ：0：初始化失败 1：初始化成功*/
u8 MPU6500_Init(void)
{SPI1_Init();                                                               //MPU6500 IO口和SPI初始化if(MPU6500_Read_Reg(WHO_AM_I) == 0x70)            //正确读取到6500的地址{     MPU6500_Write_Reg(PWR_MGMT_1,0X80);         //电源管理,复位MPU6500Delay_Ms(100);MPU6500_Write_Reg(SIGNAL_PATH_RESET,0X07);//陀螺仪、加速度计、温度计复位Delay_Ms(100);MPU6500_Write_Reg(PWR_MGMT_1,0X01);           //选择时钟源MPU6500_Write_Reg(PWR_MGMT_2,0X00);          //使能加速度计和陀螺仪MPU6500_Write_Reg(CONFIG,0X02);                     //低通滤波器 0x02 92hz (3.9ms delay) fs=1khzMPU6500_Write_Reg(SMPLRT_DIV,0X00);             //采样率1000/(1+0)=1000HZMPU6500_Write_Reg(GYRO_CONFIG,0X18);        //陀螺仪测量范围 0X18 正负2000度MPU6500_Write_Reg(ACCEL_CONFIG,0x10);         //加速度计测量范围 0X00 正负8gMPU6500_Write_Reg(ACCEL_CONFIG2,0x00);      //加速度计速率1khz 滤波器460hz (1.94ms delay)return 1;}else return 0;
}

初始化及配置方式，基本如上，然后，读取需要的寄存器即可。

2. 姿态解算

通过IMU的六轴传感器数据，三轴陀螺仪和三轴加速度计，使用四元数进行姿态解算。

主要分为两步：

（一）

（二）

3. DMP

MPU6500内部集成了DMP，并且，官方提供了针对DMP的运动驱动库，通过IIC接口配置MPU6500，即可得到四元数数据（FIFO），然后，转化为YAW、PITCH、ROLL数据。

（三）

4. UI

添加串口驱动，按照AHRS_Captain_Flight上位机串口通信协议，设计UART接口程序。

（四）

配置上位机软件，实现3D模拟显示。

到处，完成了MPU6500接口调试的基本工作。

参考博文：

http://blog.sina.com.cn/s/blog_c5a00db10102wd7d.html

MPU6500模块调试相关推荐

MPU6500模块调试笔记——小心冒牌货
本人最近做项目需要用到MPU6500,在淘宝购买了一块MPU6500模块后开始调试,整了半天发现无论如何也读不出模块的数据,耐着性子一步一步调试后发现遇到了个冒牌的6500... 模块硬件如图:使用的 ...
Linux驱动编程 step-by-step （六）用户地址检测简单模块调试以及一些杂项
用户地址检测简单模块调试以及一些杂项检测用户空间地址的有效性上一节中提到在read write时候要检测用户空间传递的参数地址是否是有效地址,有的内核函数会自行检测,但是在调用轻量级的内核函数 ...
你所不知道的模块调试技巧 - npm link #17
你所不知道的模块调试技巧 - npm link #17 1. 背景 node 应用开发中,我们不可避免的需要使用或拆分为 npm 模块,经常遇到的一个问题是: 新开发或修改的 npm 模块,如何在项目 ...
第十三届蓝桥杯嵌入式备赛-STM32G431-基础模块调试①LED/LCD调试
目录 0.前言时钟设置项目设置 1.功能要求电路原理图 2.STM32Cubemx初始化 3.程序实现 LCD LED 编写LED灯亮灭的相关函数 LED关闭函数 LEDx开启函数 LEDx关闭 ...
WIFI模块调试_RTL8189FTV
WIFI模块调试记录本文调试的模块是:BL_M8189FS6(必联的WIFI模块) 简单介绍: 该模块就是用的毛蟹的8189FTV(全程应该是:RTL8189FTV,和RTL8189ETV是有区别的 ...
hc-05蓝牙模块调试
hc-05蓝牙模块调试本文主要记录hc-05蓝牙模块调试的过程,包括hc-05蓝牙模块连线,驱动下载,hc-05蓝牙模块模式介绍,AT指令,串口调试以及与安卓手机app连接发送数据.(只列举了我在调 ...
【JDY-23蓝牙模块调试】
JDY-23蓝牙模块调试整体说明工欲善其事,必先利其器(JDY23蓝牙模块的购买) 电路原理图的设计原理图的设计 PCB的设计手机APP的设计主窗口设计 IO控制窗口串口透传功能视频及开 ...
Lora模块调试记录
一.Lora模块调试启动过程调试 1.Lora主程序启动这个报错主要是GPS模块使用了另外一路的spi,在检查spi的模式.速率等等时候报错.目前没有GPS模块所以不影响正常运行情况下的报错信息忽略 ...
龙尚U9507 4G模块调试小结
最近在调U9507模块,调试一个模块,其主要步骤如下: 1.首先要查看其数据手册,看其工作电压,该模块工作电压为3.3~4.2V,要先用万用表测其供电电压是否正常(注要一定要达3.3V以上,因为有些模 ...

MPU6500模块调试

MPU6500模块调试相关推荐

最新文章

热门文章