【STM32】MPU9250移植记录（软件IIC，STM32F4，Hal）

已于 2024-05-02 10:35:04 修改
阅读量2.5k 收藏 47
点赞数 30
文章标签： stm32 驱动开发 嵌入式硬件
于 2024-05-01 21:35:18 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/aabbcce_/article/details/138377374
版权

文章还没有完结……

1. 废话

五一稍微空一点了，做了一下MPU9250移植。这是去年8月就想做的事情，但因为种种原因，一直拖到了现在。一方面是比较忙，另一方面是上次6050DMP移植花了整整三天时间，有点阴影了。但是机器人省赛将近，不能再拖了。

简单浏览了一下，在网上没有找到特别合适的教程。大部分资料都是正点原子的，但是因为我的代码都不是他们框架的，所以之前的移植都被狠狠地折磨了。又是sys.h，又是iic里面一堆冗余的函数，又是好多个delay函数，最后还有莫名其妙的结算缓慢的现象。故这次决定不再使用他们家的代码。

2. 资源

在github上简单搜索了一下，找到下面这个资源，看了一下，代码还是比较简洁的。虽然是硬件IIC，但是简单改一下就可以转换为软件IIC。

MPU9250-DMP-STM32

在这里插入图片描述

3. 开始移植

（1）首先是最基本的下载文件，解压缩，创建文件夹，keil包含路径，添加文件。

（2）阐述一下几个文件的功能：

在这里插入图片描述

  • stm32_mpu9250_i2c: 撰写底层的IIC函数，如收发等。需要移植硬件IIC或者标准库的话，主要修改的就是这里的内容。
  • MPU9250-DMP: 用户接口，最后执行角度读取的任务就是调用这里的函数。
  • 其他：几乎不用修改的部分。我们只需要管硬件层和应用层即可，中间的主要为算法以及寄存器部分。

（3）stm32_mpu9250_i2c.c 和 stm32_mpu9250_i2c.c 内容填充

因为原来作者使用的是Hal的硬件IIC，因此，我把这部分全部换成自己的东西。函数命名很随意，大家自己改一下吧。

stm32_mpu9250_i2c.c

#include "stm32_mpu9250_i2c.h"

void MYIIC_Delayus(uint32_t u_sec)
{
	uint16_t cnt = 0;
 
	while(u_sec--)
	{
		for(cnt=0; cnt>0; cnt--);
	}
}

void MYIIC_W_SDA(uint8_t i)
{
	if(i==0)
	{
		IIC_SDA(GPIO_PIN_RESET);
//		MYIIC_Delayus(1);
	}		
	else if(i==1)
	{
		IIC_SDA(GPIO_PIN_SET);
//		MYIIC_Delayus(1);
	}		
}

void MYIIC_W_SCL(uint8_t i)
{
	if(i==0)
	{
		IIC_SCL(GPIO_PIN_RESET);
//		MYIIC_Delayus(1);
	}		
	else if(i==1)
	{
		IIC_SCL(GPIO_PIN_SET);
//		MYIIC_Delayus(1);
	}	
}

uint8_t MYIIC_R_SDA(void)
{
	uint8_t BitVal;
	if(IIC_SDA_R()==GPIO_PIN_SET) 
		BitVal=1;	
	else if(IIC_SDA_R()==GPIO_PIN_RESET)
		BitVal=0;
//	MYIIC_Delayus(1);
	return BitVal;
}

void MYIIC_Start(void)
{
	MYIIC_W_SDA(1);
	MYIIC_W_SCL(1);
	MYIIC_W_SDA(0);
	MYIIC_W_SCL(0);
}

void MYIIC_Stop(void)
{
	MYIIC_W_SDA(0);
	MYIIC_W_SCL(1);
	MYIIC_W_SDA(1);
}

/*   following function are needed in transplant of DMP    */
void MYIIC_SendByte(uint8_t Byte)
{
	uint8_t i;
	for (i = 0; i < 8; i ++)
	{
		if(Byte & (0x80 >> i))
			MYIIC_W_SDA(1);
		else 
			MYIIC_W_SDA(0);
		MYIIC_W_SCL(1);
		MYIIC_W_SCL(0);
	}
}

//return 1:success 0:failed
uint8_t IIC_Wait_Ack(void)		
{
	uint8_t ucErrTime=0;  
	MYIIC_W_SDA(1);   
	MYIIC_W_SCL(1);	 
	while(MYIIC_R_SDA())
	{
		ucErrTime++;
		if(ucErrTime>100)
		{
			MYIIC_Stop();  
			return 0;
		}
	}
	MYIIC_W_SCL(0);
	return 1;  
}

void MYIIC_SendAck(uint8_t AckBit)		//0——ack 1——nack
{
	MYIIC_W_SDA(AckBit);
	MYIIC_W_SCL(1);
	MYIIC_W_SCL(0);
}

uint8_t IIC_Read_Byte(unsigned char ack)
{
	unsigned char i,receive=0;
  for(i=0;i<8;i++ )
	{
		MYIIC_W_SCL(0); 
		MYIIC_W_SCL(1);
		receive<<=1;
		if(MYIIC_R_SDA())
			receive++;   
  }					 
	if (ack)
			MYIIC_SendAck(0);		//send ACK 
	else
			MYIIC_SendAck(1);		//send nACK  
	return receive;
} 

int stm32_i2c_write(uint8_t dev, uint8_t reg, uint8_t length, uint8_t* data)
{
 	int count = 0;
	MYIIC_Start();
	MYIIC_SendByte(dev);	   //发送写命令
	IIC_Wait_Ack();
	MYIIC_SendByte(reg);   //发送地址
    IIC_Wait_Ack();	  
	for(count=0;count<length;count++){
		MYIIC_SendByte(data[count]); 
		IIC_Wait_Ack(); 
	 }
	MYIIC_Stop();//产生一个停止条件

  return 1; //status == 0;
}


int stm32_i2c_read(uint8_t dev, uint8_t reg, uint8_t length, uint8_t* data)
{
 	int count = 0;
	
	MYIIC_Start();
	MYIIC_SendByte(dev);	   //发送写命令
	IIC_Wait_Ack();
	MYIIC_SendByte(reg);   //发送地址
	IIC_Wait_Ack();	  
	MYIIC_Start();
	MYIIC_SendByte(dev+1);  //进入接收模式	
	IIC_Wait_Ack();
	
	for(count=0;count<length;count++)
	{	 
		 if(count!=length-1)data[count]=IIC_Read_Byte(1);  //带ACK的读数据
		 	else  data[count]=IIC_Read_Byte(0);	 //最后一个字节NACK
	}
	MYIIC_Stop();		//产生一个停止条件
	return count;
}

stm32_mpu9250_i2c.h（记得把宏改成自己的引脚）

#include "main.h"

#ifndef _STM32_MPU9250_I2C_H_
#define _STM32_MPU9250_I2C_H_

#define I2C_SCL_Pin GPIO_PIN_9
#define I2C_SCL_GPIO_Port GPIOB
#define I2C_SDA_Pin GPIO_PIN_10
#define I2C_SDA_GPIO_Port GPIOB

#define IIC_SCL(a)		HAL_GPIO_WritePin(IIC_GPIO_PORT, IIC_SCL_PIN, a)
#define IIC_SDA(a)		HAL_GPIO_WritePin(IIC_GPIO_PORT, IIC_SDA_PIN, a)
#define IIC_SDA_R()		HAL_GPIO_ReadPin(IIC_GPIO_PORT, IIC_SDA_PIN)

int stm32_i2c_write(uint8_t dev, uint8_t reg,
                       uint8_t length, uint8_t * data);
int stm32_i2c_read(uint8_t dev, uint8_t reg,
                       uint8_t length, uint8_t * data);

#endif // _STM32_MPU9250_I2C_H_

（4）为系统添加宏

第一次编译后的报错来自inv_mpu.h此处：

#elif defined EMPL_TARGET_STM32F4
    void (*cb)(void);
#endif

当时参考了这篇文章

在工程设置中添加如下宏（EMPL_TARGET_STM32F4根据自己设备调整）：

MPL_LOG_NDEBUG=1,EMPL,MPU9250,EMPL_TARGET_STM32F4

在这里插入图片描述

（5）dmpmap.h小改

第二次编译后这么报错：

…\MPU9250\dmpmap.h(6): error: #37: the #endif for this directive is missing

就是字面意思，不要想复杂了，第一话 #ifndef DMPMAP_H，没有对应的 #endif。总共需要两个，那么我们再补上一个。

在这里插入图片描述

（6）MPU9250-DMP.c替换

第四次编译，如是报错：

Project\Project.axf: Error: L6218E: Undefined symbol constrain (referred from mpu9250-dmp.o).
Project\Project.axf: Error: L6218E: Undefined symbol constrainU16 (referred from mpu9250-dmp.o).
Project\Project.axf: Error: L6218E: Undefined symbol dmpEnableFeatures (referred from mpu9250-dmp.o).
Project\Project.axf: Error: L6218E: Undefined symbol dmpGetEnabledFeatures (referred from mpu9250-dmp.o).

看了好久才发现，h文件里的相关内容都是MPU9250_constrain 这种，而c文件里面却没有头衔constrain。

在这里插入图片描述

请使用快捷键Ctrl + F，如上搜索MPU9250-DMP.c文件（尽量搜整个工程，不过这步错误都出现在这个c文件里面），做以下替换：

constrain   替换为   MPU9250_constrain
constrainU16   替换为   MPU9250_constrainU16
dmpEnableFeatures   替换为   MPU9250_dmpEnableFeatures
dmpGetEnabledFeatures   替换为   MPU9250_dmpGetEnabledFeatures

github的分享者到底是怎么把代码跑起来的……

（7）MPU9250-DMP.h变量搬家

第四次编译，就没什么问题了。

我很想调用了，所以做了一些准备工作，在main.h里面声明了外部变量：

extern float pitch_inside, roll_inside, yaw_inside;

之后进行第五次编译，出现462个报错😅，发现都是这种：

Project\Project.axf: Error: L6200E: Symbol yaw_inside multiply defined (by stm32_mpu9250_i2c.o and main.o).

观察这些变量发现，它们都被定义在MPU9250-DMP.h里面，然后会被MPU9250-DMP.c调用。现在我还要在main.h里面声明，然后在main.c里面调用，可能由此产生了重复定义。

我选择把下面这坨变量从MPU9250-DMP.h移动到MPU9250-DMP.c里面，我是一直这么做的，但不知道这是不是最优雅的做法。

在这里插入图片描述

unsigned short _aSense;
float _gSense, _mSense;

int ax, ay, az;
int gx, gy, gz;
int mx, my, mz;
long qw, qx, qy, qz;
long temperature;
unsigned long time_inside;
float pitch_inside, roll_inside, yaw_inside;
float heading;

（8）在main中调用

作者没有教怎么调用，但是通过各h文件的包含关系，我们可以知道MPU9250_DMP就是一切的终点。所以我把两个文件发给GPT，让它教我使用。给出了如下代码，添加到main函数中去。第六次编译没有任何报错。

	// 初始化MPU9250
    if (MPU9250_begin() != INV_SUCCESS) {
        printf("Unable to initialize MPU9250\n");
        return -1;
    }

    // 启用DMP特性和设置FIFO采样率
    unsigned short dmpFeatures = DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_SEND_RAW_ACCEL | DMP_FEATURE_SEND_CAL_GYRO | DMP_FEATURE_GYRO_CAL;
    if (MPU9250_dmpBegin(dmpFeatures, 50) != INV_SUCCESS) { // 50Hz FIFO rate
        printf("Failed to initialize DMP\n");
        return -1;
    }

    // 启用中断，这样每当有新数据可读时，MPU9250会通知MCU
    if (MPU9250_enableInterrupt(1) != INV_SUCCESS) {
        printf("Failed to enable interrupts\n");
        return -1;
    }
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
    // 检查是否有新的数据
    if (MPU9250_dataReady()) {
        // 读取所有传感器数据
        if (MPU9250_update(UPDATE_ACCEL | UPDATE_GYRO | UPDATE_COMPASS) != INV_SUCCESS) {
            printf("Failed to read sensor data\n");
        }

        // 计算欧拉角
        MPU9250_computeEulerAngles(true);

        // 输出计算得到的欧拉角
        printf("Pitch: %f degrees\n", pitch_inside);
        printf("Roll: %f degrees\n", roll_inside);
        printf("Yaw: %f degrees\n", yaw_inside);
    }
    HAL_Delay(200);
  }

(9) F4板子不在身边，所以后续内容等我测试完并且空闲下来再更新吧，估计要好久之后了……

4. 视频

埋土人
关注
MPU9250 九轴 EKF扩展卡尔曼滤波数据融合算法 选取状态量为四元数和三轴陀螺仪的漂移
EevQiOVGMl的博客
03-14 1522
我们从陀螺仪和加速度计的特性出发，介绍了在短时间内对陀螺仪数据的可信性以及在长时间内对加速度计数据的可信性。本文围绕MPU9250九轴传感器的数据融合算法展开讨论，介绍了使用扩展卡尔曼滤波算法对陀螺仪和加速度计数据进行融合的方法。在预测步骤中，我们使用陀螺仪的测量值进行状态预测，并更新状态的协方差矩阵。在更新步骤中，我们使用加速度计和磁偏角的测量值来校正预测的状态，并更新状态的协方差矩阵。在短时间内，我们可以相信陀螺仪的测量值，但随着时间的推移，陀螺仪的漂移会越来越大，导致姿态解算的不准确。
stm32读取mpu9250九轴数据及四元数数据
weixin_41822392的博客
04-26 7777
设备：电脑一台、stm32H743开发板一块。 效果：可以实时控制mpu9250芯片的yaw、pitch、row以及原始的陀螺仪、加速度计、磁力计 传感器数据。 程序的安装包、注册方法、操作步骤如下 一、安装教程（所有需要的软件、固件、图形显示界面均可在软件中找到） 软件以及stm32H743的官方例程，留联系方式我私发你们。 1、解压上图软件中的MDK5，点击keil.stm32h7xx安装嵌...
MPU9250九轴官方MPL库移植STM32F407例程
04-14
MPU9250MPL官方版本 已移植好STM32F407例程寄存器版（本人也成功移植到STM32F103上需要的请另外联系），能直接接上MPU9250使用，运行稳定后yaw角不漂移。上传只是希望更多的人开发九轴MPL库，然后可以多多交流学习。
stm32f103读取MPU9250初始数据程序
10-03
将mpu9250读取角度的程序移植到了stm32f103上,方便测试原始数据是否正确。
STM32驱动MPU9250九轴姿态加速度模块
最新发布
优信电子的博客
09-14 1371
MPU9250是一个OFN封装的复合芯片(MGM)，它由2部分组成。一组是3轴加速度还有3轴陀螺仪，另一组则是AKM公司的AK8963轴磁力计。所以，MPU9250是一款9轴运动跟踪装置，他在小小的3X3X1m的封装中融合了3轴加速度，3轴陀螺仪以及数字运动处理器(DMP)并且兼容MPU6515。其完美的12 C方案,可直接输出9轴的全部数据。一体化的设计,运动性的融合,时钟校准功能,让开发者避开了繁琐复杂的芯片选择和外设成本，保证最佳的性能。
STM32CubeIDE HAL库操作IIC （二）案例篇（MPU9250）
zateper的博客
02-17 8519
接上一篇：STM32CubeIDE HAL库操作IIC （一）配置篇 一、IIC接口 二、工作流程 三、传感器数据读取
STM32模拟I2C读取MPU9250数据
热门推荐
远行的蜗牛
12-06 1万+
模拟I2C MPU9250
MPU9250+STM32F103
03-26
实测可用，精度不错； 改编自正点原子F4版；
mpu9250_stm32驱动
05-12
stm32 亲测能用，无情奉献，实现mpu9250各轴数据的读取
stm32+mpu9250程序
05-30
stm32l053读mpu9250加速度和陀螺仪 程序 采用液晶显示 可以作为stm32l系列采用库文件的模板程序使用
MPU9250 DMP STM32驱动代码
01-25
MPU9250 DMP STM32驱动代码，亲测可用。容易理解内容简洁
MPU9250 STM32库函数
12-05
关于九轴陀螺仪 MPU9250 基于STM32f1库函数版本 的源码
STM32串口输出MPU-9250九轴传感器
08-13
STM32F103调试成功，基于卖家资料和正点原子代买所写。如果触犯他人权利，请联系我，会及时清除。
MPU9250移植到F103C8T6,串口输出俯仰角和偏航
02-09
MPU9250移植到F103C8T6，包含KEIL和IAR的两个工程。
STM32-MPU9250:用C ++编写的用于STM32的MPU9250的库
03-18
STM32-MPU9250:用C ++编写的用于STM32的MPU9250的库
SMT32 MPU9250驱动代码国外大牛贡献
01-25
SMT32 MPU9250驱动代码国外大牛贡献 arduino工程。
STM32_MPU9250_DMP.zip_MPU6500 DMP_STM32F103mpu9250_mpu6050 DMP
07-14
STM32_MPU9250_DMP.zip 文件包含了针对STM32F103C8微控制器的MPU9250传感器驱动程序，特别强调了DMP（数字运动处理器）功能的实现，该功能同样适用于MPU6500传感器。DMP是一种硬件加速器，用于处理传感器数据融合，...
MPU9250从STM32F4移植到F1源码例程
04-24
标题中的“MPU9250从STM32F4移植到F1源码例程”涉及了两个关键硬件平台——STM32F4和STM32F1，以及一个重要的传感器组件——MPU9250。这个过程通常是为了在资源更有限的STM32F1微控制器上实现相同的功能，比如在...
基于STM32 CUBeMx的MPU9250驱动和磁力计椭球拟合
04-13
需修改： 1. MPU 的 ID ，9250：0x71，9255：0x73 单位： 1. 加速度：g 2. 陀螺仪：度/s 3. 磁力计：向量 ...1. 含示例工程，基于stm32F4CE11U6 2.含磁力计拟合，不含磁力计校正 3. 可以修改驱动方式，在末尾
stm32 mpu9250 dmp
05-12
STM32和MPU9250都是嵌入式系统中常用的硬件设备。MPU9250是一种集成了加速度计、陀螺仪、磁力计和温度传感器的9轴惯性测量单元(IMU)。DMP是指数字移动处理器，它是一种基于传感器信号的物理算法，可用于处理复杂的运动信号和姿态估计。 在STM32中使用MPU9250 DMP，可以通过I2C总线将MPU9250连接到STM32的I2C接口上，并使用STM32的程序代码控制MPU9250的DMP数据输出。具体实现步骤如下： 1. 配置STM32的I2C接口，并初始化MPU9250的寄存器。 2. 设置MPU9250的DMP，通过I2C发送配置信息到MPU9250，启用DMP。 3. 通过I2C读取MPU9250的DMP数据。 4. 解析DMP数据，并将其转换为姿态信息。 需要注意的是，使用MPU9250 DMP需要进行较多的数据处理和算法实现，因此需要较强的嵌入式系统开发能力。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值