设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › stm32+QMC5883L磁力传感器源程序，可以用来融合校准MPU6 ...
返回列表 发新帖
查看: 6503|回复: 10
打印 上一主题 下一主题
收起左侧

stm32+QMC5883L磁力传感器源程序，可以用来融合校准MPU6050Z轴偏移

  [复制链接]
跳转到指定楼层
楼主
ID:125878 发表于 2019-7-10 10:54 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
该代码是磁力计stm32控制QMC5883L磁力计输出角度与三个磁力分量，某宝一些标记有hmc5883L模块实际是QMC5883L，输出角度一直是45的可以试一下，你会感谢我的

单片机源程序如下:
  1. #include "HMC5883L.h"
  2. #include "I2C.h"
  3. #include "delay.h"
  4. void hmc_write_reg(u8 reg,u8 data)
  5. {
  6.         IIC_Start();
  7.         IIC_Send_Byte(WRITE_ADDRESS);
  8.         IIC_Wait_Ack();
  9.         IIC_Send_Byte(reg);
  10.         IIC_Wait_Ack();
  11.         IIC_Send_Byte(data);
  12.         IIC_Wait_Ack();
  13.         IIC_Stop();
  14.         //delay_ms(5);
  15. }

  17. u8 hmc_read_reg(u8 reg)
  18. {
  19.         u8 data;
  20.         IIC_Start();
  21.         IIC_Send_Byte(WRITE_ADDRESS);
  22.         IIC_Wait_Ack();
  23.         IIC_Send_Byte(reg);
  24.         IIC_Wait_Ack();
  25.         IIC_Stop();
  26.         IIC_Start();
  27.         IIC_Send_Byte(READ_ADDRESS);
  28.         IIC_Wait_Ack();
  29.         data=IIC_Read_Byte();
  30.         IIC_NAck();
  31.         IIC_Stop();
  32.         return data;
  33. }

  35. void hmc_read_XYZ(short int *data)
  36. {
  37. //        u16 temp;
  38. //        temp=hmc_read_reg(DATAX_M);
  39. //        *data++=(temp<<8)+hmc_read_reg(DATAX_L);
  40. //        temp=hmc_read_reg(DATAY_M);
  41. //        *data++=(temp<<8)+hmc_read_reg(DATAY_L);
  42. //        temp=hmc_read_reg(DATAZ_M);
  43. //        *data++=(temp<<8)+hmc_read_reg(DATAZ_L);
  44.         *data++=((int16_t)hmc_read_reg(DATAX_M)<<8)|hmc_read_reg(DATAX_L);
  45.         *data++=((int16_t)hmc_read_reg(DATAY_M)<<8)|hmc_read_reg(DATAY_L);
  46.         *data++=((int16_t)hmc_read_reg(DATAZ_M)<<8)|hmc_read_reg(DATAZ_L);
  47. }

  49. void hmc_init(void)
  50. {
  51.         hmc_write_reg(0X0B,0x01);
  52.         hmc_write_reg(0X20,0x40);
  53.         hmc_write_reg(0X21,0x01);
  54.         hmc_write_reg(CONFIGA,0x1D);
  55.         delay_ms(10);
  56. }

复制代码


  1. #include "stm32f10x.h"
  2. #include "I2C.h"
  3. #include "HMC5883L.h"
  4. #include "delay.h"
  5. #include "math.h"
  6. #include "usart.h"

  8. //连接引脚PA8(SCL)PA11(SDA)

  10. short int data[3];
  11. double angle,x,y,z;
  12. int main(void)
  13. {       
  14.         delay_init();
  15.         i2c_init();
  16.         hmc_init();
  17.         uart_init(115200);
  18.         while(1)
  19.         {
  20.                 hmc_read_XYZ(data);
  21.                 angle=atan2((double)data[0],(double)data[2])*(180 / 3.14159265)+180;
  22.                 x=(double)data[0];
  23.                 y=(double)data[1];
  24.                 z=(double)data[2];
  25.                 printf("%f %f %f %f\r\n",x,y,z,angle);
  26.                 delay_ms(100);
  27.         }
  28. }
复制代码

所有资料51hei提供下载:
STM32F1_QMC5883L.7z (3.13 MB, 下载次数: 292)

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏10 分享淘帖 顶顶2 踩踩
回复

使用道具 举报

沙发
ID:466684 发表于 2019-7-16 10:17 | 只看该作者
谢谢老哥，整了两天看了你的代码终于好了
回复

使用道具 举报

板凳
ID:466684 发表于 2019-7-16 10:19 | 只看该作者
谢谢大佬，两天的调试，宝宝心里的苦，估计只有大佬能感受到
回复

使用道具 举报

地板
ID:625819 发表于 2019-10-17 19:38 | 只看该作者
好资料，51黑有你更精彩!!!
回复

使用道具 举报

5#
ID:660972 发表于 2019-12-10 20:33 | 只看该作者
赚点黑币去下载
回复

使用道具 举报

6#
ID:284786 发表于 2020-10-18 20:33 | 只看该作者
确定能用吗   我怎么读出来都是-1啊
回复

使用道具 举报

7#
ID:855651 发表于 2020-12-16 21:41 | 只看该作者
搞不定，编译后烧写，串口一直输出45，啥原因啊？
回复

使用道具 举报

8#
ID:338306 发表于 2021-3-12 08:50 | 只看该作者
我已经将资料下载下来了，今天测试一下51程序，希望能用，提前感谢楼主了
回复

使用道具 举报

9#
ID:462324 发表于 2021-10-16 19:10 | 只看该作者
BigBen 发表于 2020-12-16 21:41
搞不定，编译后烧写，串口一直输出45，啥原因啊？

我也是这样，你解决了吗？
回复

使用道具 举报

10#
ID:462324 发表于 2021-10-16 19:11 | 只看该作者
怎么读出来是45
回复

使用道具 举报

11#
ID:978679 发表于 2023-2-16 17:20 | 只看该作者
有没有HAL库版本的呀？
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

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