luguangmeng/CELIS
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
3d88ee1152
CELIS/SYSTEM/adc.c

546 lines
15 KiB
C
Raw Normal View History

完成UDS升级 Signed-off-by: lidun <1084178170@qq.com>
2024-01-30 03:31:27 +00:00
#include "adc.h"
#include "usart.h"
#include "stm32f10x_adc.h"
#include "stm32f10x_rcc.h"
#include "stm32f10x_dma.h"
#include "GUNDiscriminate.h"
#define SIZE 10
#define debug 1
// <20><><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD><EFBFBD>ΪMovingAverage<67>Ľṹ<C4BD>壬<EFBFBD><E5A3AC><EFBFBD>ڴ洢<DAB4><E6B4A2><EFBFBD>е<EFBFBD><D0B5><EFBFBD>Ϣ,δʹ<CEB4><CAB9>
typedef struct {
float queue[SIZE]; // <20>洢<EFBFBD><E6B4A2><EFBFBD><EFBFBD>Ԫ<EFBFBD>ص<EFBFBD><D8B5><EFBFBD><EFBFBD><EFBFBD>
int front; // <20><><EFBFBD>е<EFBFBD>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
int rear; // <20><><EFBFBD>еĺ<D0B5><C4BA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
int itemCount; // <20><><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
float sum; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ص<EFBFBD><D8B5>ܺ<EFBFBD>
float min; // <20><><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD><D0B5><EFBFBD>СԪ<D0A1><D4AA>
float max; // <20><><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD><D0B5><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD><D4AA>
} MovingAverage;
// <20><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
MovingAverage ma = {.front = 0, .rear = -1, .itemCount = 0, .sum = 0, .min = 3.4e+38f, .max = 1.2e-38f};
static uint32_t GetR_ValueNew(float AD_Value);
typedef struct
{
int count;
int count_DC;
int count_AC;
int filter_adc;
float container;
int mode;
double Res;
}ADCMode;
ADCMode Sadcmode={0,0,0,0,0,0,0};
__IO uint16_t AD_Value[AD_NUM];
static void enqueue(float data);
static double findAverage() ;
static double calculateMovingAverage(float new_value) ;
work_mode ADCtoMode(void);
work_mode GUNCheck = Normal_operation;
void Adc_Init()
{
GPIO_InitTypeDef GPIO_InitStructure;
ADC_InitTypeDef ADC_InitStruct;
DMA_InitTypeDef DMA_InitStructure;
RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE); //ʹ<><CAB9>MDA1ʱ<31><CAB1>
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC|RCC_APB2Periph_ADC1|RCC_APB2Periph_AFIO,ENABLE); //ʹ<><CAB9>ADC1ͨ<31><CDA8>ʱ<EFBFBD><CAB1>
RCC_ADCCLKConfig(RCC_PCLK2_Div6); //<2F><><EFBFBD><EFBFBD>ADC<44><43>Ƶ<EFBFBD><C6B5><EFBFBD><EFBFBD>6 72M/6=12,ADC<44><43><EFBFBD><EFBFBD>ʱ<EFBFBD>䲻<EFBFBD>ܳ<EFBFBD><DCB3><EFBFBD>14M
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_3|GPIO_Pin_4|GPIO_Pin_5;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN; //GPIO<49><4F><EFBFBD><EFBFBD>Ϊģ<CEAA><C4A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
GPIO_Init(GPIOC, &GPIO_InitStructure);
ADC_InitStruct.ADC_Mode = ADC_Mode_Independent;//<2F><><EFBFBD><EFBFBD>ģʽ
ADC_InitStruct.ADC_DataAlign = ADC_DataAlign_Right;//<2F>Ҷ<EFBFBD><D2B6><EFBFBD>
ADC_InitStruct.ADC_ExternalTrigConv = ADC_ExternalTrigConv_None; //ת<><D7AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ⲿ<EFBFBD><E2B2BF><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
ADC_InitStruct.ADC_ContinuousConvMode = ENABLE;//<2F><><EFBFBD><EFBFBD>ת<EFBFBD><D7AA>
ADC_InitStruct.ADC_NbrOfChannel = AD_NUM;
ADC_InitStruct.ADC_ScanConvMode = ENABLE;//<2F><>ͨ<EFBFBD><CDA8>
ADC_Init(ADC1,&ADC_InitStruct);
ADC_RegularChannelConfig(ADC1, ADC_Channel_10, 1, ADC_SampleTime_55Cycles5); //ͨ<><CDA8>1<EFBFBD><31><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>55.5<EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
ADC_RegularChannelConfig(ADC1, ADC_Channel_13, 2, ADC_SampleTime_55Cycles5); //ͨ<><CDA8>1<EFBFBD><31><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>55.5<EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
ADC_RegularChannelConfig(ADC1, ADC_Channel_14, 3, ADC_SampleTime_55Cycles5); //ͨ<><CDA8>1<EFBFBD><31><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>55.5<EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
ADC_RegularChannelConfig(ADC1, ADC_Channel_15, 4, ADC_SampleTime_55Cycles5); //ͨ<><CDA8>1<EFBFBD><31><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>55.5<EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_PeripheralBaseAddr = (uint32_t)&ADC1->DR;//<2F><><EFBFBD><EFBFBD><EFBFBD>洢<EFBFBD><E6B4A2><EFBFBD><EFBFBD>ַ
DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;//<2F><><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;//<2F><>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_MemoryBaseAddr = (uint32_t)AD_Value;//ת<>Ƶ<EFBFBD>ַ
DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord;//<2F><><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable;//<2F><>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralSRC;//<2F><><EFBFBD>䷽<EFBFBD><E4B7BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>-SRAM
DMA_InitStructure.DMA_BufferSize = AD_NUM;
DMA_InitStructure.DMA_Mode = DMA_Mode_Circular;//<2F>Զ<EFBFBD><D4B6><EFBFBD>װ<EFBFBD><D7B0>ֵ
DMA_InitStructure.DMA_M2M = DMA_M2M_Disable;//Ӳ<><D3B2><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
DMA_InitStructure.DMA_Priority = DMA_Priority_Medium;//<2F><><EFBFBD>ȼ<EFBFBD>
DMA_Init(DMA1_Channel1, &DMA_InitStructure);
DMA_Cmd(DMA1_Channel1, ENABLE);//ʹ<><CAB9>ͨ<EFBFBD><CDA8>һ
ADC_DMACmd(ADC1, ENABLE);//ʹ<><CAB9>ADC<44><43>DMA
ADC_Cmd(ADC1, ENABLE); //ʹ<><CAB9>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD>ADC1
ADC_ResetCalibration(ADC1); //ʹ<>ܸ<EFBFBD>λУ׼
while(ADC_GetResetCalibrationStatus(ADC1)); //<2F>ȴ<EFBFBD><C8B4><EFBFBD>λУ׼<D0A3><D7BC><EFBFBD><EFBFBD>
ADC_StartCalibration(ADC1); //<2F><><EFBFBD><EFBFBD>ADУ׼
while(ADC_GetCalibrationStatus(ADC1)); //<2F>ȴ<EFBFBD>У׼<D0A3><D7BC><EFBFBD><EFBFBD>
ADC_SoftwareStartConvCmd(ADC1, ENABLE); //ʹ<><CAB9>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD>ADC1<43><31><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><D7AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
}
const TempRes_TypeDef Temp_R_List[] =
{
{-40,318.406},{-39,298.823},{-38,280.326},{-37,262.967},
{-36,246.740},{-35,231.604},{-34,217.500},{-33,204.359},
{-32,192.109},{-31,180.684},{-30,170.017},{-29,160.049},
{-28,150.727},{-27,142.001},{-26,133.827},{-25,126.165},
{-24,118.980},{-23,112.237},{-22,105.909},{-21,99.9666},
{-20,94.3861},{-19,89.1441},{-18,84.2191},{-17,79.5912},
{-16,75.2417},{-15,71.1534},{-14,67.3099},{-13,63.6959},
{-12,60.2969},{-11,57.0996},{-10,54.0912},{-9 ,51.2599},
{-8 ,48.5945},{-7, 46.0844},{-6 ,43.7200},{-5 ,41.4919},
{-4 ,39.3916},{-3 ,37.4110},{-2 ,35.5426},{-1, 33.7793},
{0 ,32.1146},{1 ,30.5423},{2 ,29.0568},{3 ,27.6525},
{4 ,26.3247},{5 ,25.0685},{6 ,23.8798},{7 ,22.7543},
{8 ,21.6884},{9 ,20.6785},{10 ,19.7213},{11 ,18.8137},
{12 ,17.9529},{13 ,17.1362},{14 ,16.3611},{15 ,15.6251},
{16 ,14.9262},{17 ,14.2623},{18 ,13.6313},{19 ,13.0316},
{20 ,12.4613},{21 ,11.9190},{22 ,11.4031},{23 ,10.9121},
{24 ,10.4449},{25 ,10.0000},{26 ,9.57638},{27 ,9.17289},
{28 ,8.78847},{29 ,8.42215},{30 ,8.07300},{31 ,7.74013},
{32 ,7.42271},{33 ,7.11995},{34 ,6.83113},{35 ,6.55553},
{36 ,6.29249},{37 ,6.04139},{38 ,5.80162},{39 ,5.57263},
{40 ,5.35389},{41 ,5.14488},{42 ,4.94514},{43 ,4.75421},
{44 ,4.57166},{45 ,4.39708},{46 ,4.23009},{47 ,4.07032},
{48 ,3.91743},{49 ,3.77108},{50 ,3.63097},{51 ,3.49680},
{52 ,3.36829},{53 ,3.24517},{54 ,3.12719},{55 ,3.01411},
{56 ,2.90571},{57 ,2.80175},{58 ,2.70205},{59 ,2.60641},
{60 ,2.51463},{61 ,2.42655},{62 ,2.34200},{63 ,2.26081},
{64 ,2.18285},{65 ,2.10795},{66 ,2.03600},{67 ,1.96685},
{68 ,1.90039},{69 ,1.83649},{70 ,1.77506},{71 ,1.71597},
{72 ,1.65913},{73 ,1.60444},{74 ,1.55181},{75 ,1.50116},
{76 ,1.45240},{77 ,1.40544},{78 ,1.36023},{79 ,1.31667},
{80 ,1.27472},{81 ,1.23429},{82 ,1.19533},{83 ,1.15778},
{84 ,1.12158},{85 ,1.08667},{86 ,1.05301},{87 ,1.02055},
{88 ,0.98923},{89 ,0.95901},{90 ,0.92986},{91 ,0.90172},
{92 ,0.87456},{93 ,0.84834},{94 ,0.82303},{95 ,0.79859},
{96 ,0.77498},{97 ,0.75218},{98 ,0.73015},{99 ,0.70886},
{100,0.68830},{101,0.66842},{102,0.64921},{103,0.63064},
{104,0.61269},{105,0.59533},{106,0.57854},{107,0.56230},
{108,0.54659},{109,0.53139},{110,0.51669},{111,0.50246},
{112,0.48869},{113,0.47536},{114,0.46246},{115,0.44997},
{116,0.43787},{117,0.42616},{118,0.41481},{119,0.40382},
{120,0.39317},{121,0.38286},{122,0.37286},{123,0.36317},
{124,0.35377},{125,0.34467},
} ;
static uint16_t Temp_R_Num = sizeof(Temp_R_List) / sizeof(TempRes_TypeDef);
int16_t FindTemperature(float r_value)
{
uint16_t high = Temp_R_Num-1;
uint16_t low = 0,mid =0;
if( (r_value < Temp_R_List[high].R_Value) || (r_value > Temp_R_List[low].R_Value) )
return 0xFFF; //
while (low <= high)
{
mid = (low + high)/2;
if (r_value > Temp_R_List[mid].R_Value)
{
high = mid - 1; //<2F><><EFBFBD><EFBFBD>
//low = mid+1; //<2F><><EFBFBD><EFBFBD>
}
else if (r_value < Temp_R_List[mid].R_Value)
{
low = mid+1;
//high = mid - 1;
}
else
{
return Temp_R_List[mid].TemperatureValue;
}
}
return Temp_R_List[low].TemperatureValue;
}
Volt_sampldata Volt_SamplData;
Filter_variable Filter_Variable[AD_NUM];
void CC_Voltage_Sampl(void);
void TEMP1_Voltage_Sampl(void);
void GUN_TEMP_Sampl(void);
void KL30_Voltage_Sampl(void);
uint8_t Get_TEMP1(void);
uint8_t Get_GUN_TEMP(void);
uint16_t Get_KL30_Volt(void);
work_mode Get_WorkMode(void);
get_sampl_data Get_Sampl_Data = {
.Resistance_Value=0,
.TEMP1=Get_TEMP1,
.GUN_TEMP=Get_GUN_TEMP,
.KL30_Volt=Get_KL30_Volt,
.WorkMode=Get_WorkMode,
};
sampl_funtion Sampl_Funtion = {
.CC_Voltag=CC_Voltage_Sampl,
.TEMP1_Voltage=TEMP1_Voltage_Sampl,
.GUN_TEMP=GUN_TEMP_Sampl,
.KL30_Voltage=KL30_Voltage_Sampl,
};
void Voltage_Filter(uint16_t AD_Value,uint8_t sub,float *data)
{
if(Filter_Variable[sub].Flag)
{
if(Filter_Variable[sub].Sum!=0)
{
Filter_Variable[sub].Sum/=20;
Filter_Variable[sub].volt_data=Filter_Variable[sub].Sum*3.3/4096;
*data=Filter_Variable[sub].volt_data;
}
Filter_Variable[sub].Sum=0;
Filter_Variable[sub].Flag=0;
}
else
{
Filter_Variable[sub].Count++;
Filter_Variable[sub].Sum+=AD_Value;
if(Filter_Variable[sub].Count==20)
{
Filter_Variable[sub].Flag=1;
Filter_Variable[sub].Count=0;
}
}
}
void TEMP1_Voltage_Sampl()
{
static float data;
uint16_t value=AD_Value[ADC_TEMP1];
Voltage_Filter(value,ADC_TEMP1,&data);
Volt_SamplData.TEMP1_Data=FindTemperature(4.9/data);
}
void KL30_Voltage_Sampl()
{
static float data;
uint16_t value=AD_Value[VIN_AD];
Voltage_Filter(value,CC_AD,&data);
Volt_SamplData.KL30_Volt = data*11;
}
void GUN_TEMP_Sampl()
{
static float data;
uint16_t value=AD_Value[TEMPL_AD];
Voltage_Filter(value,TEMPL_AD,&data);
Volt_SamplData.GUN_TempData=FindTemperature(4.9/data);
}
static uint32_t value1_z;
static uint32_t value1_v;
static uint32_t value1_flg;
static uint32_t value1_sum;
static float r;
static int mode = 0;
static int flag = 0;
void CC_Voltage_Sampl()
{
static float data;
uint16_t value=AD_Value[CC_AD];
uint16_t value1,sum;
value1 = AD_Value[CC_AD];
// printf("value1=%d\r\n",value1);
if(value1_flg)
{
value1_z = value1_z /60;
value1_v = 33000 / 4096 * value1_z;
Volt_SamplData.CC_Volt = (float)value1_v / 10000;
// printf("R %f\r\n",Volt_SamplData.CC_Volt);
// r = (7.0f*Volt_SamplData.CC_Volt*1.022/(20.0f-7.0f*Volt_SamplData.CC_Volt*1.022))*0.9414226;
// GUNCheck = ADCtoMode();
// printf("value=%.5f r=%.5f mode=%d\r\n",Volt_SamplData.CC_Volt,r,mode);
value1_flg = 0;
value1_z = 0;
value1_v = 0;
}
else
{
if(value1_sum < 60)
{
value1_z += value1;
value1_sum++;
}
else
{
value1_sum = 0;
value1_flg = 1;
}
}
}
uint8_t Get_TEMP1()
{
return Volt_SamplData.TEMP1_Data;
}
uint8_t Get_GUN_TEMP()
{
return Volt_SamplData.GUN_TempData;
}
uint16_t Get_KL30_Volt()
{
return Volt_SamplData.KL30_Volt;//ADS1015<31><35><EFBFBD><EFBFBD>
}
work_mode last_Stat_work = Normal_operation;
work_mode This_State_work = Normal_operation;
enum GUNState SUMStateLast = NO_GUN;
work_mode Get_WorkMode()
{
return This_State_work;
}
void Scan_work(void)
{
static uint32_t GUNFLAGCount = 0;
enum GUNState GUNState= Get_R_GUNState(Get_R_Value());
work_mode SUMState = Normal_operation;
if( GUNState == AC_GUN)
{
SUMState = AC_Charging;
}
else if( (GUNState == DC_adapter)|| (GUNState == DC_GUN))
{
SUMState = DC_Charging;
}
else
{
SUMState = Normal_operation;
}
if(SUMState != last_Stat_work)
{
GUNFLAGCount = 0;
last_Stat_work = SUMState;
}
else if(SUMState == This_State_work)
{
GUNFLAGCount = 0;
}
else
{
GUNFLAGCount++;
if(GUNFLAGCount >= 2)
{
This_State_work = last_Stat_work;
SUMStateLast = GUNState;
GUNFLAGCount = 0;
}
}
}
/*<2A><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ADCtoMode
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><EFBFBD>ö<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> work_mode<EFBFBD><EFBFBD>0<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> 1<EFBFBD><EFBFBD>ֱ<EFBFBD><EFBFBD> 3<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̣<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ǰ40<EFBFBD><EFBFBD>adc<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2.335V<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>5<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊһ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>䣬2.3080~2.335<EFBFBD><EFBFBD>4.5~5<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><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><EFBFBD><EFBFBD>жϣ<EFBFBD>
<EFBFBD>ж<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>3<EFBFBD><EFBFBD><EFBFBD><EFBFBD>0-2.1Ϊ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>4.5<EFBFBD><EFBFBD>4.3<EFBFBD><EFBFBD>-5.1<EFBFBD><EFBFBD>5.2<EFBFBD><EFBFBD>Ϊֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><0<EFBFBD><EFBFBD><EFBFBD><EFBFBD>2.1-4.5<EFBFBD><EFBFBD>4.3<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>>5.1<EFBFBD><EFBFBD>5.2<EFBFBD><EFBFBD>Ϊδ<EFBFBD><EFBFBD>ǹ
<EFBFBD>ж<EFBFBD><EFBFBD><EFBFBD>ֱ<EFBFBD><EFBFBD>ģʽ*/
work_mode ADCtoMode(void)
{
if(Volt_SamplData.CC_Volt>2.335)
{
// r = (7.0f*Volt_SamplData.CC_Volt*1.0256/(20.0f-7.0f*Volt_SamplData.CC_Volt*1.0256))*0.9523809;
r = (7.0f*Volt_SamplData.CC_Volt/(20.0f-7.0f*Volt_SamplData.CC_Volt))*0.9523809;
}
else if(Volt_SamplData.CC_Volt>2.3080 &&Volt_SamplData.CC_Volt<2.335)
{
// r = (7.0f*Volt_SamplData.CC_Volt*1.022/(20.0f-7.0f*Volt_SamplData.CC_Volt*1.022))*0.9414226;
r = (7.0f*Volt_SamplData.CC_Volt/(20.0f-7.0f*Volt_SamplData.CC_Volt))*0.9414226;
}
else
{
r = (7.0f*Volt_SamplData.CC_Volt/(20.0f-7.0f*Volt_SamplData.CC_Volt));
}
Get_Sampl_Data.Resistance_Value = r;
// Sadcmode.Res = calculateMovingAverage(r);
if(r>4.3&&r<=5.5)
{
Sadcmode.count_DC++;
Sadcmode.count_AC = 0;
}
else if(r<=2.1&&r>=0.05)
{
Sadcmode.count_AC++;
Sadcmode.count_DC = 0;
}
if((r>2.1&&r<4.0)||r>5.2||r<0.05)
{
mode = 0;
return Normal_operation ;
}
if(Sadcmode.count_DC > 20 || Sadcmode.count_AC > 20)
{
if(Sadcmode.count_DC > 20)
{
Sadcmode.count_DC = 0;
mode = 2;
return DC_Charging ;
}
if(Sadcmode.count_AC > 20)
{
Sadcmode.count_AC = 0;
mode = 1;
return AC_Charging ;
}
}
return Normal_operation ;
}
float Get_R_Value(void)
{
float CC_CC2Vol = Volt_SamplData.CC_Volt;
CC_CC2Vol = (Volt_SamplData.CC_Volt*5.1f)/(5.0f-Volt_SamplData.CC_Volt)+0.12f;
CC_CC2Vol = (10.0*CC_CC2Vol)/(10.0-CC_CC2Vol);
Get_Sampl_Data.Resistance_Value = CC_CC2Vol;
return CC_CC2Vol;
}
/*ȡƽ<C8A1><C6BD><EFBFBD><EFBFBD>ֵ<EFBFBD>㷨<EFBFBD><E3B7A8>δʹ<CEB4><CAB9>*/
// <20><><EFBFBD><EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD>ӵ<EFBFBD><D3B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>еĺ<D0B5><C4BA><EFBFBD>
void enqueue(float data) {
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(ma.itemCount == SIZE){
// <20><><EFBFBD>ܺ<EFBFBD><DCBA>м<EFBFBD>ȥ<EFBFBD><C8A5><EFBFBD><EFBFBD>ǰ<EFBFBD>˵<EFBFBD>Ԫ<EFBFBD><D4AA>
ma.sum -= ma.queue[ma.front];
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ǰ<EFBFBD>˵<EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Сֵ<D0A1><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Сֵ<D0A1><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ
if(ma.queue[ma.front] == ma.min) {
ma.min = 3.4e+38f;
}
if(ma.queue[ma.front] == ma.max) {
ma.max = 1.2e-38f;
}
// ǰ<><C7B0><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ǰ<EFBFBD>ƶ<EFBFBD>һλ
ma.front++;
// <20><><EFBFBD><EFBFBD>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>ĩβ<C4A9><CEB2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ0
if(ma.front == SIZE) {
ma.front = 0;
}
// Ԫ<><D4AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
ma.itemCount--;
}
// <20><><EFBFBD><EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD>ӵ<EFBFBD><D3B5><EFBFBD><EFBFBD>еĺ<D0B5><C4BA><EFBFBD>
ma.queue[ma.rear] = data;
// <20><><EFBFBD><EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD>ӵ<EFBFBD><D3B5>ܺ<EFBFBD><DCBA><EFBFBD>
ma.sum += data;
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD><D4AA>С<EFBFBD><D0A1><EFBFBD><EFBFBD>Сֵ<D0A1><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Сֵ
if(data < ma.min) {
ma.min = data;
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ش<EFBFBD><D8B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ
if(data > ma.max) {
ma.max = data;
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƶ<EFBFBD>һλ
ma.rear++;
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>ĩβ<C4A9><CEB2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ0
if(ma.rear == SIZE) {
ma.rear = 0;
}
// Ԫ<><D4AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
ma.itemCount++;
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ص<EFBFBD>ƽ<EFBFBD><C6BD>ֵ<EFBFBD>ĺ<EFBFBD><C4BA><EFBFBD>
double findAverage() {
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>Ԫ<EFBFBD><D4AA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>С<EFBFBD>ڵ<EFBFBD><DAB5><EFBFBD>2<EFBFBD><32><EFBFBD>򷵻<EFBFBD>-1<><31><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ҫȥ<D2AA><C8A5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD>Сֵ<D0A1><D6B5><EFBFBD>ټ<EFBFBD><D9BC><EFBFBD>ƽ<EFBFBD><C6BD>ֵ
if(ma.itemCount <= 2) {
return -1;
}
// <20><><EFBFBD><EFBFBD>ȥ<EFBFBD><C8A5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD>Сֵ<D0A1><D6B5><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>ֵ
return (double)((ma.sum - ma.min - ma.max) / (ma.itemCount - 3));
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ز<EFBFBD><D8B2><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>ֵ<EFBFBD>ĺ<EFBFBD><C4BA><EFBFBD>
double calculateMovingAverage(float new_value) {
enqueue(new_value);
// ֻ<>е<EFBFBD><D0B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>ż<EFBFBD><C5BC><EFBFBD>ƽ<EFBFBD><C6BD>ֵ
if(ma.itemCount == SIZE) {
return findAverage();
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>δ<EFBFBD><CEB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>-1
return -1;
}
static uint32_t GetR_ValueNew(float AD_Value)
{
float R = (5.1f*AD_Value)/(5.0f-AD_Value);
return (uint32_t)R;
}
Reference in New Issue Copy Permalink