xiaokaixuan/MoistureSoftware
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
main
MoistureSoftware/Source/AD7190.c

562 lines
16 KiB
C
Raw Permalink Normal View History

首次版本管理远端推送
2025-09-28 09:17:22 +00:00
#include "spi.h"
#include "APPDEF.H"
#include "math.h"
// AD7190<39>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD>
#define AD7190_REG_COMM 0x00 << 3
#define AD7190_REG_STAT 0x00 << 3
#define AD7190_REG_MODE 0x01 << 3
#define AD7190_REG_CONF 0x02 << 3
#define AD7190_REG_DATA 0x03 << 3
#define AD7190_REG_GPOC 0x05 << 3
// AD7190<39><30><EFBFBD><EFBFBD><EEB6A8>
#define AD7190_CMD_NOP 0xFF
#define AD7190_CMD_WR 0x00
#define AD7190_CMD_RD 0x40
// AD7190<39><30><EFBFBD>üĴ<C3BC><C4B4><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
#define AD7190_CONF_CH_MASK 0x000F
#define AD7190_CONF_BURNOUT 0x0800
#define AD7190_CONF_REFSEL 0x0400
#define AD7190_CONF_GAIN_MASK 0x0038
#define AD7190_CONF_MODE_MASK 0x0C00
// AD7190<39><30><EFBFBD>üĴ<C3BC><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD>涨<EFBFBD><E6B6A8>
#define AD7190_CONF_GAIN_1 0x00
#define AD7190_CONF_GAIN_8 0x08
#define AD7190_CONF_GAIN_16 0x10
#define AD7190_CONF_GAIN_32 0x18
#define AD7190_CONF_GAIN_64 0x20
#define AD7190_CONF_GAIN_128 0x28
#define AD7190_CONF_GAIN_256 0x30
// AD7190<39><30><EFBFBD>üĴ<C3BC><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģʽ<C4A3><CABD><EFBFBD><EFBFBD>
#define AD7190_CONF_MODE_CONT 0x000000
#define AD7190_CONF_MODE_ZEROSEL 0x800000
#define AD7190_CONF_MODE_FullSEL 0xA00000
#define AD7190_CONF_MODE_FS9_0 0x0003FF
// AD7190 <20><><EFBFBD>ſ<EFBFBD><C5BF><EFBFBD>
#define AD7190_GPOCON_BDPSW 0x40
void AD7190_WriteRegister(uint8_t regAddr, uint32_t regValue)
{
SPI1_ReadWrite(AD7190_CMD_WR | regAddr);
SPI1_ReadWrite((regValue >> 16) & 0xFF);
SPI1_ReadWrite((regValue >> 8) & 0xFF);
SPI1_ReadWrite(regValue & 0xFF);
}
uint32_t AD7190_ReadRegister(uint8_t regAddr)
{
uint32_t regValue = 0;
SPI1_ReadWrite(AD7190_CMD_RD | regAddr);
regValue = SPI1_ReadWrite(0xFF);
regValue = (regValue << 8) + SPI1_ReadWrite(0xFF);
regValue = (regValue << 8) + SPI1_ReadWrite(0xFF);
return regValue;
}
void AD7190_WriteRegisterOnce(uint8_t regAddr, uint8_t regValue)
{
SPI1_ReadWrite(AD7190_CMD_WR | regAddr);
SPI1_ReadWrite(regValue);
}
uint8_t AD7190_ReadRegisterOnce(uint8_t regAddr)
{
uint32_t regValue = 0;
SPI1_ReadWrite(AD7190_CMD_RD | regAddr);
regValue = SPI1_ReadWrite(0xFF);
return regValue;
}
bool AD7190_WaitForReady(uint32_t timeout)
{
uint32_t count = 0;
// SPI1_ReadWrite(AD7190_CMD_RD | AD7190_REG_STAT);
// while ((SPI1_ReadWrite(0xFF) & 0x80) && (count < timeout)) {
// delay_us(1);
// count++;
// }
while (GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_6) && (count < timeout))
{
delay_us(1);
count++;
}
if (count >= timeout)
{
return false;
}
else
{
return true;
}
}
//extern uint16_t Read_Internal_Temperature();
//// AD7190<39><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȡADת<44><D7AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//float V25 = 1.43; // 25 <20><>ʱ<EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѹ(mV)
// float Avg_Slope = 4.3; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѹ<EFBFBD><D1B9><EFBFBD><EFBFBD>֮<EFBFBD><D6AE><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>б<EFBFBD><D0B1>(mV/<2F><>C)
// // <20><>ȡ ADC <20>ο<EFBFBD><CEBF><EFBFBD>ѹֵ<D1B9><D6B5>һ<EFBFBD><D2BB>Ϊ 3.3V<EFBFBD><EFBFBD>
// float Vref = 3.3; // <20>ο<EFBFBD><CEBF><EFBFBD>ѹֵ(V)
//float TemperatureIn;
uint8_t ErrCount;
uint32_t AD7190_ReadData()
{
uint32_t data = 0;
//uint16_t TempI;
if(AD7190_WaitForReady(50000))
{
data = AD7190_ReadRegister(AD7190_REG_DATA);
// TempI = Read_Internal_Temperature();
// // <20><> ADC ֵת<D6B5><D7AA>Ϊ<EFBFBD><CEAA>ѹֵ
// float V_ADC = (TempI * Vref) / 4095;
// // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD><EFBFBD>϶ȣ<CFB6>
// TemperatureIn = ((V25 - V_ADC)*1000 / Avg_Slope) + 25.0;
if(data > 15000000)
{
ErrCount++;
}
else
{
ErrCount = 0;
}
}
else
{
ErrCount++;
}
if(ErrCount > 10)
{
SPI1_Configuration();
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
osDelay(50);
uint32_t modeReg;
// <20><><EFBFBD>üĴ<C3BC><C4B4><EFBFBD><EFBFBD><EFBFBD>ͨ<EFBFBD><CDA8>ѡ<EFBFBD>񡢲ο<F1A1A2B2><CEBF><EFBFBD>ѹԴ<D1B9><D4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>͹<EFBFBD><CDB9><EFBFBD>ģʽ
// <09><><EFBFBD><EFBFBD>PSW
uint8_t GPOC = AD7190_ReadRegisterOnce(AD7190_REG_GPOC);
GPOC |= AD7190_GPOCON_BDPSW;
AD7190_WriteRegisterOnce(AD7190_REG_GPOC, GPOC);
osDelay(5);
uint32_t config = 0x0000011F;
AD7190_WriteRegister(AD7190_REG_CONF, config);
osDelay(5);
modeReg |= AD7190_CONF_MODE_FS9_0; // <20>˲<EFBFBD><CBB2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
// ִ<><D6B4><EFBFBD>ϵ<EFBFBD>У׼
modeReg = AD7190_ReadRegister(AD7190_REG_MODE);
modeReg &= ~0x00E00000;
modeReg |= AD7190_CONF_MODE_ZEROSEL;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
AD7190_WaitForReady(1000000);
modeReg &= ~0x00E00000;
modeReg |= AD7190_CONF_MODE_FullSEL;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
AD7190_WaitForReady(1000000);
// У׼<D0A3><D7BC><EFBFBD><EFBFBD> <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><D7AA>ģʽ
modeReg = 0x000803FF;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
ErrCount = 0;
osDelay(500);
if(AD7190_WaitForReady(50000))
{
data = AD7190_ReadRegister(AD7190_REG_DATA);
}
}
return data;
}
// AD7190<39><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȡADת<44><D7AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><D7AA>Ϊʵ<CEAA>ʵ<EFBFBD>ѹֵ
// static void bubbleSort2(float *num)
//{
// float temp;
// int i, j;
// for (i = 0; i < 5; i++) {
// for (j = 0; j < 5 - i; j++) {
// if (num[j] > num[j + 1]) {
// // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ص<EFBFBD>ֵ
// temp = num[j];
// num[j] = num[j + 1];
// num[j + 1] = temp;
// }
// }
// }
//} // <20><><EFBFBD>忨<EFBFBD><E5BFA8><EFBFBD><EFBFBD><EFBFBD>˲<EFBFBD><CBB2><EFBFBD><EFBFBD>IJ<EFBFBD><C4B2><EFBFBD><EFBFBD>ṹ<EFBFBD><E1B9B9>
typedef struct
{
float x; // ״̬<D7B4><CCAC><EFBFBD><EFBFBD>ֵ
float P; // ״̬Э<CCAC><D0AD><EFBFBD><EFBFBD>
float Q; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Э<EFBFBD><D0AD><EFBFBD><EFBFBD>
float R; // <20>۲<EFBFBD><DBB2><EFBFBD><EFBFBD><EFBFBD>Э<EFBFBD><D0AD><EFBFBD><EFBFBD>
float K; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
} KalmanFilter;
KalmanFilter kf2;
// <20><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>˲<EFBFBD><CBB2><EFBFBD>
void kalman_filter_init2(KalmanFilter *kf, float initial_x, float initial_P, float process_noise, float measurement_noise)
{
kf->x = initial_x;
kf->P = initial_P;
kf->Q = process_noise;
kf->R = measurement_noise;
}
// <20><><EFBFBD>¿<EFBFBD><C2BF><EFBFBD><EFBFBD><EFBFBD><EFBFBD>˲<EFBFBD><CBB2><EFBFBD>״̬
void kalman_filter_update2(KalmanFilter *kf, float measurement)
{
// Ԥ<>ⲽ<EFBFBD><E2B2BD>
float x_pred = kf->x; // Ԥ<><D4A4><EFBFBD><EFBFBD>״ֵ̬
float P_pred = kf->P + kf->Q; // Ԥ<><D4A4><EFBFBD><EFBFBD>״̬Э<CCAC><D0AD><EFBFBD><EFBFBD>
// <20><><EFBFBD>²<EFBFBD><C2B2><EFBFBD>
kf->K = P_pred / (P_pred + kf->R); // <20><><EFBFBD>㿨<EFBFBD><E3BFA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
kf->x = x_pred + kf->K * (measurement - x_pred); // <20><><EFBFBD><EFBFBD>״̬<D7B4><CCAC><EFBFBD><EFBFBD>ֵ
kf->P = (1 - kf->K) * P_pred; // <20><><EFBFBD><EFBFBD>״̬Э<CCAC><D0AD><EFBFBD><EFBFBD>
}
float WeightData2 = 0.0f;
float ADvalue2filter = 0.0f;
// static float bufferdata2[5];
// static float dataout2[5];
static float WeightData2Temp = 0.0f;
int32_t ADvalue2filterOld = 0;
int32_t ADvalue2 = 0;
uint8_t ic2 = 0;
uint8_t i;
int32_t data2 = 0;
struct uCalibrateWeight CalibrateWeight2;
uint8_t FollowCount = 0;
uint8_t TimeCount = 0;
int32_t WeightZeroOld = 0;
uint32_t modeRega;
uint32_t configa;
uint32_t configao;
bool weightChanging = false;
#include "APPDEF.H"
void AD7190_Run(const void *p_arg)
{
osDelay(600);
ADvalue2 = AD7190_ReadData();
osDelay(200);
ADvalue2 = AD7190_ReadData();
ADvalue2filterOld = ADvalue2filter = ADvalue2;
kalman_filter_init2(&kf2, ADvalue2, 1.0, 0.001, 0.1);
WeightZeroOld = CalibrateWeight2.WeightZero;
uint8_t FilterQOld, SensorQOld, ZeroTrackOld, RuBianLiangOld, ruBianTimeOld;
int8_t RubianLiang, RubianTime;
float ZeroTrackTime, ZeroTrackRange;
for (;;)
{
if (FilterQOld != Set.FilterQ)
{
FilterQOld = Set.FilterQ;
switch (Set.FilterQ) // <20>˲<EFBFBD><CBB2><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ζ<EFBFBD> <20><><EFBFBD>ζ<EFBFBD>Խ<EFBFBD><D4BD> <20><>ӦԽ<D3A6><D4BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʾԽ<CABE>ȶ<EFBFBD>
{
case 0:
kf2.Q = 0.1;
break;
case 1:
kf2.Q = 0.08;
break;
case 2:
kf2.Q = 0.06;
break;
case 3:
kf2.Q = 0.04;
break;
case 4:
kf2.Q = 0.02;
break;
case 5:
kf2.Q = 0.009;
break;
case 6:
kf2.Q = 0.007;
break;
case 7:
kf2.Q = 0.005;
break;
case 8:
kf2.Q = 0.003;
break;
case 9:
kf2.Q = 0.001;
break;
default:
break;
}
}
if (SensorQOld != Set.SensorQ)
{
SensorQOld = Set.SensorQ;
switch (Set.SensorQ) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ζ<EFBFBD> <20><><EFBFBD>ζ<EFBFBD>Խ<EFBFBD><D4BD> <20><>ӦԽѸ<D4BD>٣<EFBFBD><D9A3><EFBFBD><EFBFBD>ݲ<EFBFBD><DDB2><EFBFBD>Խ<EFBFBD><D4BD> <20><>ʾԽ<CABE><D4BD><EFBFBD>ȶ<EFBFBD>
{
case 0:
kf2.R = 0.5;
break;
case 1:
kf2.R = 0.3;
break;
case 2:
kf2.R = 0.1;
break;
case 3:
kf2.R = 0.08;
break;
case 4:
kf2.R = 0.06;
break;
case 5:
kf2.R = 0.04;
break;
case 6:
kf2.R = 0.02;
break;
case 7:
kf2.R = 0.009;
break;
case 8:
kf2.R = 0.005;
break;
case 9:
kf2.R = 0.001;
break;
default:
break;
}
}
if (ZeroTrackOld != Set.ZeroTrack) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD>ټ<EFBFBD><D9BC><EFBFBD>Խ<EFBFBD><D4BD> ԭʼ<D4AD><CABC><EFBFBD>ݷ<EFBFBD><DDB7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>仯ʱ<E4BBAF><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD><DDB2>ᷢ<EFBFBD><E1B7A2><EFBFBD>仯<EFBFBD>Ŀ<EFBFBD><C4BF><EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD><D4BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD>ټ<EFBFBD><D9BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ9ʱ<39><CAB1><EFBFBD><EFBFBD>ô<EFBFBD><C3B4><EFBFBD><EFBFBD>ԭʼ<D4AD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD>4<EFBFBD><34><EFBFBD>ڱ仯С<E4BBAF><D0A1>2.5mg<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ô<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD><EFBFBD>ᷢ<EFBFBD><EFBFBD><EFBFBD>仯<EFBFBD><EFBFBD>ԭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>cpu<EFBFBD>Ὣ<EFBFBD><EFBFBD>4<EFBFBD><EFBFBD><EFBFBD>ڱ仯<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݵ<EFBFBD><EFBFBD>ӵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϣ<EFBFBD><EFBFBD>൱<EFBFBD>ڶ<EFBFBD>̬<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ˡ<EFBFBD>
{
ZeroTrackOld = Set.ZeroTrack;
switch (ZeroTrackOld)
{
case 0:
ZeroTrackTime = 20;
ZeroTrackRange = 0;
break;
case 1:
ZeroTrackTime = 15;
ZeroTrackRange = 0.0005;
break;
case 2:
ZeroTrackTime = 10;
ZeroTrackRange = 0.0005;
break;
case 3:
ZeroTrackTime = 7;
ZeroTrackRange = 0.0005;
break;
case 4:
ZeroTrackTime = 4;
ZeroTrackRange = 0.0005;
break;
case 5:
ZeroTrackTime = 4;
ZeroTrackRange = 0.0008;
break;
case 6:
ZeroTrackTime = 4;
ZeroTrackRange = 0.001;
break;
case 7:
ZeroTrackTime = 4;
ZeroTrackRange = 0.0015;
break;
case 8:
ZeroTrackTime = 4;
ZeroTrackRange = 0.002;
break;
case 9:
ZeroTrackTime = 4;
ZeroTrackRange = 0.0025;
break;
default:
break;
}
}
if (ruBianTimeOld != Set.RuBianTime) // <20><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1> <20><><EFBFBD><EFBFBD>Խ<EFBFBD><D4BD> <20><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>Խ<EFBFBD>̣<EFBFBD><CCA3><EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD><D4BD> <20><>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
ruBianTimeOld = Set.RuBianTime;
switch (Set.RuBianTime)
{
case 0:
RubianTime = 100;
break;
case 1:
RubianTime = 60;
break;
case 2:
RubianTime = 30;
break;
case 3:
RubianTime = 20;
break;
case 4:
RubianTime = 15;
break;
case 5:
RubianTime = 10;
break;
case 6:
RubianTime = 8;
break;
case 7:
RubianTime = 6;
break;
case 8:
RubianTime = 4;
break;
case 9:
RubianTime = 2;
break;
default:
break;
}
}
if (RuBianLiangOld != Set.RuBianLiang) //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20>ɷ<EFBFBD><C9B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͷ<EFBFBD><CDB7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ0ʱ <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>۲<EFBFBD>һ<EFBFBD><D2BB>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݱ仯 <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD><EFBFBD>仯Ϊ<E4BBAF><CEAA><EFBFBD><EFBFBD> <20><>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD>䡣<EFBFBD><E4A1A3>֮Ϊ<D6AE><CEAA><EFBFBD><EFBFBD><EFBFBD>䡣 <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>𣨽<EFBFBD><F0A3A8BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD>鲻<EFBFBD><E9B2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
RuBianLiangOld = Set.RuBianLiang;
switch (Set.RuBianLiang)
{
case 0:
RubianLiang = -5;
break;
case 1:
RubianLiang = -4;
break;
case 2:
RubianLiang = -3;
break;
case 3:
RubianLiang = -2;
break;
case 4:
RubianLiang = -1;
break;
case 5:
RubianLiang = 0;
break;
case 6:
RubianLiang = 1;
break;
case 7:
RubianLiang = 2;
break;
case 8:
RubianLiang = 3;
break;
case 9:
RubianLiang = 4;
break;
case 10:
RubianLiang = 5;
break;
default:
break;
}
}
osDelay(190);
ADvalue2 = AD7190_ReadData();
kalman_filter_update2(&kf2, ADvalue2); // <20><><EFBFBD>²<EFBFBD><C2B2><EFBFBD>
ADvalue2filter = kf2.x;
WeightData2Temp = CalibrateWeight2.WeightSlope * ((int32_t)ADvalue2filter - (int32_t)CalibrateWeight2.WeightZero);
if( RubianLiang != 0 )
{
if (TimeCount++ > 4 * RubianTime) // <20><>̬<EFBFBD><CCAC><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
TimeCount = 0;
if (CalibrateWeight2.WeightZero == WeightZeroOld)
{
CalibrateWeight2.WeightZero += RubianLiang;
}
WeightZeroOld = CalibrateWeight2.WeightZero;
}
}
if (fabs(WeightData2 - WeightData2Temp) < ZeroTrackRange)
{
if (FollowCount++ > 4 * ZeroTrackTime) // <20><><EFBFBD>㶯̬<E3B6AF><CCAC><EFBFBD><EFBFBD>
{
FollowCount = 0;
TimeCount = 0;
CalibrateWeight2.WeightZero += ADvalue2filter - ADvalue2filterOld;
ADvalue2filterOld = ADvalue2filter;
}
}
else
{
FollowCount = 0;
ADvalue2filterOld = ADvalue2filter;
}
if (fabs(WeightData2 - WeightData2Temp) > 0.01f)
{
weightChanging = 1;
}
else
{
weightChanging = 0;
}
if (fabs(WeightData2 - WeightData2Temp) > 0.001f) // <20><><EFBFBD><EFBFBD><EFBFBD>˲<EFBFBD>
{
WeightData2Temp = (int32_t)(WeightData2Temp * 10000) / 10000.0f;
WeightData2 = WeightData2Temp;
}
}
}
osThreadDef(AD7190_Run, osPriorityNormal, 1, 0);
// AD7190<39><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʼ<EFBFBD><CABC>AD7190
void AD7190_Init()
{
SPI1_Configuration();
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
SPI1_ReadWrite(0xFF);
osDelay(50);
uint32_t modeReg;
// <20><><EFBFBD>üĴ<C3BC><C4B4><EFBFBD><EFBFBD><EFBFBD>ͨ<EFBFBD><CDA8>ѡ<EFBFBD>񡢲ο<F1A1A2B2><CEBF><EFBFBD>ѹԴ<D1B9><D4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>͹<EFBFBD><CDB9><EFBFBD>ģʽ
// <09><><EFBFBD><EFBFBD>PSW
uint8_t GPOC = AD7190_ReadRegisterOnce(AD7190_REG_GPOC);
GPOC |= AD7190_GPOCON_BDPSW;
AD7190_WriteRegisterOnce(AD7190_REG_GPOC, GPOC);
osDelay(5);
uint32_t config = 0x0000011F;
AD7190_WriteRegister(AD7190_REG_CONF, config);
osDelay(5);
modeReg |= AD7190_CONF_MODE_FS9_0; // <20>˲<EFBFBD><CBB2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
// ִ<><D6B4><EFBFBD>ϵ<EFBFBD>У׼
modeReg = AD7190_ReadRegister(AD7190_REG_MODE);
modeReg &= ~0x00E00000;
modeReg |= AD7190_CONF_MODE_ZEROSEL;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
AD7190_WaitForReady(1000000);
modeReg &= ~0x00E00000;
modeReg |= AD7190_CONF_MODE_FullSEL;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
osDelay(5);
AD7190_WaitForReady(1000000);
// У׼<D0A3><D7BC><EFBFBD><EFBFBD> <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><D7AA>ģʽ
modeReg = 0x000803FF;
AD7190_WriteRegister(AD7190_REG_MODE, modeReg);
CalibrateWeight2.WeightSlope = 0.0000818f;
CalibrateWeight2.WeightZero = 745430;
osThreadCreate(osThread(AD7190_Run), NULL);
}
Reference in New Issue Copy Permalink