/***************************************** *AD程序 *编写：李平 *版本号：V1.00 *日期：2011-7-16 *文件名：Ad.c */ #include "Ad.h" #include "flash.h" #include "usart.h" #include "buffer.h" #include "weight.h" #define ZERO 500000 #define SPANZERO ZERO #define TRN_INI 2 extern unsigned char usart1_send_data[64]; extern void USART_Send_DMA(unsigned char j,int n); extern unsigned char WeightConst_ChanCheShu; ulng keyword=0; uchar stas_s0=0;//状态标志变量 0：称重状态 1：工厂标定和工厂设置状态 2：用户设置状态 uchar fs[16]= {0}; //工厂参数 uchar ZeroPass=0; uchar IsRealZero=0; uchar IsZeroFlag=0; uchar num_stbn=0; uchar n_stbn=0; uchar num_trn=0; uchar stbn=0; uchar IsStb=0; uchar Isol=0; uchar ad_nag_flag=0; uchar nag=0; uchar IsTare=0; ulng ad_lcd=0; ulng ad_lcd1=0; ulng ad_read=0; ulng ad_start=0; ulng ad_sample=0; ulng ad_zero=0; ulng real_zero=0; ulng ad_last=0; ulng ad_tare=0; ulng Maxval=0; uchar Inteval=0; uchar point1=0; uchar point2=0; float spanz=0; ulng Low_w=0; ulng Up_w=0; ulng err_cnt=0; ulng ok_cnt=0; uchar STB_N=2; uchar start_loop; ulng AD=0; /*******************************************/ float Avad[6]= {0}; float Bvad[6]= {0}; float Cvad[6]= {0}; float Dvad[6]= {0}; float Evad[6]= {0}; float Fvad[6]= {0}; float Gvad[6]= {0}; float Hvad[6]= {0}; float Ivad[6]= {0}; float Jvad[6]= {0}; float AD_result=0; uchar ad_ini_flag=0; uchar ad_ini_flag1=0; float Ad_tol=0; uchar Ad_cnt=0; uchar Ad_I=0; uchar AVG_CNT=4; uchar f_zeroset=1; uchar FLT_CNT=16; uchar FLT_XF_CNT=1; ulng FilterArray[128]; uchar FilterPos=0; uchar dat[32]= {0}; ulng Kalman_FilterArray[128]; uchar Kalman_ini_flag=0; uchar Kalman_FilterPos=0; uchar key_CNT_f=0; float percent_fl=1.000f; ulng percent_ul=999; extern uchar ini_flag1; uchar Rsbuffer[7]= {0}; //RS232使用 uchar RsWeight[]= { 0x30,0x31,0x32,0x33,0x34,0x35, // "0" "1" "2" "3" "4" "5" 0x36,0x37,0x38,0x39 // "6" "7" "8" "9" }; float x1=0,x2=0,x0=0,y0=0,y1=0,y2=0; unsigned char buf[4] = {0,0,0,0}; unsigned char isIRQ; ulng ad_sample_temp; extern void Delay(__IO uint32_t nCount); #define _nop_() Delay(1) ulng get_weight(void) { ulng tempval=0; ulng tempvalw=0; isIRQ=0; tempval = Ad_Sample1(); if (tempval<0xFFFFFFFF) { ad_sample_temp = tempval; } // if (ad_sample_temp>0 && ad_sample_temp<0xFFFFF && isIRQ==0) if (isIRQ==0 && tempval<0xFFFFFFFF) ad_sample=ad_sample_temp; // ad_sample_=ad_sample; // ad_sample=(int)((float)ad_sample * 0.01 + (1.0 - 0.01) * (float)ad_sample); // ad_sample = AdFilter_xf(ad_sample); //限幅滤波 FLT_XF_CNT=32; ad_sample = middleFilter(ad_sample); tempvalw = ad_sample; switch(fs[1]) { case 1: ad_sample = Kalman_Filter(ad_sample, 0.5, 0.5); break; case 2: ad_sample = Kalman_Filter(ad_sample, 0.1, 0.5); break; case 3: ad_sample = Kalman_Filter(ad_sample, 0.05, 0.5); break; case 4: ad_sample = Kalman_Filter(ad_sample, 0.01, 0.5); break; case 5: ad_sample = Kalman_Filter(ad_sample, 0.1, 0.5); break; case 6: ad_sample = Kalman_Filter(ad_sample, 0.05, 0.5); break; case 7: ad_sample = Kalman_Filter(ad_sample, 0.1, 0.5); break; default: ad_sample = Kalman_Filter(ad_sample, 0.125, 0.5); break; } //ad_sample = AdFilter(ad_sample); //滑动滤波 FLT_CNT=32; if (tempWeighttime<100){ tempWeighttime ++; ad_sample = tempvalw; } ad_read = adcalculate(ad_sample); Common(); //称量状态 // RS232weight(ad_lcd1); return ad_lcd1; } //--------------------------------- //Function that writes to the AD7190 via the SPI port. //-------------------------------------------------------------------------------- void WriteToAD7190(unsigned char count, unsigned char *buf) { unsigned char ValueToWrite = 0; unsigned char i = 0; unsigned char j = 0; // __disable_irq(); AD_CLK_1; _nop_(); for(i=count; i>0; i--) { ValueToWrite = *(buf + i - 1); for(j=0; j<8; j++) { AD_CLK_0; if(0x80 == (ValueToWrite & 0x80)) { AD_DIN_1; //Send one to SDO pin } else { AD_DIN_0; //Send zero to SDO pin } _nop_(); AD_CLK_1; _nop_(); ValueToWrite <<= 1; //Rotate data } } AD_DIN_0; // __enable_irq(); } //--------------------------------- //Function that reads from the AD7190 via the SPI port. //-------------------------------------------------------------------------------- void ReadFromAD7190(unsigned char count, unsigned char *buf) { unsigned char i = 0; unsigned char j = 0; unsigned int iTemp = 0; unsigned char RotateData = 0; // __disable_irq(); AD_CLK_1; _nop_(); for(j=count; j>0; j--) { for(i=0; i<8; i++) { AD_CLK_0; RotateData <<= 1; //Rotate data _nop_(); iTemp = AD_R_DI; //Read SDI of AD7190 AD_CLK_1; if(0x00000001 == (iTemp & 0x00000001)) { RotateData |= 1; } _nop_(); } *(buf + j - 1)= RotateData; } // __enable_irq(); } // extern void led_change(void); /*********************************** *读AD7190函数 */ ulng Ad_Sample1(void) { uchar i; ulng j=0; ulng AdSample=0XFFFFFFFF; // __disable_irq(); AD_CLK_1; _nop_(); // _nop_(); while(AD_R_DI==1) { j++; if (j>1000) break; } if (j<1000) { AdSample=0; for(i=0; i<24; i++) { AD_CLK_0; // _nop_(); _nop_(); AdSample<<=1; if(AD_R_DI==1) AdSample++; AD_CLK_1; _nop_(); // _nop_(); } /* if ((AdSample&0x00800000)!=0) { AdSample=~AdSample+1; AdSample&=0x007fffff; AdSample=0x007fffff-AdSample; } else { AdSample&=0x007fffff; AdSample=0x007fffff+AdSample; } */ if (fs[1]<=4 && fs[1]>0 ) AdSample = AdSample>>3; else if (fs[1]>4 && fs[1]<=6 ) AdSample = AdSample>>2; else AdSample = AdSample; // led_change(); } //__enable_irq(); return(AdSample); } /********************************************* *AD7190上电初始化处理 */ void adFs(unsigned char fs_) { Delay(100); AD_CS_0; AD_SYNC_1; Delay(100); //Reset AD7190 buf[2]= 0xff; buf[1]= 0xff; buf[0]= 0xff; WriteToAD7190(3,buf); buf[1]= 0xff; buf[0]= 0xff; WriteToAD7190(2,buf); Delay(200); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 0 0 1 0 0 0 */ /*********************************** 模式寄存器 MD2|MD1|MD0|DAT_STA|CLK1|CLK0| 0 | 0 0 0 0 0 0 0 0 0 SINC3| 0 |ENPAR| 0 |SINGLE|REJ60|FS9|FS8 0 0 0 0 0 1 0 0 FS7|FS6|FS5|FS4|FS3|FS2|FS1|FS0 0 0 0 0 0 1 0 1 */ //mode register buf[0] = 0x08; WriteToAD7190(1,buf); buf[2] = 0x00; buf[1] = 0x04; // buf[0] = 0x50;//xxx Hz if (fs_==0) buf[0] = 80;//xxx Hz else /*if (fs_==1) { buf[1] = buf[1]|((480>>8)&3);//xxx Hz buf[0] = 480&0xff;//xxx Hz } else if (fs_==2) { buf[1] = buf[1]|((480>>8)&3);//xxx Hz buf[0] = 480&0xff;//xxx Hz } else if (fs_==3) { buf[1] = buf[1]|((640>>8)&3);//xxx Hz buf[0] = 640&0xff;//xxx Hz } else if (fs_==4) { buf[1] = buf[1]|((640>>8)&3);//xxx Hz buf[0] = 640&0xff;//xxx Hz } else if (fs_==5) { buf[1] = buf[1]|((1023>>8)&3);//xxx Hz buf[0] = 1023&0xff;//xxx Hz } else if (fs_==6) { buf[1] = buf[1]|((1023>>8)&3);//xxx Hz buf[0] = 1023&0xff;//xxx Hz } else if (fs_==7) */ { buf[1] = buf[1]|((120>>8)&3);//xxx Hz buf[0] = 120&0xff;//xxx Hz } /* else { buf[0] = 80;//xxx Hz } */ WriteToAD7190(3,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 0 1 0 0 0 0 */ /********************************* 配置寄存器 CHOP| 0 | 0 |REFSEL| 0 | 0 | 0| 0 0 0 0 0 0 0 0 0 CH7|CH6|CH5|CH4|CH3|CH2|CH1|CH0 0 0 0 0 0 0 1 0 BURN|REFDET| 0 |BUF|U/B|G2|G1|G0 0 0 0 1 0 1 1 1 */ //Configuration register buf[0] = 0x10; WriteToAD7190(1,buf); buf[2] = 0x80; //buf[2] = 0x80; buf[1] = 0x02; buf[0] = 0x17; WriteToAD7190(3,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 1 0 1 0 0 0 */ /*********************************** GPOCON寄存器 0 |BPDSW|GP32EN|GPIOEN|P3DAT|P2DAT|P1DAT|P0DAT 0 1 0 0 0 0 0 0 */ //GPOCON register buf[0] = 0x28; WriteToAD7190(1,buf); buf[0] = 0x40; WriteToAD7190(1,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 1 0 1 1 1 0 0 */ //通信寄存器，连续读数据寄存器 buf[0] = 0x5c; WriteToAD7190(1,buf); Delay(5); } /********************************************* *AD7190上电初始化处理 */ void adini(void) { Delay(100); AD_CS_0; AD_SYNC_1; Delay(100); //Reset AD7190 buf[2]= 0xff; buf[1]= 0xff; buf[0]= 0xff; WriteToAD7190(3,buf); buf[1]= 0xff; buf[0]= 0xff; WriteToAD7190(2,buf); Delay(200); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 0 0 1 0 0 0 */ /*********************************** 模式寄存器 MD2|MD1|MD0|DAT_STA|CLK1|CLK0| 0 | 0 0 0 0 0 0 0 0 0 SINC3| 0 |ENPAR| 0 |SINGLE|REJ60|FS9|FS8 0 0 0 0 0 1 0 0 FS7|FS6|FS5|FS4|FS3|FS2|FS1|FS0 0 0 0 0 0 1 0 1 */ //mode register buf[0] = 0x08; WriteToAD7190(1,buf); buf[2] = 0x00; buf[1] = 0x04; buf[0] = 0x50;//xxx Hz WriteToAD7190(3,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 0 1 0 0 0 0 */ /********************************* 配置寄存器 CHOP| 0 | 0 |REFSEL| 0 | 0 | 0| 0 0 0 0 0 0 0 0 0 CH7|CH6|CH5|CH4|CH3|CH2|CH1|CH0 0 0 0 0 0 0 1 0 BURN|REFDET| 0 |BUF|U/B|G2|G1|G0 0 0 0 1 0 1 1 1 */ //Configuration register buf[0] = 0x10; WriteToAD7190(1,buf); buf[2] = 0x00; buf[1] = 0x02; buf[0] = 0x17; WriteToAD7190(3,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 0 1 0 1 0 0 0 */ /*********************************** GPOCON寄存器 0 |BPDSW|GP32EN|GPIOEN|P3DAT|P2DAT|P1DAT|P0DAT 0 1 0 0 0 0 0 0 */ //GPOCON register buf[0] = 0x28; WriteToAD7190(1,buf); buf[0] = 0x40; WriteToAD7190(1,buf); /*********************************** 通信寄存器 WEN|R/W|RS2|RS1|RS0|CREAD| 0 | 0 0 1 0 1 1 1 0 0 */ //通信寄存器，连续读数据寄存器 buf[0] = 0x5c; WriteToAD7190(1,buf); Delay(5); } /************************ *AD采样速度选择函数 */ void Speed(void) { switch(fs[1]) { case 0: ad_ini_flag=0; ad_ini_flag1=0; FLT_CNT=4; //滑动滤波 AVG_CNT=4; //平均滤波 break; case 1: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 2: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 3: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 4: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 5: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 6: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; case 7: ad_ini_flag1=0; FLT_CNT=24; AVG_CNT=6; break; default: ad_ini_flag1=0; FLT_CNT=32; AVG_CNT=4; break; } } /****限幅滤波**********************/ uchar count_xf; ulng AdFilter_xf_value; uchar ad_ini_flag_xf=0; ulng AdFilter_xf(ulng x) { uint32_t FILTER_A = 0x7FFF; //限幅100公斤 int32_t FILTER_1 ; if(ad_ini_flag_xf==0) { ad_ini_flag_xf=1; count_xf=0; AdFilter_xf_value=x; return x; } FILTER_1 = x - AdFilter_xf_value; if (FILTER_1<0) FILTER_1 = FILTER_1 * -1; if(FILTER_1 > FILTER_A && count_xf<=FLT_XF_CNT) { count_xf++; } else { count_xf=0; AdFilter_xf_value = x; } return AdFilter_xf_value; } /***kalman滤波*************/ /* Q:过程噪声，Q增大，动态响应变快，收敛稳定性变坏 R:测量噪声，R增大，动态响应变慢，收敛稳定性变好 */ ulng Kalman_Filter(const double ResrcData, double ProcessNiose_Q,double MeasureNoise_R) { int32_t ad_sum = 0; ulng ad_avg = 0; double R = MeasureNoise_R; double Q = ProcessNiose_Q; static double x_last; static double p_last; double x_mid; double x_now; double p_mid ; double p_now; double kg; uchar i; uchar x__=3; uchar y__=1<=y__) Kalman_FilterPos=0; Kalman_FilterArray[Kalman_FilterPos]=ResrcData; ad_sum = 0; for (i=0; i>x__; ad_sum = 0; // for (i=0; i>(x__+2)); for (i=0; i middleFilterdata[i+1]) { temp = middleFilterdata[i]; middleFilterdata[i] = middleFilterdata[i+1]; middleFilterdata[i+1] = temp; } } } return middleFilterdata[floor((FLT_CNT-1)/2)]; } /****************************/ ulng AdFilter(ulng x) { ulng ad_sum = 0; uchar i; if(ad_ini_flag1==0) { for(i=0; i=FLT_CNT) { FilterPos=0; } FilterArray[FilterPos]=x; for (i=0; i999999) { dis_data=0; //超过显示最大值送零 } for(digit=0; digit<6; digit++) { quotient=0; while(dis_data>(divider-1)) { dis_data-=divider; quotient++; } divider/=10; Rsbuffer[digit]=RsWeight[quotient]; } } void RS232weight(__IO ulng x) { DisplayWeight_ww(x); //2D 33 36 35 34 0D //02 2B 30 30 30 30 30 30 33 03 // 30 30 2E 30 30 30 0D 0A if (WeightConst_ChanCheShu==9) { usart1_send_data[0] = 0x04; usart1_send_data[1] = (ad_sample_temp>>24)&0xFF; usart1_send_data[2] = (ad_sample_temp>>16)&0xFF; usart1_send_data[3] = (ad_sample_temp>>8)&0xFF; usart1_send_data[4] = ad_sample_temp&0xFF; } else { usart1_send_data[0] = 0x06; if (nag) { usart1_send_data[1] = 0x2D; for(int i=2; i<6; i++) usart1_send_data[i] = Rsbuffer[i]; } else for(int i=1; i<6; i++) usart1_send_data[i] = Rsbuffer[i]; } usart1_send_data[6] = 0x0D; rt_sem_take(uart1_lock, RT_WAITING_FOREVER); HAL_UART_Transmit_DMA(&huart1, usart1_send_data, usart1_send_data[0]); rt_sem_release(uart1_lock); } /********************************* *小数点位 1-5 */ void setPoint(__IO uchar val_) { point1 = val_; ArgSave(); } /********************************* *分度值 1、2、5、10 */ void setInteval(__IO uchar val_) { Inteval=val_; ArgSave(); } /********************************* *滤波级别 1-8 */ void setFS(__IO uchar val_) { fs[1] = val_; adFs(fs[1]); Speed(); ArgSave(); } /********************************* *校正百分比 */ void setPercent(__IO int val_) { percent_fl=(float)val_/1000; spanz = spanz + spanz * percent_fl; //保存新的校正 ArgSave(); } /********************************* *最大称量 */ void setMaxval(__IO ulng val_) { Maxval = val_; ArgSave(); } /********************************* *0点校正 */ void setZeroCal(void) { if ((ad_sample>0)&&(ad_sample<50000000)) { zerocalculate(); //0点计算 ArgSave(); } } /********************************* *砝码校正 */ void setFullCal(__IO ulng val_) { keyword = val_; if ((ad_sample-ad_zero)>=(keyword/Inteval*10)&&(ad_sample>ad_zero)&&(keyword!=0)) { fullcalculate(); //砝码计算 ArgSave(); } } /********************************* *置零 */ void setZero(void) { Zero_Pro(); } /********************************* *称量计算显示函数 */ void Common(void) { if(f_zeroset==0) { CommonModeIni(); } CheckZero(ad_read); Do(); Dis_Weight(); } /********************************************* *零点检测 */ void CheckZero(__IO ulng check_data) { ulng zero_range; zero_range=24; if(check_data>real_zero) { check_data-=real_zero; } else { check_data=real_zero-check_data; } IsRealZero=(check_datacheck_Wdata1)&&(ad_read=20) { n_stbn=0; IsStb=1; } else { n_stbn++; } } else { n_stbn=0; } } /********************************************* *稳定判别 */ void Check_Wen(void) { ulng check_Wdata1; ulng check_Wdata2; ulng stb_w; stb_w=5; STB_N=5; check_Wdata1 = ad_last - stb_w; check_Wdata2 = ad_last + stb_w; if((ad_read>check_Wdata1)&&(ad_read=STB_N) { n_stbn=0; IsStb=1; } else { n_stbn++; } } else { n_stbn=0; } } /********************************************* *不稳定判别 */ void Check_Not_Wen(void) { ulng check_data1; ulng check_data2; ulng nstb_w; nstb_w=10; check_data1=ad_lcd-nstb_w; check_data2=ad_lcd+nstb_w; if((ad_readcheck_data2)) { IsStb=0; } } /********************************************* *开机零点检测 *Return: 0 开机零点超出范围 * 1 开机零点在范围内 */ uchar Check_Start(void) { ulng check1=0; ulng check2=0; check1=SPANZERO-(Maxval/(ulng)Inteval*2);//20% check2=SPANZERO+(Maxval/(ulng)Inteval*2); if((ad_readcheck2)) { return(0); } else { return(1); } } /********************************************* *零点跟踪 */ void Zero_Trace(void) { ulng check_data1; ulng check_data2; ulng ZeroTrace_w; uchar trn_cnt; ZeroTrace_w = 5; check_data1=ad_start-Maxval/((ulng)Inteval*2)/10;//600; check_data2=ad_start+Maxval/((ulng)Inteval*2)/10;//600; if((ad_readcheck_data2)) { num_trn=0; return; } check_data1=real_zero-1; check_data2=real_zero+1; if((ad_read>=check_data1)&&(ad_read<=check_data2)) { num_trn=0; return; } check_data1=real_zero-ZeroTrace_w; check_data2=real_zero+ZeroTrace_w; if((ad_read<=check_data1)||(ad_read>=check_data2)) { num_trn=0; return; } trn_cnt=5; if(num_trn>=trn_cnt) { if (ad_read>=real_zero) { real_zero++; ad_tare++; } else { real_zero--; ad_tare--; } num_trn=0; } else { num_trn++; } } /********************************************* *四舍五入计算 */ ulng RoundOff(__IO ulng data1,__IO ulng data2) { ulng result; ulng remainder; result=data1/data2; remainder=data1%data2 ; if ((remainder*2)>=data2) { result++; } return (result); } /********************************************* *外码计算 */ void Dis_Weight(void) { ulng Ovcheck; ad_dis_calcu(); AD=ad_lcd1;//保存ad码 if(ad_lcd>=real_zero) { Ovcheck=ad_lcd-real_zero; } else { Ovcheck=real_zero-ad_lcd; } if(Ovcheck<=((Maxval/Inteval)*10+90)) { Isol=0; } else { Isol=1; } ad_lcd1=RoundOff(ad_lcd1,10); ad_lcd1 = ad_lcd1 * Inteval; if(ad_lcd1==0) { ad_nag_flag=0; } if (ad_lcd1<=Inteval*3) { nag=0; } if (ad_lcd1<=20*Inteval) { ZeroPass=0; } } /*************************************** *皮重计算 */ void ad_dis_calcu(void) { if(ad_lcd>=ad_tare) { ad_nag_flag=0; nag=0; ad_lcd1=ad_lcd-ad_tare; } else { ad_nag_flag=1; nag=1; ad_lcd1=ad_tare-ad_lcd; } if(ad_tare>=real_zero) { if((ad_tare-real_zero)<5) { IsTare=0; } else { IsTare=1; } } else { if((real_zero-ad_tare)<5) { IsTare=0; } else { IsTare=1; } } } /********************************************* Description: Argument : Return : **********************************************/ void Do() { if(IsStb) { Check_Not_Wen(); Zero_Trace(); ad_lcd = ad_read; } else { Check_Wen(); ad_lcd = ad_read; } CheckZero(ad_read); ad_last=ad_read; } /*********************************************/ /****************************** *置零处理 */ void Zero_Pro(void) { //ulng Start_w; if(stas_s0==0) { //Start_w=((Maxval/(ulng)Inteval)*5)/10;//5% //if ((IsStb)&&(ad_lcd<=(ad_start+Start_w))&&(ad_lcd>=(ad_start-Start_w))&&(!IsTare)) if ((IsStb)&&(!IsTare)) // if (IsStb) { ad_tare=ad_tare+(ad_lcd-real_zero); real_zero=ad_lcd; Zero_Save(); } return; } } /*************************** *最大去皮量计算 */ ulng maxtare(void) { return(Maxval-Inteval); } /*************************** *去皮处理 */ void Tare_Pro(void) { if ((IsStb)&&(stas_s0==0)) { if ((ad_lcd>=real_zero) && ((ad_lcd-real_zero)<=((maxtare()/Inteval)*10))) { ad_tare = ad_lcd; } } if ((IsStb)&&(IsZeroFlag)&&(stas_s0==0)) { ad_tare = ad_lcd; real_zero = ad_lcd; IsTare = 0; } if ((IsStb)&&(IsTare)&&(ad_lcd=(ad_start-Start_w))&&(!IsTare)) { ad_tare=ad_tare+(ad_lcd-real_zero); real_zero=ad_lcd; Zero_Save(); } return; } } /*********************************** *重量标定计算 */ void fullcalculate(void) { float SpanFull=0; float spanz1=0; SpanFull=((float)keyword/(float)Inteval*10); spanz1=SpanFull; spanz=(spanz1/((float)ad_sample-(float)ad_zero)); ad_read=adcalculate(ad_zero); //建立零点 ad_last=ad_read; ad_lcd= ad_read; ad_start=ad_read; ad_tare=ad_read; real_zero=ad_read; f_zeroset=1; } /****************************************** *标定零位计算 */ void zerocalculate(void) { ad_zero=ad_sample; } /*********************************** *AD值计算 */ ulng adcalculate(__IO ulng ads) { float adcal=0; adcal=(float)ads-((float)ad_zero-((float)ZERO/spanz)); // ZERO=500000; ad_zero=500000; spanz=1。2010-01-24 adcal=adcal*spanz; return((ulng)(adcal+0.5)); } /***************************************/ /************************************* *滤波函数 *输入：采样值x *输出：返回滤波后的结果值 */ ulng EX_QR_Filter(ulng x) { uchar i; if(ad_ini_flag==0) { for(i=0; i<4; i++) { Avad[i]=x; Bvad[i]=x; Cvad[i]=x; Dvad[i]=x; Evad[i]=x; Fvad[i]=x; Gvad[i]=x; Hvad[i]=x; Ivad[i]=x; Jvad[i]=x; } ad_ini_flag=1; return(x); } else { Ad_tol+=x; Ad_cnt++; if(Ad_cnt>=AVG_CNT) { Avad[3]=Avad[2]; Avad[2]=Avad[1]; Avad[1]=Avad[0]; Avad[0]=Ad_tol/AVG_CNT; Ad_cnt=0; Ad_tol=0; } else { return((ulng)(AD_result+0.5f)); } } Bvad[3]=Bvad[2]; Bvad[2]=Bvad[1]; Bvad[1]=Bvad[0]; Bvad[0]=0.1f*Avad[0]+0.2f*Avad[1]+0.3f*Avad[2]+0.4f*Avad[3]; Cvad[3]=Cvad[2]; Cvad[2]=Cvad[1]; Cvad[1]=Cvad[0]; Cvad[0]=0.1f*Bvad[0]+0.2f*Bvad[1]+0.3f*Bvad[2]+0.4f*Bvad[3]; Dvad[3]=Dvad[2]; Dvad[2]=Dvad[1]; Dvad[1]=Dvad[0]; Dvad[0]=0.1f*Cvad[0]+0.2f*Cvad[1]+0.3f*Cvad[2]+0.4f*Cvad[3]; Evad[3]=Evad[2]; Evad[2]=Evad[1]; Evad[1]=Evad[0]; Evad[0]=0.1f*Dvad[0]+0.2f*Dvad[1]+0.3f*Dvad[2]+0.4f*Dvad[3]; Fvad[3]=Fvad[2]; Fvad[2]=Fvad[1]; Fvad[1]=Fvad[0]; Fvad[0]=0.1f*Evad[0]+0.2f*Evad[1]+0.3f*Evad[2]+0.4f*Evad[3]; if (fs[1]==0) AD_result=Avad[0]; else if (fs[1]==1) AD_result=Avad[0]; else if (fs[1]==2) AD_result=Avad[0]; else if (fs[1]==3) AD_result=Avad[0]; else if (fs[1]==4) AD_result=Avad[0]; else if (fs[1]==5) AD_result=Bvad[0]; else if (fs[1]==6) AD_result=Cvad[0]; else AD_result=Dvad[0]; return((ulng)(AD_result+0.5f)); } /**************************************************** * 这是一个延迟函数 */ void Delay(__IO uint32_t nCount) { /* __IO 就是volatile, 加上这个后可以避免延迟函数被编译器优化掉 */ for(; nCount != 0; nCount--); } /********************************************************/