PT32L007F8P7K与QMC5883L IIC通讯代码分享 电子罗盘

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

#include "qmc5883.h"
#include "PT32x007x.h"
#include "string.h"

#define QMC5883_ADDR               (0x1A)//0x0D //0x1a
#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++;
        }
    }
}
//---------------------------------------

/**
* @brief IIC写函数
* @param pBuffer：需要写入的数据
* @param WriteAddr：从机地址
* @param NumByteToWrite：需要写入的数据长度
* @retval 无
*/
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);
//    printf("%s %d\r\n", __func__, __LINE__) ;
    I2C_GenerateEvent(I2C,I2C_Event_Start,ENABLE);    
    while(I2C_GetFlagStatus(I2C,I2C_FLAG_StartOk)!= SET);
    
    I2C_SendAddr(I2C, QMC5883_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);

    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, QMC5883_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, QMC5883_ADDR + 1);//器件地址，读
    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 QMC5883_ReadReg(uint8_t Reg)
{
    u8 RegVal = 0;
    RegVal = Acce_Read_Byte(Reg);
    return RegVal;
}

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

uint8_t QMC5883_InitConfig(void)
{
    uint8_t Temp;
    QMC5883_WriteReg(0x0B, 0x01);
    QMC5883_WriteReg(0x20, 0x40);
    QMC5883_WriteReg(0x21, 0x01);
    QMC5883_WriteReg(0x09, 0x1D);/****OSR=512,RNG=+/-2G,ODR=200Hz,MODE= continuous*******/

    //QMC5883 initial cost a lot time.
    Temp = QMC5883_ReadReg(0x0d);
    printf(" read id=0x%x\r\n", Temp) ;
    while(Temp != 0x1D)
    {
         return 0;
    }
    return Temp;
}

uint8_t QMC5883_GetData(float *Magnet)
{
    uint8_t Buff[6], i;
    uint8_t Temp;

    int16_t MagnetRawAd[3];

    Temp = QMC5883_ReadReg(0x06);

    if(Temp == 0)
    {
        return 0;
    }

    Buff[0] =Acce_Read_Byte(0x00); delay_us(200) ;
    Buff[1] =Acce_Read_Byte(0x01); delay_us(200) ;
    Buff[2] =Acce_Read_Byte(0x02); delay_us(200) ;
    Buff[3] =Acce_Read_Byte(0x03); delay_us(200) ;
    Buff[4] =Acce_Read_Byte(0x04); delay_us(200) ;
    Buff[5] =Acce_Read_Byte(0x05); delay_us(200) ;

    MagnetRawAd[0] = (int16_t)((Buff[1] << 8) | Buff[0]);
    MagnetRawAd[1] = (int16_t)((Buff[3] << 8) | Buff[2]);
    MagnetRawAd[2] = (int16_t)((Buff[5] << 8) | Buff[4]);

//    Magnet[0] = -(float)MagnetRawAd[0] / 12000.f;
//    Magnet[1] = (float)MagnetRawAd[1] / 12000.f;
//    Magnet[2] = -(float)MagnetRawAd[2] / 12000.f;
    
//    Magnet[0] = -(float)MagnetRawAd[0] / 120.f;
//    Magnet[1] = (float)MagnetRawAd[1] / 120.f;
//    Magnet[2] = -(float)MagnetRawAd[2] / 120.f;
    
    Magnet[0] = (float)MagnetRawAd[0] / 30.f;
    Magnet[1] = -(float)MagnetRawAd[1] / 30.f;
    Magnet[2] = -(float)MagnetRawAd[2] / 30.f;
    
    printf("x=%.2f y=%.2f z=%.2f\n", Magnet[0], Magnet[1], Magnet[2]) ;

    return 1;
}