motor_ctl-3/User/Src/gas_sensor.c

#include "gas_sensor.h"
#include "math_tools.h"
#include "log_save.h"

uint16_t GasSensor_OffSet = 0;
TrueOrFalse_Flag_Struct_t IsGasSensorConnectedFlag = FALSE;

#define ZeroOffSetData 100

//指拨零点值初始化
void GasSensorOffSet_Init(uint16_t* OffSet, uint16_t AdcData)
{
  //根据开始时刻采集值判断是否连接转把
	if(AdcData < 300)
	{
	  IsGasSensorConnectedFlag = FALSE;
	}
	else
	{
	  IsGasSensorConnectedFlag = TRUE;
	}
	
	*OffSet = AdcData + ZeroOffSetData;
}

//指拨零点值更新
void GasSensorOffSetData_Update(uint16_t* PresentData, uint16_t AdcData, MC_ErrorCode_Struct_t* p_MC_ErrorCode)
{
  static uint16_t Array[50];
	static TrueOrFalse_Flag_Struct_t IsArrayFullFalg = FALSE;
	static uint8_t i = 0;
	uint16_t TempData;
	static uint32_t ErrorDelayTimeCnt = 0;
	
	//刚开机时，数组未存满
	if(IsArrayFullFalg == FALSE)
	{
	  Array[i++] = AdcData;
		if(i >= 50)
		{
		  IsArrayFullFalg = TRUE;
			i = 0;
		}
	}
	//存满后取滑动均值
	else
	{
	  TempData = MovingAverageFilter(AdcData, Array, sizeof(Array) / 2) + ZeroOffSetData;
		if(TempData < *PresentData)
		{
		  //更新零点值
			if(TempData > 300)//避免线缆松脱导致零点变为异常值
			{
		  	//*PresentData = TempData;//实测结果，开机状态下拔出转把，然后再插入，零点值会更新到300，导致异常启动，先取消零点更新
			}	
		}
	}
	//判断零点是否超出范围
	if(p_MC_ErrorCode->ERROR_Bit.Fault_GasSensor == 0)
	{
	  if(*PresentData <= 1500)
		{
		  ErrorDelayTimeCnt = HAL_GetTick();
		}
		if((HAL_GetTick() - ErrorDelayTimeCnt) > 10000)
		{
			p_MC_ErrorCode->ERROR_Bit.Fault_GasSensor = 1;
			//记录故障日志
			MC_ErrorLogSaveInfo.NotesInfo1 = 1;
			MC_ErrorLogSaveInfo.NotesInfo2 = *PresentData;
			ErrorLogSave_Update(&MC_ErrorLogSaveInfo);
			IsErrorLogSaveInfoUpdateFlag = TRUE;
			//存储故障次数
			MC_RunLog2.GasSensor_FaultCnt++;
			RunLogSaveIndex = 2;
		}	 
	}
}