【正文】 ****************/sint32 led。sint32 Vr,Vn。sint32 Vnp。uint16 Dist,TimepR,Time。byte showtime。uint32 PITc。byte Go_on。 byte Mod_Tag。sint8 uBLP0,uBLP1。sint8 dBLP0,dBLP1。sint8 bBLP0,bBLP1。uint8 Detc。uint16 Det_Bufu,Det_Bufd。uint16 Det_Stepu,Det_Stepd。uint16 Detu[30],Detd[30]。sint16 Spd_pwm。uint16 sline[3]。uint8 roundc。 sint32 Sten。sint32 Stenp,Sten_adj。uint8 pdir。 sint32 Neckn。sint32 Ndir。sint32 Tdir。 uint16 bcdd。uint8 BCDwei。byte BCDon。const MyBCD[11]={0x05,0xe7,0x29,0xa1,0xc3,0x91,0x11,0xa7,0x01,0x81,0xff}。uint32 Pulc。uint16 Pul。 uint16 VD。sint32 ad0,ad1,ad2,ad3,ad4。sint32 ad0z,ad1z,ad2l,ad3l,ad0b,ad1b,ad2r,ad3r。sint32 ad0d,ad1d,ad2d,ad3d。sint32 ad0w,ad1w,ad2w,ad3w。uint8 dip1,dip2,dip3,dip4,dip5。sint8 abc,cba[400]。sint16 ublp[10],dublp。sint32 ndirm。sint32 ndir[20],dndir。uint8 Stat_Label。uint16 Statc0,Statc1。uint8 Stat1。uint8 Bri_Label。 /*************************initialization function definition*****************************/void Sys_Clk_Init(){ CLKSELamp。=0x7f。} void GPIO_Init(){ DDRA=0x00。 DDRB=0xff。 DDRK=0x00。 DDRH=0xff。 DDRE=0xfc。void Int_Init() EnableInterrupts。} void ADC_Init(){ ATD0CTL1=0x00。 ATD0CTL2=0x00。 ATD0CTL3=0xa8。 ATD0CTL4=0x05。 ATD0CTL5=0x30。 ATD0DIEN=0x001f。void PIT_Init(){ PITMUXamp。=0xfe。 PITINTE|=0x01。 PITMTLD0=401。 PITLD0=1001。 PITCE|=0x01。}void PWM_Init(){ PWMCTL|=0x50。 PWMPRCLK=0x22。 PWMCLK=0x00。 PWMCAE=0x。 PWMPOL|=0xa2。 PWMPER7=200。 PWMDTY7=0。 PWMPER5=20000%256。 PWMPER4=20000/256。 PWMPER1=20000%256。 PWMPER0=20000/256。 PWME|=0xa2。}void TIM_Init() { PACTL=0x40。}void Sys_Init(){ Sys_Clk_Init()。 Int_Init()。 GPIO_Init()。 ADC_Init()。 PIT_Init()。 PWM_Init()。 TIM_Init()。}/***************************special function definition**************************/void DELAY(uint32 t){ uint32 i。 for(i=0。it。i++)。}void Button() { byte run。 while(1) { run=PORTK_PK0。 if(run==OFF){DELAY(8000)。run=PORTK_PK0。} if(run==OFF)break。 } DELAY(50000)。 }void BCD_Flash(uint8 num){ uint8 i。 for(i=0。inum。i++) { BCD_Switch(OFF)。 DELAY(100000)。 BCD_Switch(ON)。 DELAY(100000)。 } }void Dip() { dip1=PORTK_PK1。 dip2=PORTK_PK2。 dip3=PORTK_PK3。 dip4=PORTK_PK4。 dip5=PORTK_PK5。 }void AD_adj(){ if(dip1==0amp。amp。dip2==0amp。amp。dip3==0amp。amp。dip4==0amp。amp。dip5==1) { Button()。 BCD_Flash(1)。 ad0z=ad0。 Button()。 BCD_Flash(1)。 ad1z=ad1。 Button()。 BCD_Flash(1)。 ad0b=ad0。 Button()。 BCD_Flash(1)。 ad1b=ad1。 } }void Start_Up(){ uint8 i。 PITCFLMT_PITE=1。 Tdir=0。Ste_Dir_Ctrl()。 Ndir=0。Neck_Dir_Ctrl()。 for(i=0。i3。i++) { BCD_Switch(OFF)。 DELAY(100000)。 BCD_Switch(ON)。 DELAY(100000)。 } ad0z=170。 ad0b=90。 ad1z=185。 ad1b=90。 ad2r= ad2l=20。 ad3l= ad3r=20。 Stat_Label=0。 Statc0=0。 Statc1=0。 Bri_Label=0。 showtime=OFF。 Go_on=FALSE。 roundc=0。 uBLP0=0。 dBLP0=0。 Spd_pwm=0。 } void BCD_Display(uint16 num){ uint8 bai=0,shi=0,ge=0。 bai=num/100。 shi=num%100/10。 ge=num%10。 if(BCDwei==0) { PTH_PTH4=0。 PTH_PTH5=0。 PTH_PTH6=1。 PORTB=MyBCD[bai]。 } if(BCDwei==1) { PTH_PTH4=0。 PTH_PTH5=1。 PTH_PTH6=0。 PORTB=MyBCD[shi]。 } if(BCDwei==2) { PTH_PTH4=1。 PTH_PTH5=0。 PTH_PTH6=0。 PORTB=MyBCD[ge]。 } }void BCD_Switch(byte key){ if(key==ON)BCDon=1。 else if(key==OFF) { BCDon=0。 PTH_PTH4=0。 PTH_PTH5=0。 PTH_PTH6=0。 PORTB=MyBCD[10]。 }} void AD_Sample() { ad0=ATD0DR0。 ad1=ATD0DR1。 ad2=ATD0DR2。 ad3=ATD0DR3。 ad4=ATD0DR4。}void Det_Getu(uint8 get){ uint16 a,c,b,d。 Det_Bufu=PORTA。 a=Det_Bufu。 b=a。 c=b。 d=c。 aamp。=0x0010。 bamp。=0x0020。 camp。=0x0040。 damp。=0x0080。 if (get==0)Det_Stepu+=((a4)+(c))。 else if(get==1)Det_Stepu+=((a3)+(c1))。 else if(get==2)Det_Stepu+=((a2)+(c2))。 else if(get==3)Det_Stepu+=((b2)+(d2))。 else if(get==4)Det_Stepu+=((b1)+(d3))。 else if(get==5)Det_Stepu+=((b)+(d4))。} void Det_Getd(uint8 get){ uint16 a,c,b,d。 Det_Bufd=PORTA。 a=Det_Bufd。 b=a。 c=b。 d=c。 aamp。=0x0001。 bamp。=0x0002。 camp。=0x0004。 damp。=0x0008。 if (get==3)Det_Stepd+=((a)+(b))。 else if(get==4)Det_Stepd+=((b1)+(c1))。 else if(get==5)Det_Stepd+=((c2)+(d2))。 } void Det_Rec(){ sint8 i。 for(i=19。i=1。i)Detu[i]=Detu[i1]。 Detu[0]=Det_Stepu。 Det_Stepu=0。 for(i=19。i=1。i)Detd[i]=Detd[i1]。 Detd[0]=Det_Stepd。 Det_Stepd=0。 }void Mod_Ctrl(){ ad2add()。 BlackLine_Jud()。 Dir_Ctrl()。 StartStop_Jud()。 } uint16 Det_Filter(uint8 updown, uint8 quan, uint8 andor){ uint8 i。 uint16 a。 switch(updown) { case 0:switch(andor) { case 0:a=0xffff。for(i=0。i=quan1。i++)aamp。=(Detu[i])。break。 case 1:a=0x0000。for(i=0。i=quan1。i++)a|=(Detu[i])。break。 } break。 case 1:switch(andor) { case 0:a=0xffff。for(i=0。i=quan1。i++)aamp。=(Detd[i])。break。 case 1:a=0x0000。for(i=0。i=quan1。i++)a|=(Detd[i])。break。 }