读取秤体AD值后,主要是进行平滑滤波、判断AD值是否稳定、判断是否为负AD值。
1、 判断是否稳定和产生平滑滤波的AD值
unsigned char ad_status(unsigned short ad, unsigned char* ad_smooth)
{
unsigned char i = 0;
unsigned char flag = 0;
unsigned long tmp = 0;
unsigned short ad_ud_rng = AD_UPDATA_RANGE;//40
unsigned short ad_st_rng = AD_STABLE_RANGE;//24
unsigned short ad_st_cnt = AD_STABLE_CNT;//7
//AD_FILTER_LOG("ad_status raw_ad:%d-%d,sta_cnt:%d\r\n",ad,*((unsigned short*)(ad_smooth)),ad_st_cnt);
if(ad_abs(ad, *((unsigned short*)(ad_smooth))) <= ad_ud_rng)
{
/* 在平滑范围内,做平滑操作 */
for(i = 0; i < MAX_FILTER_QUEUE_SIZE - 1; i++)
{
ad_queue[i] = ad_queue[i + 1];
tmp += ad_queue[i + 1];
}
ad_queue[MAX_FILTER_QUEUE_SIZE - 1] = ad;
tmp += ad;
//tmp += MAX_FILTER_QUEUE_SIZE / 2;//caicai 理论上是有问题。
tmp /= MAX_FILTER_QUEUE_SIZE;
if(ad_abs((unsigned short)tmp, *((unsigned short*)(ad_smooth)) ) <= ad_st_rng)
{
if(stable_cnt > ad_st_cnt)
{
//AD_FILTER_LOG("adc stable OK!:%d\r\n",*((unsigned short*)(ad_smooth)));
flag = 1;
} else
{
stable_cnt++;
}
}
} else
{
//AD_FILTER_LOG("adc stable ER!\r\n");
stable_cnt = 0;
for(i = 0; i < MAX_FILTER_QUEUE_SIZE; i++)
{
ad_queue[i] = ad;
}
tmp = ad;
}
*((unsigned short*)(ad_smooth)) = (unsigned short)tmp;
return flag;
}
2、 判断是否为负AD值
m_af.f_ad_neg = CLR;
if(m_af.smooth_ad < m_af.ref_ad)
{
m_af.f_ad_neg = SET;
}