PT32L007F8P7K与QMA6100P IIC通讯代码分享三轴重力加速度传感器

最新推荐文章于 2024-05-22 09:41:10 发布

旭健芯科技

最新推荐文章于 2024-05-22 09:41:10 发布

阅读量686

点赞数 30

文章标签：驱动开发

本文链接：https://blog.csdn.net/weixin_44828904/article/details/137681111

版权

本文详细介绍了MT6701芯片的I2C通信接口驱动函数，包括写入和读取操作，以及MT6813芯片的寄存器读写和零点校准程序，展示了在嵌入式系统中使用这些功能进行传感器数据获取的过程。

摘要由CSDN通过智能技术生成

/**
******************************************************************************
* @file qma6100p.c
* @author Yangzhiqiang@qst
* @version V1.0
* @date 2020-5-27
* @brief qma6100p
******************************************************************************
* @attention
*
*
******************************************************************************
*/

#include "qma6100p.h"
#include "PT32x007x.h"
#include "string.h"

#define MT6701_ADDR (0x0C)
#define fabs(x) (x < 0 ? -x : x)

void delay_us(uint32_t delay)
{
   uint32_t i,j,k;
   for(i=0;i<delay;i++)
   {
       for(j=0;j<100;j++)
       {
           k++;
       }
   }
}
//---------------------------------------

void Acce_Write_Byte(unsigned int WriteAddr, u8 data)
{
//   int i;
/******************等待从机ready***************/
   I2C_GenerateEvent(I2C,I2C_Event_Start,DISABLE);
   I2C->CCR |= I2C_CCR_SI | I2C_CCR_ACK;
   I2C_Cmd(I2C,DISABLE);
   I2C_Cmd(I2C,ENABLE);

   I2C_GenerateEvent(I2C,I2C_Event_Start,ENABLE);
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_StartOk)!= SET);
//   printf("---%s %d---\n", __func__, __LINE__) ;
   I2C_SendAddr(I2C, MT6701_ADDR);//器件地址，写
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_MASGetAckW)!=SET);
   printf("%s %d\r\n", __func__, __LINE__) ;
   I2C_SendData(I2C,WriteAddr);//发送要写的字地址
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_MDSGetAck)!=SET);
//   printf("---%s %d---\n", __func__, __LINE__) ;

I2C_SendData(I2C, data);
while(I2C_GetFlagStatus(I2C,I2C_FLAG_MDSGetAck) != SET);

/******************发送停止位***************/
I2C_GenerateEvent(I2C,I2C_Event_Stop,ENABLE);
}

//uint8_t I2C_EE_Read(u8* pBuffer,u16 ReadAddr, u16 DeviceAddr, u16 data_size)
uint8_t Acce_Read_Byte(u16 ReadAddr)
{
//   int i;
   uint8_t date = 0 ;
/******************等待从机ready***************/
//printf("---%s %d---\n", __func__, __LINE__) ;
   I2C_GenerateEvent(I2C,I2C_Event_Start,ENABLE);
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_StartOk)!= SET);
//   printf("---%s %d---\n", __func__, __LINE__) ;
   I2C_SendAddr(I2C, MT6701_ADDR);//器件地址，写
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_MASGetAckW)!=SET);

   I2C_SendData(I2C,ReadAddr);//发送要读的页地址
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_MDSGetAck)!=SET);

   I2C_GenerateEvent(I2C,I2C_Event_Stop,ENABLE);

/******************接收数据***************/
   I2C_GenerateEvent(I2C,I2C_Event_Start,ENABLE);
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_StartOk)!= SET);

I2C_SendAddr(I2C, MT6701_ADDR|0x01);//器件地址，读
while(I2C_GetFlagStatus(I2C,I2C_FLAG_MASGetAckR)!=SET);

   I2C->CCR=I2C_CCR_ACK|I2C_CCR_SI;//主机发送NACK
   while(I2C_GetFlagStatus(I2C,I2C_FLAG_MDGSendNack) != SET);
   date = I2C_ReceiveData(I2C);

   /******************发送停止位***************/
   I2C_GenerateEvent(I2C,I2C_Event_Stop,ENABLE);

   return date ;
}
//---------------------------------------
uint8_t MT6813_read_reg(uint8_t Reg)
{
   u8 RegVal = 0;
   RegVal = Acce_Read_Byte(Reg);
   return RegVal;
}

void MT6813_write_reg(uint8_t Reg,uint8_t Val)
{
Acce_Write_Byte(Reg, Val);
}

void MT6701_INIT(void)
{
uint8_t Buff[2];

//   Buff[0] = MT6813_read_reg(0x22);
//   if(Buff[0] == 0x60)
//   {
//       printf("RG 0x22=%x\r\n",Buff[0]);
//       return;
//   }

   MT6813_write_reg(0x22, 0x60); //
   delay_us(10) ;
   MT6813_write_reg(0x24, 0x80); //
   delay_us(10) ;
   MT6813_write_reg(0x27, 0xB8);
   delay_us(10) ;

   Buff[0] = MT6813_read_reg(0x22);
   printf("RG 0x22 C=%x\r\n",Buff[0]);

   Buff[0] = MT6813_read_reg(0x24);
   printf("RG 0x24 D=%x\r\n",Buff[0]);

   //save eeprom
   MT6813_write_reg(0x09, 0xB3);
   MT6813_write_reg(0x0A, 0x05);
}

short angle_now;
uint8_t MT6701_GetData(uint8_t *Magnet)
{
   uint8_t Buff[6];
   int data;

   float angle;

   Buff[0] = MT6813_read_reg(0x03);
   Buff[1] = MT6813_read_reg(0x04);

   Magnet[0] = Buff[0];
   Magnet[1] = Buff[1];

   data = (short)((Magnet[0]<<8)|(Magnet[1]));
   data = data>>2;

   angle = (float)(data*0.022);
   if(angle<0)
   {
       angle = 360+angle;
   }

   // if((short)angle != angle_now)
   // {

   //    angle_now = (short)angle;
   //    printf("angle=%d\r\n",angle_now);
   // }

   printf("angle=%.2f\r\n",angle);
   return angle_now;