基于STM32的三轴数字罗盘HMC5883L模块的测试方案

基于STM32的三轴数字罗盘HMC5883L模块的测试方案,第1张

  最近买了个数字罗盘模块,调通后发现很不错,非常灵敏,测试的时候精度在1°以内。连续测量模式下,最快测量、输出速率可达75hz,模块每次测量完毕并将数据更新至寄存器后,其DRDY引脚便产生一个低电平脉冲(可以配置一个外部中断捕获DRDY引脚的下降沿,并在中断服务程序中读取数据),在STM32中可以设置一个下降沿触发的外部中断,并在中断服务程序中调用角度数据读取函数。以下为 *** 作该模块的主要步骤。

  一、IIC协议相关 *** 作(单片机作为主机控制时钟线)

  宏定义:

  //这里用到了STM32的位带区 *** 作,方便实现对一个位的 *** 作

  //PB13配置为OD输出,同时外部给上拉电阻,这样既可输出信号给从机,也能

  //在PB13为漏极开路状态时接收从机的信号(STM32的IO配置为输出模式时,

  //IO口的电平也会不断地被捕获到输入寄存器中)

  //PB14配置为推挽输出,PB15配置为浮空输入

  #defineR_SDAIPB13//PB13输入寄存器

  #defineW_SDAOPB13//PB13输出寄存器

  #defineW_SCLOPB14//PB14输出寄存器

  #defineR_DRDYIPB15//PB15输入寄存器

  #defineXmsb0//X轴数字量的高8位

  #defineXlsb1//X轴数字量的低8位

  #defineZmsb2//Z轴数字量的高8位

  #defineZlsb3//Z轴数字量的低8位

  #defineYmsb4//Y轴数字量的高8位

  #defineYlsb5//Y轴数字量的低8位

  附位带宏定义:

  #defineGPIOB_ODR_Addr(GPIOB_BASE+12)//0x40010C0C

  #defineGPIOB_IDR_Addr(GPIOB_BASE+8)//0x40010C08

  #defineBITBAND_Addr(Addr,num)((volaTIleunsignedlong*)(0x42000000+32*(Addr-0x40000000)+4*num))

  #defineIPB13*BITBAND_Addr(GPIOB_IDR_Addr,13)

  #defineOPB13*BITBAND_Addr(GPIOB_ODR_Addr,13)

  #defineOPB14*BITBAND_Addr(GPIOB_ODR_Addr,14)

  #defineIPB15*BITBAND_Addr(GPIOB_IDR_Addr,15)

  启动IIC传输:

  void_iic_Start()

  {

  W_SCL=1;

  W_SDA=1;

  _delay();

  W_SDA=0;//SCL高时,拉低SDA,表示开始IIC传输,占用总线

  _delay();

  W_SCL=0;//控制SCL

  _delay();

  }

  停止IIC传输:

  void_iic_Stop()

  {

  W_SCL=1;//释放SCL(由于没有其他主器件,SCL无需开漏)

  W_SDA=0;

  发送一个字节:

  uint8_t_iic_SendByte(uint8_tdat)

  {

  uint8_TI;

  for(i=0;i《8;i++)

  {

  _delay();

  W_SDA=dat》》7;//SCL拉高之前写SDA

  dat=dat《《1;

  _delay();

  W_SCL=1;//拉高SCL,从器件开始读取SDA

  _delay();

  W_SCL=0;//重新拉低SCL

  }

  W_SDA=1;//释放SDA

  W_SCL=1;//拉高SCL,读取从器件应答信号

  //等待应答

  i=100;

  while(i&&R_SDA){i--;_delay();}

  if(i==0)//无应答

  {

  W_SCL=0;//重新拉低SCL

  return0;

  }

  else{//有应答

  _delay();

  W_SCL=0;//重新拉低SCL

  return1;

  }

  }

  _delay();

  W_SDA=1;//SCL为高时,拉高SDA表示结束ICC传输,释放总线

  }

  接收一个字节:

  uint8_t_iic_ReadByte(uint8_tAck)

  {

  uint8_ttemp,i;

  W_SDA=1;//释放SDA

  _delay();

  for(i=0;i《8;i++)

  {

  _delay();

  W_SCL=1;//拉高SCL开始读取SDA

  temp=temp《《1;

  temp|=R_SDA;//SCL拉高之后读取SDA

  W_SCL=0;//拉低SCL,从器件开始放置数据

  }

  //发送应答信号

  if(Ack)W_SDA=0;//拉低SDA表示应答

  W_SCL=1;//拉高SCL,从器件接收应答信号

  _delay();

  W_SCL=0;//重新拉低SCL

  W_SDA=1;//释放SDA

  returntemp;

  }

  二、配置HMC5883L模块

  voidHMC5883L_Init()

  {

  _iic_Start();

  _iic_SendByte(0x3c);//写 *** 作

  _iic_SendByte(0x00);//指针指向00,配置寄存器A

  _iic_SendByte(0x78);//数据测量、输出速率75hz

  _iic_Start();//指针定位到02,模式寄存器

  _iic_SendByte(0x3c);

  _iic_SendByte(0x02);

  _iic_SendByte(0x00);//连续测量模式

  _iic_Stop();

  }

  三、读取角度数据

  接收三轴数据,处理X,Y轴的数据并计算角度:

  int16_tHMC5883L_ReadAngle()

  {

  staTIcuint8_TI;

  staticuint8_tXYZ_Data[6];//用来存储三个轴输出的数字量

  _iic_Start();

  _iic_SendByte(0x3c);//发送HMC5883L的器件地址0x3c,写 *** 作

  _iic_SendByte(0x03);//指针指向03,Xmsb寄存器

  _iic_Start();

  _iic_SendByte(0x3d);//改为读 *** 作

  //依次读取三个轴的数字量

  for(i=0;i《5;i++)//前5次读取发送应答信号

  {

  XYZ_Data[i]=_iic_ReadByte(1);

  }

  XYZ_Data[5]=_iic_ReadByte(0);//不应答

  _iic_Stop();

  returnatan2((double)((int16_t)((XYZ_Data[Ymsb]《《8)+XYZ_Data[Ylsb])),(double)((int16_t)((XYZ_Data[Xmsb]《《8)+XYZ_Data[Xlsb])))*(180/3.14159265)+180;//计算角度,需要包含math.h头文件

  }

  配置好IO口,调用HMC5883L_Init()后,便可调用HMC5883L_ReadAngle()读取角度值,0~360°。以下为测试时的截图:

基于STM32的三轴数字罗盘HMC5883L模块的测试方案,基于STM32的三轴数字罗盘HMC5883L模块的测试方案,第2张

  测试时,模块比较灵敏且精确,稍微旋转模块便有精确的变化。由于该模块是基于对地磁场的测量,此模块容易受到其他磁场的干扰,比如将该模块靠近直流电机时,便会因为电机内的磁场而降低精度甚至失灵(之前做智能小车时就遇到这个问题,要将电机内的磁场屏蔽起来才行)。

欢迎分享,转载请注明来源:内存溢出

原文地址: http://outofmemory.cn/dianzi/2664814.html

(0)
打赏 微信扫一扫 微信扫一扫 支付宝扫一扫 支付宝扫一扫
上一篇 2022-08-13
下一篇 2022-08-13

发表评论

登录后才能评论

评论列表(0条)

保存