CELIS/APPLICATION/GUNDiscriminate/GUNDiscriminate.c

#include "GUNDiscriminate.h"
#include "adc.h"
#include "stdio.h"
#include "Filtering.h"
#include "CDZ_State.h"
#include "SecTimer.h"
#include "CDZ_DATA.h"

enum  GUNState This_GUNState = NO_GUN;
enum GUNState Get_R_GUNState(float RValue)
{
	enum GUNState R_GUNState = NO_GUN;
	
	static enum  GUNState last_GUNState = NO_GUN;
//	if(RValue>5.5f) 
//	{
//		R_GUNState = NO_GUN;
//		printf("g=%d\r\n",R_GUNState);
//		printf("r=%f\r\n",RValue);
//		return NO_GUN;
//	}
//	printf("r=%f\r\n",RValue);
	enum BMS_OncConSt OBC_Connect = BMSDefaultParameters.parenr->Get_Car_OncConSt_Status(BMSDefaultParameters.parenr);
	switch(This_GUNState)
	{
		case NO_GUN:
			if(RValue < 1.5f && RValue>0.7f && OBC_Connect == No_connect)
			{
				R_GUNState = DC_GUN;
			}
			else if(RValue < 3.8f && RValue>0.01) 
			{
				R_GUNState = AC_GUN;
		  }
			else if(RValue>4.0f && RValue < 6.0f)
			{
				R_GUNState = DC_adapter;
			}
			else{
				R_GUNState = NO_GUN;
			}

			break;
		case AC_GUN:
			if(RValue < 3.8f && RValue>0.01)
			{
				R_GUNState = AC_GUN;
			}
			else
			{
				R_GUNState = NO_GUN;
			}
			break;
		case DC_adapter:
			if(RValue < 1.5f && RValue>0.01f)
			{
				R_GUNState = DC_GUN;
			}
			else if(RValue>4.0f && RValue < 6.0f)
			{
				R_GUNState = DC_adapter;
			}
			else 
			{
				R_GUNState = NO_GUN;
			}
			break;
		
		case DC_GUN:
			if(RValue < 1.5f && RValue>0.01 && OBC_Connect == No_connect)
			{
				R_GUNState = DC_GUN;
			}
			else if(RValue>4.0f && RValue < 7.0f)
			{
				R_GUNState = DC_adapter;
			}
			else 
			{
				R_GUNState = NO_GUN;
			}
			break;
		
		
		default:
			R_GUNState = NO_GUN;
			break;
	
	}
//	static uint32_t GUNFLAGCount = 0;
//	
//	if(R_GUNState != last_GUNState)
//	{
//		GUNFLAGCount = 0;
//		last_GUNState = R_GUNState;
//	}
//	else if(R_GUNState == This_GUNState)
//	{
//		GUNFLAGCount = 0;
//	}
//	else
//	{
//		GUNFLAGCount++;
//		if(GUNFLAGCount >=40)
//		{
//			This_GUNState = last_GUNState;
//			GUNFLAGCount = 0;
//		}
//	}
	This_GUNState = FilteringScan(&ContinuousFiltering[CC2_R_Filter],&R_GUNState);
//	printf("g=%d\r\n",This_GUNState);
	return This_GUNState;
}