Compare commits
3 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 5fb9e0cf38 | |||
| fbc74b1e47 | |||
| e18f9f13bf |
+61
-61
@@ -1,3 +1,64 @@
|
|||||||
|
# ---> uVision
|
||||||
|
# git ignore file for Keil µVision Project
|
||||||
|
|
||||||
|
# µVision 5 and µVision 4 Project screen layout file
|
||||||
|
*.uvguix.*
|
||||||
|
*.uvgui.*
|
||||||
|
|
||||||
|
# Listing Files
|
||||||
|
*.i
|
||||||
|
*.lst
|
||||||
|
*.m51
|
||||||
|
*.m66
|
||||||
|
*.map
|
||||||
|
|
||||||
|
# Object Files
|
||||||
|
*.axf
|
||||||
|
*.b[0-2][0-9]
|
||||||
|
*.b3[0-1]
|
||||||
|
*.bak
|
||||||
|
*.build_log.htm
|
||||||
|
*.crf
|
||||||
|
*.d
|
||||||
|
*.dep
|
||||||
|
*.elf
|
||||||
|
*.htm
|
||||||
|
*.iex
|
||||||
|
*.lnp
|
||||||
|
*.o
|
||||||
|
*.obj
|
||||||
|
*.sbr
|
||||||
|
|
||||||
|
# Firmware Files
|
||||||
|
*.bin
|
||||||
|
*.h86
|
||||||
|
*.hex
|
||||||
|
|
||||||
|
# Build Files
|
||||||
|
.bat
|
||||||
|
|
||||||
|
# Debugger Files
|
||||||
|
.ini
|
||||||
|
|
||||||
|
# JLink Files
|
||||||
|
JLinkLog.txt
|
||||||
|
|
||||||
|
# Other Files
|
||||||
|
|
||||||
|
# ---> VisualStudioCode
|
||||||
|
.vscode/*
|
||||||
|
!.vscode/settings.json
|
||||||
|
!.vscode/tasks.json
|
||||||
|
!.vscode/launch.json
|
||||||
|
!.vscode/extensions.json
|
||||||
|
!.vscode/*.code-snippets
|
||||||
|
|
||||||
|
# Local History for Visual Studio Code
|
||||||
|
.history/
|
||||||
|
|
||||||
|
# Built Visual Studio Code Extensions
|
||||||
|
*.vsix
|
||||||
|
|
||||||
# ---> IAR
|
# ---> IAR
|
||||||
# Compiled binaries
|
# Compiled binaries
|
||||||
*.o
|
*.o
|
||||||
@@ -67,64 +128,3 @@ EWARM/**/Exe
|
|||||||
# Autogenerated folder for debugger
|
# Autogenerated folder for debugger
|
||||||
EWARM/settings
|
EWARM/settings
|
||||||
|
|
||||||
# ---> uVision
|
|
||||||
# git ignore file for Keil µVision Project
|
|
||||||
|
|
||||||
# µVision 5 and µVision 4 Project screen layout file
|
|
||||||
*.uvguix.*
|
|
||||||
*.uvgui.*
|
|
||||||
|
|
||||||
# Listing Files
|
|
||||||
*.i
|
|
||||||
*.lst
|
|
||||||
*.m51
|
|
||||||
*.m66
|
|
||||||
*.map
|
|
||||||
|
|
||||||
# Object Files
|
|
||||||
*.axf
|
|
||||||
*.b[0-2][0-9]
|
|
||||||
*.b3[0-1]
|
|
||||||
*.bak
|
|
||||||
*.build_log.htm
|
|
||||||
*.crf
|
|
||||||
*.d
|
|
||||||
*.dep
|
|
||||||
*.elf
|
|
||||||
*.htm
|
|
||||||
*.iex
|
|
||||||
*.lnp
|
|
||||||
*.o
|
|
||||||
*.obj
|
|
||||||
*.sbr
|
|
||||||
|
|
||||||
# Firmware Files
|
|
||||||
*.bin
|
|
||||||
*.h86
|
|
||||||
*.hex
|
|
||||||
|
|
||||||
# Build Files
|
|
||||||
.bat
|
|
||||||
|
|
||||||
# Debugger Files
|
|
||||||
.ini
|
|
||||||
|
|
||||||
# JLink Files
|
|
||||||
JLinkLog.txt
|
|
||||||
|
|
||||||
# Other Files
|
|
||||||
|
|
||||||
# ---> VisualStudioCode
|
|
||||||
.vscode/*
|
|
||||||
!.vscode/settings.json
|
|
||||||
!.vscode/tasks.json
|
|
||||||
!.vscode/launch.json
|
|
||||||
!.vscode/extensions.json
|
|
||||||
!.vscode/*.code-snippets
|
|
||||||
|
|
||||||
# Local History for Visual Studio Code
|
|
||||||
.history/
|
|
||||||
|
|
||||||
# Built Visual Studio Code Extensions
|
|
||||||
*.vsix
|
|
||||||
|
|
||||||
|
|||||||
@@ -0,0 +1,344 @@
|
|||||||
|
#include "main.h"
|
||||||
|
#include "mmc5983.h"
|
||||||
|
#include "UartDebug.h"
|
||||||
|
#include "i2c.h"
|
||||||
|
#include "Algorithm.h"
|
||||||
|
//test
|
||||||
|
|
||||||
|
static int32_t max_in[XYZ];
|
||||||
|
static int32_t min_in[XYZ];
|
||||||
|
static bool InitFlag;
|
||||||
|
static bool MMC5983IntFlag;
|
||||||
|
static MMC5983Var_t MMC5983Var;
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Write_Reg
|
||||||
|
* 功能描述: MMC5983写寄存器
|
||||||
|
* 参 数: reg 寄存器地址
|
||||||
|
val 寄存器数据
|
||||||
|
* 返 回 值: 成功返回true,失败返回false
|
||||||
|
*****************************************************************************************/
|
||||||
|
static bool MMC5983_Write_Reg(uint8_t reg, uint8_t val)
|
||||||
|
{
|
||||||
|
return I2C_MasterWriteData(M0P_I2C0, MMC5983_ADDRESS, reg, &val, 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Read_Reg
|
||||||
|
* 功能描述: MMC5983读寄存器
|
||||||
|
* 参 数: reg 寄存器地址
|
||||||
|
* 返 回 值: 返回寄存器值
|
||||||
|
*****************************************************************************************/
|
||||||
|
static uint8_t MMC5983_Read_Reg(uint8_t reg)
|
||||||
|
{
|
||||||
|
uint8_t res;
|
||||||
|
if(I2C_MasterReadData(M0P_I2C0, MMC5983_ADDRESS, reg, &res, 1) == false)
|
||||||
|
res = 0;
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Read_Buffer
|
||||||
|
* 功能描述: MMC5983读数据
|
||||||
|
* 参 数: reg 寄存器地址
|
||||||
|
buffer 读取数据输出缓存入口
|
||||||
|
len 读取长度
|
||||||
|
* 返 回 值: 成功返回true,失败返回false
|
||||||
|
*****************************************************************************************/
|
||||||
|
static bool MMC5983_Read_Buffer(uint8_t reg, void *buffer, uint8_t len)
|
||||||
|
{
|
||||||
|
return I2C_MasterReadData(M0P_I2C0, MMC5983_ADDRESS, reg, buffer, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983StartCov
|
||||||
|
* 功能描述: MMC5983开启连续转换
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
static void MMC5983StartCov(void)
|
||||||
|
{
|
||||||
|
MMC5983RegCtrl2 Ctrl2Reg; //开启/关闭连续转换
|
||||||
|
Ctrl2Reg.Byte = 0x00;
|
||||||
|
Ctrl2Reg.Bit.Cm_freq = 0x04;
|
||||||
|
Ctrl2Reg.Bit.Cmm_en = 1; //连续设1,单次设0
|
||||||
|
Ctrl2Reg.Bit.Prd_set = 3;
|
||||||
|
Ctrl2Reg.Bit.En_prd_set = 1; //连续设1,单次设0
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_2, Ctrl2Reg.Byte);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Init
|
||||||
|
* 功能描述: MMC5983初始化
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
static void MMC5983_Init(void)
|
||||||
|
{
|
||||||
|
uint8_t id;
|
||||||
|
|
||||||
|
id = MMC5983_Read_Reg(MMC5983_ID);
|
||||||
|
//DBG_LOG("MMC5983 id=0x%x\r\n",id);
|
||||||
|
MMC5983Var.MMC5983Delay1mSCnt = 100;
|
||||||
|
while(id != 0x30){
|
||||||
|
if(MMC5983Var.MMC5983Delay1mSCnt <= 0) {
|
||||||
|
DBG_LOG("LEFT MMC5983 INIT Err...\r\n");
|
||||||
|
InitFlag = false;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
MMC5983RegCtrl1 Ctrl1Reg;
|
||||||
|
Ctrl1Reg.Byte = 0x00;
|
||||||
|
Ctrl1Reg.Bit.SW_RST = 1;
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_1, Ctrl1Reg.Byte);
|
||||||
|
MMC5983Delay(15);
|
||||||
|
|
||||||
|
MMC5983RegCtrl2 Ctrl2Reg; //开启/关闭连续转换
|
||||||
|
Ctrl2Reg.Byte = 0x00;
|
||||||
|
Ctrl2Reg.Bit.Cm_freq = 0x04;
|
||||||
|
Ctrl2Reg.Bit.Cmm_en = 0; //连续设1,单次设0
|
||||||
|
Ctrl2Reg.Bit.Prd_set = 3;
|
||||||
|
Ctrl2Reg.Bit.En_prd_set = 0; //连续设1,单次设0
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_2, Ctrl2Reg.Byte);
|
||||||
|
|
||||||
|
MMC5983RegCtrl3 Ctrl3Reg;
|
||||||
|
Ctrl3Reg.Byte = 0x00;
|
||||||
|
Ctrl3Reg.Bit.St_enm = 1;
|
||||||
|
Ctrl3Reg.Bit.St_enp = 1;
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_3, Ctrl3Reg.Byte);
|
||||||
|
|
||||||
|
MMC5983RegCtrl0 Ctrl0Reg;
|
||||||
|
Ctrl0Reg.Byte = 0x00;
|
||||||
|
Ctrl0Reg.Bit.TM_M = 1;
|
||||||
|
Ctrl0Reg.Bit.Auto_SR_en = 1;
|
||||||
|
Ctrl0Reg.Bit.NT_meas_done_en = 1;
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_0, Ctrl0Reg.Byte);
|
||||||
|
|
||||||
|
if(InitFlag == false){
|
||||||
|
DBG_LOG("MMC5983 INIT OK...\r\n");
|
||||||
|
InitFlag = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Read
|
||||||
|
* 功能描述: MMC5983读取原始数据
|
||||||
|
* 参 数: MagAdcX X轴数据
|
||||||
|
MagAdcY Y轴数据
|
||||||
|
MagAdcZ Z轴数据
|
||||||
|
* 返 回 值: 成功返回true,失败返回false
|
||||||
|
*****************************************************************************************/
|
||||||
|
static bool MMC5983_Read(int32_t *MagAdcX, int32_t *MagAdcY, int32_t *MagAdcZ)
|
||||||
|
{
|
||||||
|
static uint8_t buff[7];
|
||||||
|
|
||||||
|
if (MMC5983_Read_Buffer(MMC5983_X_OUT_H, buff, 7) == false)
|
||||||
|
return false;
|
||||||
|
|
||||||
|
*MagAdcX = (buff[0] << 10) | (buff[1] << 2) | ((buff[6] & 0xC0) >> 6);
|
||||||
|
*MagAdcY = (buff[2] << 10) | (buff[3] << 2) | ((buff[6] & 0x30) >> 4);
|
||||||
|
*MagAdcZ = (buff[4] << 10) | (buff[5] << 2) | ((buff[6] & 0x0C) >> 2);// Turn the 18 bits into unsigned 32-bit value
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983_Get_Mag
|
||||||
|
* 功能描述: 外部获取MMC5983磁场强度数据
|
||||||
|
* 参 数: mag 读取数据输出缓存入口
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983_Get_Mag(float *mag)
|
||||||
|
{
|
||||||
|
if(mag == NULL)
|
||||||
|
return;
|
||||||
|
|
||||||
|
float ADVal[XYZ];
|
||||||
|
|
||||||
|
ADVal[X] = MMC5983Var.Mag_Original[X] - 131072.0f;
|
||||||
|
ADVal[Y] = MMC5983Var.Mag_Original[Y] - 131072.0f;
|
||||||
|
ADVal[Z] = MMC5983Var.Mag_Original[Z] - 131072.0f;
|
||||||
|
|
||||||
|
mag[0] = (float) (ADVal[X] * MMC5983_MAG_SCALE_18BIT);
|
||||||
|
mag[1] = (float) (ADVal[Y] * MMC5983_MAG_SCALE_18BIT);
|
||||||
|
mag[2] = (float) (ADVal[Z] * MMC5983_MAG_SCALE_18BIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983LoopHandler
|
||||||
|
* 功能描述: MMC5983循环处理函数
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
extern void MmcDataProcessCallBack(float *Mag);
|
||||||
|
|
||||||
|
void MMC5983LoopHandler(void)
|
||||||
|
{
|
||||||
|
static int32_t mag_array[XYZ][10];
|
||||||
|
static uint8_t magcnt;
|
||||||
|
static uint8_t TimeOutMagcnt;
|
||||||
|
|
||||||
|
switch(MMC5983Var.Status) {
|
||||||
|
case MMC5983_STATUS_IDLE:{
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_START:{
|
||||||
|
for(int i = 0; i < 10; i++) {
|
||||||
|
mag_array[X][i] = 0;
|
||||||
|
mag_array[Y][i] = 0;
|
||||||
|
mag_array[Z][i] = 0;
|
||||||
|
}
|
||||||
|
magcnt = 0;
|
||||||
|
TimeOutMagcnt = 0;
|
||||||
|
memset(&MMC5983Var, NULL, sizeof(MMC5983Var));
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_DELAY;
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_DELAY:{
|
||||||
|
MMC5983StartRead();
|
||||||
|
MMC5983Var.MMC5983Delay1mSCnt = 50;
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_WAIT_DELAY;
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_WAIT_DELAY:{
|
||||||
|
if(MMC5983Var.MMC5983Delay1mSCnt <= 0){
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_READ;
|
||||||
|
}
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_READ:{
|
||||||
|
MMC5983Var.MMC5983Delay1mSCnt = 50;
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_WAIT_READ;
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_WAIT_READ:{
|
||||||
|
if(MMC5983Var.MMC5983Delay1mSCnt <= 0){
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_DELAY;
|
||||||
|
TimeOutMagcnt++;
|
||||||
|
}
|
||||||
|
if(MMC5983IntFlag == true){
|
||||||
|
MMC5983IntFlag = false;
|
||||||
|
MMC5983_Read(&mag_array[X][magcnt], &mag_array[Y][magcnt], &mag_array[Z][magcnt]);
|
||||||
|
magcnt++;
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_DELAY;
|
||||||
|
}
|
||||||
|
if(TimeOutMagcnt >= 10){
|
||||||
|
TimeOutMagcnt = 0;
|
||||||
|
if(magcnt > 0){
|
||||||
|
MMC5983Var.Mag_Original[X] = AverageFilter_32t(mag_array[X], magcnt);
|
||||||
|
MMC5983Var.Mag_Original[Y] = AverageFilter_32t(mag_array[Y], magcnt);
|
||||||
|
MMC5983Var.Mag_Original[Z] = AverageFilter_32t(mag_array[Z], magcnt);
|
||||||
|
magcnt = 0;
|
||||||
|
MMC5983_Get_Mag(MMC5983Var.Mag);
|
||||||
|
MmcDataProcessCallBack(MMC5983Var.Mag);
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_STOP;
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_STOP;
|
||||||
|
// DBG_LOG("LEFT MMC5983 TimeOut...\r\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if(magcnt >= 10){
|
||||||
|
MMC5983Var.Mag_Original[X] = AverageFilter_32t(mag_array[X], magcnt);
|
||||||
|
MMC5983Var.Mag_Original[Y] = AverageFilter_32t(mag_array[Y], magcnt);
|
||||||
|
MMC5983Var.Mag_Original[Z] = AverageFilter_32t(mag_array[Z], magcnt);
|
||||||
|
magcnt = 0;
|
||||||
|
MMC5983_Get_Mag(MMC5983Var.Mag);
|
||||||
|
MmcDataProcessCallBack(MMC5983Var.Mag);
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_STOP;
|
||||||
|
}
|
||||||
|
break;}
|
||||||
|
|
||||||
|
case MMC5983_STATUS_STOP:{
|
||||||
|
MMC5983Stop();
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_IDLE;
|
||||||
|
//MMC5983Var.Status = MMC5983_STATUS_START;//持续工作
|
||||||
|
break;}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: LeftMMC59831mSRoutine
|
||||||
|
* 功能描述: MMC59831ms时基循环处理函数
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC59831mSRoutine(void)
|
||||||
|
{
|
||||||
|
if(MMC5983Var.MMC5983Delay1mSCnt > 0)
|
||||||
|
MMC5983Var.MMC5983Delay1mSCnt--;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: LeftMMC5983Init
|
||||||
|
* 功能描述: MMC5983初始化
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983Init(void)
|
||||||
|
{
|
||||||
|
if(!InitFlag){
|
||||||
|
MMC5983_Init();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_START;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: LeftMMC5983Start
|
||||||
|
* 功能描述: MMC5983启动
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983Start(void)
|
||||||
|
{
|
||||||
|
if(!InitFlag){
|
||||||
|
MMC5983_Init();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
MMC5983Var.Status = MMC5983_STATUS_START;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: LeftMMC5983StartRead
|
||||||
|
* 功能描述: MMC5983启动读取
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983StartRead(void)
|
||||||
|
{
|
||||||
|
MMC5983_Init();//读取时重新初始化
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: MMC5983Stop
|
||||||
|
* 功能描述: MMC5983停止
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983Stop(void)
|
||||||
|
{
|
||||||
|
MMC5983RegCtrl0 Ctrl0Reg;
|
||||||
|
Ctrl0Reg.Byte = 0x00;
|
||||||
|
MMC5983_Write_Reg(MMC5983_CTRL_0, Ctrl0Reg.Byte);
|
||||||
|
|
||||||
|
MMC5983RegStatus StatusReg;
|
||||||
|
StatusReg.Byte = MMC5983_Read_Reg(MMC5983_STATUS);
|
||||||
|
if(StatusReg.Bit.Meas_M_Done == 1){
|
||||||
|
MMC5983_Write_Reg(MMC5983_STATUS, StatusReg.Byte);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************************
|
||||||
|
* 函数名称: LeftMMC5983IntCallBack
|
||||||
|
* 功能描述: MMC5983中断回调
|
||||||
|
* 参 数: 无
|
||||||
|
* 返 回 值: 无
|
||||||
|
*****************************************************************************************/
|
||||||
|
void MMC5983IntCallBack(void)
|
||||||
|
{
|
||||||
|
MMC5983IntFlag = true;
|
||||||
|
}
|
||||||
|
|
||||||
@@ -0,0 +1,140 @@
|
|||||||
|
/**
|
||||||
|
*****************************************************************************
|
||||||
|
* @file ak8975.h
|
||||||
|
* @author WWJ
|
||||||
|
* @version v1.0
|
||||||
|
* @date 2019/04/09
|
||||||
|
* @environment stm32f407
|
||||||
|
* @brief
|
||||||
|
*****************************************************************************
|
||||||
|
**/
|
||||||
|
|
||||||
|
#ifndef _MMC5983_H
|
||||||
|
#define _MMC5983_H
|
||||||
|
#include "bsp.h"
|
||||||
|
|
||||||
|
#define X 0
|
||||||
|
#define Y 1
|
||||||
|
#define Z 2
|
||||||
|
#define XYZ 3
|
||||||
|
|
||||||
|
#define MAX(A, B) (A > B) ? A : B;
|
||||||
|
#define MIN(A, B) (A < B) ? A : B;
|
||||||
|
|
||||||
|
#define MMC5983_X_OUT_H 0X00 //Device ID = 0x48
|
||||||
|
#define MMC5983_X_OUT_L 0X01
|
||||||
|
#define MMC5983_Y_OUT_H 0X02
|
||||||
|
#define MMC5983_Y_OUT_L 0X03
|
||||||
|
#define MMC5983_Z_OUT_H 0X04
|
||||||
|
#define MMC5983_Z_OUT_L 0X05
|
||||||
|
#define MMC5983_XYZ_OUT 0X06
|
||||||
|
#define MMC5983_TMP_OUT 0X07
|
||||||
|
#define MMC5983_STATUS 0X08
|
||||||
|
#define MMC5983_CTRL_0 0X09
|
||||||
|
#define MMC5983_CTRL_1 0X0A
|
||||||
|
#define MMC5983_CTRL_2 0X0B
|
||||||
|
#define MMC5983_CTRL_3 0X0C
|
||||||
|
#define MMC5983_ID 0X2F
|
||||||
|
|
||||||
|
#define MMC5983_ADDRESS 0x30
|
||||||
|
#define MMC5983_MAG_SCALE_16BIT 0.24414f
|
||||||
|
#define MMC5983_MAG_SCALE_18BIT 0.061035f
|
||||||
|
|
||||||
|
#define MMC5983Delay(x) delay_ms(x)
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
uint8_t Meas_M_Done: 1;
|
||||||
|
uint8_t Meas_T_Done: 1;
|
||||||
|
uint8_t Res0: 2;
|
||||||
|
uint8_t OTP_Read_Done: 1;
|
||||||
|
uint8_t Res1: 3;
|
||||||
|
}Bit;
|
||||||
|
uint8_t Byte;
|
||||||
|
}MMC5983RegStatus;
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
uint8_t TM_M: 1;
|
||||||
|
uint8_t TM_T: 1;
|
||||||
|
uint8_t NT_meas_done_en: 1;
|
||||||
|
uint8_t Set: 1;
|
||||||
|
uint8_t Reset: 1;
|
||||||
|
uint8_t Auto_SR_en: 1;
|
||||||
|
uint8_t OTP_Read: 1;
|
||||||
|
uint8_t Res0: 1;
|
||||||
|
}Bit;
|
||||||
|
uint8_t Byte;
|
||||||
|
}MMC5983RegCtrl0;
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
uint8_t BW: 2;
|
||||||
|
uint8_t X_Inhibit: 1;
|
||||||
|
uint8_t YZ_Inhibit: 2;
|
||||||
|
uint8_t Res0: 2;
|
||||||
|
uint8_t SW_RST: 1;
|
||||||
|
}Bit;
|
||||||
|
uint8_t Byte;
|
||||||
|
}MMC5983RegCtrl1;
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
uint8_t Cm_freq: 3;
|
||||||
|
uint8_t Cmm_en: 1;
|
||||||
|
uint8_t Prd_set: 3;
|
||||||
|
uint8_t En_prd_set: 1;
|
||||||
|
}Bit;
|
||||||
|
uint8_t Byte;
|
||||||
|
}MMC5983RegCtrl2;
|
||||||
|
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
uint8_t Res0: 1;
|
||||||
|
uint8_t St_enp: 1;
|
||||||
|
uint8_t St_enm: 1;
|
||||||
|
uint8_t Res1: 3;
|
||||||
|
uint8_t Spi_3w: 1;
|
||||||
|
uint8_t Res2: 1;
|
||||||
|
}Bit;
|
||||||
|
uint8_t Byte;
|
||||||
|
}MMC5983RegCtrl3;
|
||||||
|
|
||||||
|
typedef enum{
|
||||||
|
MMC5983_STATUS_IDLE,
|
||||||
|
MMC5983_STATUS_START,
|
||||||
|
MMC5983_STATUS_DELAY,
|
||||||
|
MMC5983_STATUS_WAIT_DELAY,
|
||||||
|
MMC5983_STATUS_READ,
|
||||||
|
MMC5983_STATUS_WAIT_READ,
|
||||||
|
MMC5983_STATUS_STOP,
|
||||||
|
}MMC5983Status_m;
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
MMC5983Status_m Status;
|
||||||
|
uint16_t MMC5983Delay1mSCnt;
|
||||||
|
float Mag[3];
|
||||||
|
int32_t Mag_Original[XYZ];
|
||||||
|
}MMC5983Var_t;
|
||||||
|
|
||||||
|
void MMC5983LoopHandler(void);
|
||||||
|
void MMC59831mSRoutine(void);
|
||||||
|
void MMC5983Init(void);
|
||||||
|
void MMC5983Start(void);
|
||||||
|
void MMC5983Stop(void);
|
||||||
|
void MMC5983IntCallBack(void);
|
||||||
|
|
||||||
|
void MMC5983Calib(void);
|
||||||
|
void MMC5983GetADValue(int32_t *Mag);
|
||||||
|
void MMC5983_Get_Mag(float *mag);
|
||||||
|
MMC5983Status_m GetMMC5983Status(void);
|
||||||
|
void MMC5983StartRead(void);
|
||||||
|
bool GetMMC5983CalibStatus(void);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* end of ak8975.h */
|
||||||
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user