219 lines
7.0 KiB
C
219 lines
7.0 KiB
C
/*!
|
|
*****************************************************************************
|
|
@file: AD5940Main.c
|
|
@author: Neo Xu
|
|
@brief: Used to control specific application and furfur process data.
|
|
-----------------------------------------------------------------------------
|
|
|
|
Copyright (c) 2017-2019 Analog Devices, Inc. All Rights Reserved.
|
|
|
|
This software is proprietary to Analog Devices, Inc. and its licensors.
|
|
By using this software you agree to the terms of the associated
|
|
Analog Devices Software License Agreement.
|
|
|
|
*****************************************************************************/
|
|
/**
|
|
* @addtogroup AD5940_System_Examples
|
|
* @{
|
|
* @defgroup BioElec_Example
|
|
* @{
|
|
*/
|
|
#include "ad5940.h"
|
|
#include "AD5940.h"
|
|
#include <stdio.h>
|
|
#include "string.h"
|
|
#include "math.h"
|
|
#include "ElectrodermalActivity.h"
|
|
|
|
#define APPBUFF_SIZE 512
|
|
uint32_t AppBuff[APPBUFF_SIZE];
|
|
float LFOSCFreq; /* Measured LFOSC frequency */
|
|
uint32_t ResistorForBaseline = 0;
|
|
|
|
|
|
/* print EDA result to uart */
|
|
AD5940Err EDAShowResult(void *pData, uint32_t DataCount)
|
|
{
|
|
float RtiaMag;
|
|
/*Process data*/
|
|
fImpCar_Type *pImp = (fImpCar_Type*)pData;
|
|
AppEDACtrl(EDACTRL_GETRTIAMAG, &RtiaMag);
|
|
|
|
/*Process data*/
|
|
for(int i=0;i<DataCount;i++)
|
|
{
|
|
float mag, phase;
|
|
fImpCar_Type res;
|
|
res = pImp[i];
|
|
res.Real += ResistorForBaseline; /* Show the real result of impedance under test(between F+/S+) */
|
|
mag = AD5940_ComplexMag(&res);
|
|
phase = AD5940_ComplexPhase(&res)*180/MATH_PI;
|
|
printf("Rtia:%.2f,(Real,Image):(%.2f,%.2f)Ohm---Mag:%.2fOhm,Phase:%.2f`\n",RtiaMag, res.Real, res.Image, mag, phase);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* Initialize AD5940 basic blocks like clock */
|
|
static int32_t AD5940PlatformCfg(void)
|
|
{
|
|
CLKCfg_Type clk_cfg;
|
|
FIFOCfg_Type fifo_cfg;
|
|
SEQCfg_Type seq_cfg;
|
|
AGPIOCfg_Type gpio_cfg;
|
|
LFOSCMeasure_Type LfoscMeasure;
|
|
|
|
/* Use hardware reset */
|
|
AD5940_HWReset();
|
|
/* Platform configuration */
|
|
AD5940_Initialize();
|
|
|
|
/* Step1. Configure clock */
|
|
clk_cfg.ADCClkDiv = ADCCLKDIV_1;
|
|
clk_cfg.ADCCLkSrc = ADCCLKSRC_HFOSC;
|
|
clk_cfg.SysClkDiv = SYSCLKDIV_1;
|
|
clk_cfg.SysClkSrc = SYSCLKSRC_HFOSC;
|
|
clk_cfg.HfOSC32MHzMode = bFALSE;
|
|
clk_cfg.HFOSCEn = bTRUE;
|
|
clk_cfg.HFXTALEn = bFALSE;
|
|
clk_cfg.LFOSCEn = bTRUE;
|
|
AD5940_CLKCfg(&clk_cfg);
|
|
/* Step2. Configure FIFO and Sequencer*/
|
|
fifo_cfg.FIFOEn = bFALSE;
|
|
fifo_cfg.FIFOMode = FIFOMODE_FIFO;
|
|
fifo_cfg.FIFOSize = FIFOSIZE_4KB; /* 4kB for FIFO, The reset 2kB for sequencer */
|
|
fifo_cfg.FIFOSrc = FIFOSRC_DFT;
|
|
fifo_cfg.FIFOThresh = 4;//AppBIACfg.FifoThresh; /* DFT result. One pair for RCAL, another for Rz. One DFT result have real part and imaginary part */
|
|
AD5940_FIFOCfg(&fifo_cfg); /* Disable to reset FIFO. */
|
|
fifo_cfg.FIFOEn = bTRUE;
|
|
AD5940_FIFOCfg(&fifo_cfg); /* Enable FIFO here */
|
|
/* Configure sequencer and stop it */
|
|
seq_cfg.SeqMemSize = SEQMEMSIZE_2KB;
|
|
seq_cfg.SeqBreakEn = bFALSE;
|
|
seq_cfg.SeqIgnoreEn = bFALSE;
|
|
seq_cfg.SeqCntCRCClr = bTRUE;
|
|
seq_cfg.SeqEnable = bFALSE;
|
|
seq_cfg.SeqWrTimer = 0;
|
|
AD5940_SEQCfg(&seq_cfg);
|
|
|
|
/* Step3. Interrupt controller */
|
|
AD5940_INTCCfg(AFEINTC_1, AFEINTSRC_ALLINT, bTRUE); /* Enable all interrupt in Interrupt Controller 1, so we can check INTC flags */
|
|
AD5940_INTCCfg(AFEINTC_0, AFEINTSRC_DATAFIFOTHRESH, bTRUE); /* Interrupt Controller 0 will control GP0 to generate interrupt to MCU */
|
|
AD5940_INTCClrFlag(AFEINTSRC_ALLINT);
|
|
/* Step4: Reconfigure GPIO */
|
|
gpio_cfg.FuncSet = GP6_SYNC|GP5_SYNC|GP4_SYNC|GP2_EXTCLK|GP1_SYNC|GP0_INT;
|
|
gpio_cfg.InputEnSet = AGPIO_Pin2;
|
|
gpio_cfg.OutputEnSet = AGPIO_Pin0|AGPIO_Pin1|AGPIO_Pin4|AGPIO_Pin5|AGPIO_Pin6;
|
|
gpio_cfg.OutVal = 0;
|
|
gpio_cfg.PullEnSet = 0;
|
|
AD5940_AGPIOCfg(&gpio_cfg);
|
|
|
|
AD5940_SleepKeyCtrlS(SLPKEY_UNLOCK); /* Enable AFE to enter sleep mode. */
|
|
|
|
/* Measure LFOSC frequency */
|
|
LfoscMeasure.CalDuration = 1000.0; /* 1000ms used for calibration. */
|
|
LfoscMeasure.CalSeqAddr = 0;
|
|
LfoscMeasure.SystemClkFreq = 16000000.0f; /* 16MHz in this firmware. */
|
|
AD5940_LFOSCMeasure(&LfoscMeasure, &LFOSCFreq);
|
|
printf("Freq:%f\n", LFOSCFreq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
void AD5940EDAStructInit(void)
|
|
{
|
|
AppEDACfg_Type *pCfg;
|
|
|
|
AppEDAGetCfg(&pCfg);
|
|
pCfg->MaxSeqLen = 512;
|
|
|
|
pCfg->LfoscClkFreq = 32000; /* Don't do LFOSC calibration now. We assume the default LFOSC is trimmed. */
|
|
pCfg->RtiaAutoScaleEnable = bTRUE; /* We manually select resistor value. */
|
|
pCfg->LptiaRtiaSel = LPTIARTIA_120K;
|
|
pCfg->SinAmplitude = 1100*3/4; /* Set excitation voltage to 0.75 times of full range. */
|
|
pCfg->SinFreq = 100.0f;
|
|
pCfg->SampleFreq = 400.0f; /* Do not change sample frequency unless you know how it works. */
|
|
pCfg->EDAODR = 4.0f; /* ODR decides how frequently to start the engine to measure impedance. */
|
|
pCfg->FifoThresh = 4; /* The minimum threshold value is 4, and should always be 4*N, where N is 1,2,3... */
|
|
pCfg->bParaChanged = bTRUE;
|
|
}
|
|
|
|
|
|
void AD5940_Main(void)
|
|
{
|
|
uint32_t temp;
|
|
fImpCar_Type EDABase =
|
|
{
|
|
.Real = 24299.84f,
|
|
.Image = -110778.71f,
|
|
};
|
|
|
|
AD5940PlatformCfg();
|
|
|
|
AD5940EDAStructInit(); /* Configure your parameters in this function */
|
|
|
|
AppEDAInit(AppBuff, APPBUFF_SIZE); /* Initialize BIA application. Provide a buffer, which is used to store sequencer commands */
|
|
AppEDACtrl(APPCTRL_START, 0); /* Control BIA measurement to start. Second parameter has no meaning with this command. */
|
|
AppEDACtrl(EDACTRL_SETBASE, &EDABase);
|
|
ResistorForBaseline = 20000; /* Above result is obtained using 20kOhm resistor on BioElec Rev C board. */
|
|
while(1)
|
|
{
|
|
/* Check if interrupt flag which will be set when interrupt occurred. */
|
|
if(AD5940_GetMCUIntFlag())
|
|
{
|
|
AD5940_ClrMCUIntFlag(); /* Clear this flag */
|
|
temp = APPBUFF_SIZE;
|
|
AppEDAISR(AppBuff, &temp); /* Deal with it and provide a buffer to store data we got */
|
|
EDAShowResult(AppBuff, temp); /* Show the results to UART */
|
|
}
|
|
}
|
|
}
|
|
|
|
uint32_t rst_eda_base(uint32_t para1, uint32_t para2)
|
|
{
|
|
printf("Reset EDA impedance baseline\n");
|
|
ResistorForBaseline = 0;
|
|
AppEDACtrl(EDACTRL_RSTBASE, 0);
|
|
return 0;
|
|
}
|
|
|
|
uint32_t set_eda_base(uint32_t para1, uint32_t para2)
|
|
{
|
|
fImpCar_Type ImpAVR;
|
|
printf("Set EDA impedance baseline with current measured impedance average result\n");
|
|
printf("Resistor used to measure baseline is %dOhm\n", para1);
|
|
ResistorForBaseline = para1;
|
|
AppEDACtrl(EDACTRL_GETAVR, &ImpAVR);
|
|
AppEDACtrl(EDACTRL_SETBASE, &ImpAVR);
|
|
return 0;
|
|
}
|
|
|
|
uint32_t get_average_imp(uint32_t para1, uint32_t para2)
|
|
{
|
|
fImpCar_Type ImpAVR;
|
|
printf("Measured average impedance result is:\n");
|
|
AppEDACtrl(EDACTRL_GETAVR, &ImpAVR);
|
|
printf("(Real,Image)=(%.2f,%.2f)Ohm\n", ImpAVR.Real, ImpAVR.Image);
|
|
return 0;
|
|
}
|
|
|
|
uint32_t eda_start(uint32_t para1, uint32_t para2)
|
|
{
|
|
printf("Start EDA measurement\n");
|
|
AppEDACtrl(APPCTRL_START, 0);
|
|
return 0;
|
|
}
|
|
|
|
uint32_t eda_stop(uint32_t para1, uint32_t para2)
|
|
{
|
|
printf("Stop EDA measurement right now!!\n");
|
|
AppEDACtrl(APPCTRL_STOPNOW, 0);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @}
|
|
* @}
|
|
* */
|
|
|