MPU6050+HMC5883+BMP180+GPS导航系统设计

最新推荐文章于 2025-05-09 10:28:37 发布
最新推荐文章于 2025-05-09 10:28:37 发布
阅读量7.3k 收藏 56
点赞数 8
CC 4.0 BY-SA版权
分类专栏： stm32设计 姿态解算 飞控 文章标签： stm32 MPU6050 惯导
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/boboelec/article/details/61915378
本文介绍了MPU6050陀螺仪及加速度计的实际应用案例，包括其与STM32的连接配置、静态漂移测试、与磁力计HMC5883和气压计BMP180的组合使用，以及如何通过Arduino实现3D姿态跟踪。

摘要生成于 C知道 ，由 DeepSeek-R1 满血版支持， 前往体验 >

老师有个项目，让我搞惯导这一块,虽然最后也没有用上廉价的MPU6050，而是用了一两万的Xsens。但是本人还是想写一下MPU6050，虽然技术含量不高，但是写下来，留个纪念吧。



首先是MPU6050，属于MEMS传感器，现在做四轴的用这款芯片的很多，它集成了三轴陀螺仪+三轴加速度计，因为官方提供DMP库，这样就大大方便了开发，使用硬解，解放主控资源。自己买回来MPU6050后，测了其静态漂移。把MPU6050模块插在面包板上，微处理器用的是stm32，通讯方式是IIC，姿态解算用的是硬件解算，用的例程是原子的，然后通过每隔一段时间记录一次,mpu6050自带的DMP进行解算，直接输出四元数，然后通过四元数转化转换为对应的姿态角，但是没有Z轴上的参考量，所以Yaw是不准的。(Time是次数的意思，当时的时间间隔忘记了）

发现半个小时，yaw漂6--7度。对于微型小四轴来说够用了，一般微型小四轴也就飞7、8分钟左右。通过mpu6050，我们可以得到roll，pitch，yaw。至于mpu6050的源码，大家自己看原子的。这里就不放了。

其次是HMC5883，它是磁力计，可以测量x,y,z方向上的磁场。它与微处理器也是通过IIC通讯。至于它的有关介绍可以看DATASHEET。其代码如下：

#include "HMC5883L.h"
#include "sys.h"
#include "delay.h"
#include "usart.h" 
#define SlaveAddress 0x3c

void Init_HMC5883(void)
{
	      MPU_IIC_Init();
	      Write_HMC5883_Byte(0x02,0x00);		
}

u8 Write_HMC5883_Byte(u8 add, u8 da)
{
   MPU_IIC_Start();                 
   MPU_IIC_Send_Byte(SlaveAddress);   
	 if(MPU_IIC_Wait_Ack())	
	{
		MPU_IIC_Stop();		 
		return 1;		
	}	
   MPU_IIC_Send_Byte(add);   
	 MPU_IIC_Wait_Ack();	

   MPU_IIC_Send_Byte(da);     
	if(MPU_IIC_Wait_Ack())
{
		MPU_IIC_Stop();	 
		return 1;		 
	}		

   MPU_IIC_Stop();	
	 return 0;
}
u8 Read_HMC5883_Byte(u8 REG_Address)
{   
	u8 REG_data;
   MPU_IIC_Start();                        
   MPU_IIC_Send_Byte(SlaveAddress);           
   MPU_IIC_Wait_Ack();

    MPU_IIC_Send_Byte(REG_Address);                   	
	  MPU_IIC_Wait_Ack();

   MPU_IIC_Start();                        
   MPU_IIC_Send_Byte(SlaveAddress+1);         
	 MPU_IIC_Wait_Ack();	

    REG_data=MPU_IIC_Read_Byte(0);            
	  MPU_IIC_Stop();                         
    return REG_data; 
}
void Multiple_read_HMC5883(u8*BUF)
{   u8 i;
    MPU_IIC_Start();                          
    MPU_IIC_Send_Byte(SlaveAddress);           
	  MPU_IIC_Wait_Ack();
    MPU_IIC_Send_Byte(0x03);                   	
	  MPU_IIC_Wait_Ack();
    MPU_IIC_Start();                          
    MPU_IIC_Send_Byte(SlaveAddress+1);        
	  MPU_IIC_Wait_Ack();
	 for (i=0; i<6; i++)                     
    {
        
        if (i == 5)
        {
           BUF[i] = MPU_IIC_Read_Byte(0);          
        }
        else
        {
          BUF[i] = MPU_IIC_Read_Byte(1);          
       }
   }
    MPU_IIC_Stop();                          
}


接下来是BMP180气压计，它通过测气压得到相对海拔高度，但是我感觉噪声有点大，估计我用的是原始值，没有滤波的原因，大家可以用MS5611，精度比较高。效果会好些。但是气压计这个东西本来就会受环境影响。它也是通过IIC与微处理器通讯的，我直接上代码：
#include "BMP180.h"
#include "delay.h"
#include "mpuiic.h"
#include "sys.h"
long  result_UT=0;
long  result_UP=0;

short ac1;
short ac2; 
short ac3; 
unsigned short ac4;
unsigned short ac5;
unsigned short ac6;
short b1; 
short b2;
short mb;
short mc;
short md;
u16 Multiple_read(u8 ST_Address)
{   
	u8 msb, lsb;
	u16 _data;
    MPU_IIC_Start();                          
    MPU_IIC_Send_Byte(BMP180_SlaveAddress);    
	MPU_IIC_Wait_Ack();
    MPU_IIC_Send_Byte(ST_Address);            
	MPU_IIC_Wait_Ack();                                
    MPU_IIC_Start();                          
    MPU_IIC_Send_Byte(BMP180_SlaveAddress+1);        
	MPU_IIC_Wait_Ack();                                       

    msb = MPU_IIC_Read_Byte(1);                                
    lsb = MPU_IIC_Read_Byte(0);              

    MPU_IIC_Stop();                         
    delay_ms(5);
    _data = msb << 8;
	_data |= lsb;	
	return _data;
}
//********************************************************************
u16 bmp180ReadTemp(void)
{

    MPU_IIC_Start();                  
    MPU_IIC_Send_Byte(BMP180_SlaveAddress);   
	MPU_IIC_Wait_Ack();
    MPU_IIC_Send_Byte(0xF4);	        
    while(MPU_IIC_Wait_Ack());
	MPU_IIC_Send_Byte(0x2E);       	
    while(MPU_IIC_Wait_Ack());
	MPU_IIC_Stop();                   
	delay_ms(10);	
	return Multiple_read(0xF6);
}
//*************************************************************
u16 bmp180ReadPressure(void)
{
	//u16 pressure = 0;

    MPU_IIC_Start();                  
    MPU_IIC_Send_Byte(BMP180_SlaveAddress);  
    while(MPU_IIC_Wait_Ack());
	MPU_IIC_Send_Byte(0xF4);	         
    while(MPU_IIC_Wait_Ack());
	MPU_IIC_Send_Byte(0x34);       	  
    while(MPU_IIC_Wait_Ack());
	MPU_IIC_Stop();                   
	delay_ms(20);    	                  
	

	
	return Multiple_read(0xF6);//pressure;	
}

//**************************************************************


void Init_BMP180()
{
	MPU_IIC_Init();
	ac1 = Multiple_read(0xAA);
	ac2 = Multiple_read(0xAC);
	ac3 = Multiple_read(0xAE);
	ac4 = Multiple_read(0xB0);
	ac5 = Multiple_read(0xB2);
	ac6 = Multiple_read(0xB4);
	b1 =  Multiple_read(0xB6);
	b2 =  Multiple_read(0xB8);
	mb =  Multiple_read(0xBA);
	mc =  Multiple_read(0xBC);
	md =  Multiple_read(0xBE);
}
//***********************************************************************
void bmp180Convert()
{
	unsigned int ut;
	unsigned long up;
	long x1, x2, b5, b6, x3, b3, p;
	unsigned long b4, b7;

	ut = bmp180ReadTemp();	 
	up = bmp180ReadPressure();  
	//*************
	x1 = (((long)ut - (long)ac6)*(long)ac5) >> 15;
	x2 = ((long) mc << 11) / (x1 + md);
	b5 = x1 + x2;
	result_UT = ((b5 + 8) >> 4);
	//*************		
	b6 = b5 - 4000;
	                        
	x1 = (b2 * (b6 * b6)>>12)>>11;
	x2 = (ac2 * b6)>>11;
	x3 = x1 + x2;
	b3 = (((((long)ac1)*4 + x3)<>2;	
	                         
	x1 = (ac3 * b6)>>13;
	x2 = (b1 * ((b6 * b6)>>12))>>16;
	x3 = ((x1 + x2) + 2)>>2;
	b4 = (ac4 * (unsigned long)(x3 + 32768))>>15;
	
	b7 = ((unsigned long)(up - b3) * (50000>>OSS));
	if (b7 < 0x80000000)
	p = (b7<<1)/b4;
	else
	p = (b7/b4)<<1;
	
	x1 = (p>>8) * (p>>8);
	x1 = (x1 * 3038)>>16;
	x2 = (-7357 * p)>>16;
	result_UP = p+((x1 + x2 + 3791)>>4);
}
GPS是通过USART通信的，代码就不放了。
这些数据都是直接采的，没进行滤波什么的，姿态解算也是用的硬解。然后自己用VB写了个上位机，将所有原始数据传给上位机。

除此之外，我将mpu6050的数据通过串口传给Arduino,然后主要想做个3D姿态跟随的效果，Arduino将数据传给电脑，然后实现3d姿态仿真的效果。后来发现其实labview也可以做3d仿真。


以上内容，难免有错误与不足之处，大家踊跃拍砖。

MPU6050辅助IIC（HMC5883L,STM32F103C8T6）
m0_72615170的博客
02-03 3923
当系统处理器配置完毕时（直通模式），应切换为主模式，这样可以既可以节省IO口，又可以节省MCU的空间（直通模式说明上提及“直通模式下系统处理器也可以访问MPU6050”,不知道这是不是意味着可以用一根总线挂载两个设备）辅助IIC有两种模式，一种是主模式，用于MPU6050读取外部传感器数据；一种是直通模式，用于系统处理器配置外部传感器。本项目使用MPU6050辅助IIC接口，挂载HMC5883L形成九轴传感器（加速度计、陀螺仪、磁力计）MPU6050设置直通模式。（代码，原理图，制版文件，参考文档）
[stm32] MPU6050 HMC5883 Kalman 融合算法移植
weixin_34014277的博客
08-15 948
  一、卡尔曼滤波九轴融合算法stm32尝试   1、Kalman滤波文件[.h已经封装为结构体] 1 /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics-&gt; All rights reserved-&gt; 2 3 This software may be distributed and mod...
51单片机MPU6050+HMC5883程序
04-04
弄了很多天在弄好，网上找啊找终于找到了四元融合，我在想程师是小气呢，还是怎么，总是不愿因分享，
MPU6050开发全攻略：从硬件设计到软件实现的深度解析
最新发布
niuTyler的博客
05-09 1335
MPU6050采用右手坐标系X轴：平行于芯片长边，指向右侧Y轴：平行于芯片短边，指向前方Z轴：垂直于芯片平面，向上为正在实际应用中，必须确保传感器安装方向与系统坐标系一致，否则需要进行轴向转换。MPU6050作为一款性价比极高的运动传感器，其开发过程既需要扎实的硬件基础，也需要精湛的信号处理技巧。通过本文的系统性介绍，开发者应能掌握从硬件设计到高级算法实现的完整流程。记住，稳定的运动感知系统=正确的硬件设计+严谨的初始化流程+合理的数据处理+持续的优化迭代。
STM32F103C8t6驱动MPU6050+HMC5883L+BMP280进行三轴姿态解算
qq_52376391的博客
08-24 2300
做了一个星期的姿态解算，遇到了许许多多奇怪的问题，从硬件到代码，特此记录一下，希望能够帮助大家走出困境。IIC使用两根信号线进行通信：一根时钟线SCL，一根数据线SDA。IIC将SCL处于高时SDA拉低的动作作为开始信号，SCL处于高时SDA拉高的动作作为结束信号；传输数据时，SDA在SCL低电平时改变数据，在SCL高电平时保持数据，每个SCL脉冲的高电平传递1位数据。所有IIC设备的SCL连在一起，SDA连在一起；设备的SCL和SDA要配置成开漏输出模式；
STM32通过MPU6050读取HMC5883数据时遇到的问题
u010030591的专栏
10-22 9616
上图为所用模块，为市场常见的MPU6050模块（GY-521）和HMC5883模块（GY-271） 遇到的问题： 1、模块共用STM32的I2C接口时的连接方法？ 答： 
mpu6050+hmc5883L.rar
06-25
基于STM32F103ZE+MPU6050+HMC5883L串口2输出欧拉角以及四元数，数据经融合校准，Z轴无漂移，内置串口1函数，可自己修改串口1输出角度
STM32 mpu6050 HMC5883 互补滤波 姿态解算 附卡尔曼滤波代码 下位机通信协议
06-07
//移植只需改以下参数 /* #define IIC_SCL_Pin GPIO_Pin_6 #define IIC_SDA_Pin GPIO_Pin_7 #define IMU_IIC_GPIO GPIOB #define IMU_IIC_RCC RCC_APB2Periph_GPIOB #define IIC_SDA_In() {GPIOB->CRL&=0X0FFFFFFF;GPIOB->CRL|=(u32)8<CRL&=0X0FFFFFFF;GPIOB->CRL|=(u32)3<CRH&=0XFFFF0FFF;GPIOB->CRH|=8<CRH&=0XFFFF0FFF;GPIOB->CRH|=3<<12;}
MPU6050进口HMC5883L BMP180
m0_68981246的博客
02-06 868
在无人机或机器人导航中，这有助于估算设备的高度变化，增强姿态解算的准确性。在STM32_AHRS_WorkDir源程序中，开发者会找到相关的驱动代码，包括初始化传感器、配置通信接口、读取传感器数据的函数，以及姿态解算的算法实现。STM32F103是STM32系列的一款通用型微控制器，基于ARM Cortex-M3内核，具有高速处理能力和丰富的外设接口，适用于实时控制系统。在本项目中，它作为主控器，负责收集并处理来自各传感器的数据，执行姿态解算算法，并可能将结果输出到显示器或其他设备。借用了b站的这位博主。
HMC5883L通过XCL XDA连接MPU6050
xunshenxun6136的博客
03-17 1141
2、设置 Register（0x37），I2C_BYPASS_EN(0x02) //主控制器的I2C与 MPU6050的AUXI2C 直通。//主控制器的I2C与 MPU6050的AUXI2C 直通。HMC5883L通过XCL\XDA连接到MPU6050，通过I2C无法直接访问HMC5883L，需要配置一下MPU6050的寄存器才能正常访问。1、设置 Register 106（0x6A） ，I2C_MST_EN（0x00）//不让MPU6050 控制AUXI2C；//不让MPU6050 控制AUXI2C。
9轴融合算法mpu6050 hmc5883 kalmanfilter.rar_9轴_HMC5883 _MPU6050_数据融合算
07-13
卡尔曼滤波算法融合9轴传感器（MPU6050 + HMC5883 ） 的原始数据，给出准确的滚转、俯仰和偏航角度信息。
stm32+mpu6050+QMC5883L
04-26
代码基于STM32+GY521mpu6050模块和qmc5883L磁力计可以输出陀螺仪数据，加速度数据，地磁数据，四元数，角度，电子罗盘角度，由于不会算法，还没融合YAW角度，有兴趣的大佬可以融合下
STM32_9轴传感器 MPU6050 +QMC5883
03-31
STM32 9轴控制，输出传感器数据，欧拉角数据，采用MPU6060,QMC5883,注意是QMC不是HMC
STM32+MPU6050+HMC5883L+BMP180姿态解算程序
06-28
STM32+MPU6050+HMC5883L+BMP180驱动测试及姿态解算程序程序
stm32+QMC5883L磁力传感器，可以用来融合校准MPU6050Z轴偏移
04-26
该代码是磁力计stm32控制QMC5883L磁力计输出角度与三个磁力分量，某宝一些标记有hmc5883L模块实际是QMC5883L，输出角度一直是45的可以试一下，你会感谢我的
mpu6050加hmc5883
07-28
- *1* *2* [MPU6050+HMC5883+BMP180+GPS导航系统设计](https://blog.csdn.net/boboelec/article/details/61915378)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_...
stm32f103c8t6 驱动 neo-m8n mpu6050 bmp-280 详细代码
04-23
引用[1]和[2]提到了MPU6050的驱动和DMP库的移植，引用[3]则涉及了MPU6050、HMC5883L和BMP280的三轴姿态解算，但用户现在需要的是Neo-M8N，也就是GPS模块，加上MPU6050和BMP280的组合。 首先，用户可能需要同时使用...
预备篇：一.元器件选型及飞控电路设计
无人机开发
03-30 7904
[深入浅出多旋翼飞控开发]预备篇][一][元器件选型及飞控电路设计] 作者：BlueSky QQ : 352707983 Github 因论坛关闭，迁移该文章至博客。 要让飞控程序跑起来，首先我们得要有一个硬件实体，也就是我们的飞控板。说实话，飞控电路可以很简单，单纯由几个简单的元器件组成，即使是刚学会画PCB的大学生，也能像模像样地设计一款飞控出来。接下来的这个飞控板，暂且命名为天穹V3，也...
评论 5
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值