洗牙器，脉冲控制，软起动

#include "HT66F004.h" volatile unsigned char TimeCnt0 = 0; volatile unsigned char TimeCnt1 = 0; volatile unsigned char TimeCnt2 = 0; volatile unsigned char TimeCnt3 = 0; volatile unsigned int TimeCnt4 = 0; volatile unsigned char GearCnt0 = 0; volatile unsigned char GearCnt1 = 0; volatile unsigned char GearCnt2 = 0; volatile unsigned char GearCnt3 = 0; volatile unsigned char KeyCnt0 = 0; volatile unsigned char OnoffCnt = 0; volatile unsigned char GearCnt = 0; volatile unsigned char GearValue = 0; volatile unsigned char PowOnVal = 0; volatile unsigned char ADCTime = 0; volatile unsigned short FlashTime = 0; volatile unsigned char FlashCnt = 0; volatile unsigned short ADCBuff = 0; unsigned short Voltage7Val[7]; #define D2Led _pa1 #define D3Led _pc0 #define D4Led _pc2 #define OnOffKey _pa5 #define GearKey _pa4 #define MotorPWM _pa7 #define LED5 _pc1 #define LED6 _pa3 #define LED7 _pa6 #define LED8 _pb0 #define ExtVolt _pa2 #define GearAddr 0x02 volatile bit Flg200us; volatile bit Flg1ms; volatile bit GearPosiFlg; volatile bit GearNegaFlg; volatile bit HeadFlg; volatile bit Kp1Flg; volatile bit Kp2Flg; volatile bit Kp3Flg; volatile bit Kp4Flg; volatile bit Rlv1Flg; volatile bit Rlv2Flg; volatile bit OnofFlg; volatile bit GearFlg; volatile bit Pa1Flg; volatile bit Pc1Flg; volatile bit Pc2Flg; volatile bit OffFlg; volatile bit TimerFlg; volatile bit DelayFlg; volatile bit PowNumFlg; void Write_EEP(unsigned char addr,unsigned char data); unsigned char Read_EEP(unsigned char addr); //================================================================= void InitTimer(void) { //_ptm0c0 = 0b00000000; // fsys/4 = 8M/4=2M --> 0.5us //_ptm0c0 = 0b00100000; // fH/16 = 8M/16=0.5M --> 2us _ptm0c0 = 0b00110000; // fH/64 = 8M/64=0.125M --> 8us _ptm0c1 = 0b11000001; _ptm0al = 25; // 200us 125*8us=1ms _ptm0ah = 0; _ptma0f = 0; _ptma0e = 1; _mf0f = 0; _mf0e = 1; _emi = 1; _pt0on = 1; } //================================================================ void InitIO(void) { _pa = 0b01101111; _pac = 0b00110100; //1输入 0输出pa4 _papu = 0b00110000; //1上拉 0不拉 _pawu = 0b00110000; //1唤醒 0不能 _pb = 0b00000011; _pbc = 0b00000010; //pb1 _pbpu = 0b00000010; _pbsr = 0b00000010; //PB1=AN1 //_int0s1 = 1; //下降沿中断唤醒 //_int0s0 = 1; _pc = 0b00000111; _pcc = 0b00000000; _pcpu = 0b00000000; } //=============================================================== void InitADC(void) { _sacks0 = 0; _sacks1 = 0; _sacks2 = 0; //adc时钟源Fsys _enopa = 1; _vbgen = 1; _sacs2 = 0; _sacs1 = 0; _sacs0 = 1; //AN1=PB1 _sains0 = 0; _sains1 = 0; _sains2 = 0; //100外部模拟通道输入 _savrs0 = 1; _savrs1 = 1; _savrs2 = 0; _savrs3 = 1; //ADC参考电压Vbg*4=1.04*3V _enadc = 1; //ADC使能 } //=============================================================== void __attribute((interrupt(0x10))) ISR_PTM0(void) { _ptma0f = 0; Flg200us = 1; } //================================================================ void ClearRAM(void) { _mp0=0x40; for(_tblp=64;_tblp>0;_tblp--) {_iar0=0x00; _mp0++; } GearCnt0 = 0; GearPosiFlg = 1; GearCnt2 = 0; HeadFlg = 0; Rlv1Flg = 0; Rlv2Flg = 0; Kp1Flg = 0; Kp2Flg = 0; Kp3Flg = 0; Kp4Flg = 0; OffFlg = 1; TimerFlg = 0; OnoffCnt = 0; PowNumFlg = 0; } //================================================================ void Write_EEP(unsigned char addr,unsigned char data) { _eea=addr; _eed=data; _mp1=0x40; _bp=0x01; _emi=0; _iar1|=0x08; _iar1|=0x04; _emi=1; while(_iar1&0x04); _iar1=0; _bp=0; } //================================================================ unsigned char Read_EEP(unsigned char addr) { unsigned char Read_data; _eea=addr; _mp1=0x40; _bp=0x01; _iar1|=0x02; _iar1|=0x01; while(_iar1&0x01); _iar1=0; _bp=0; Read_data=_eed; return(Read_data); } //=============================================================== void PowGear(void) { PowOnVal=Read_EEP(GearAddr); if(PowOnVal==1) {Pa1Flg = 1; } else if(PowOnVal==2) {Pc1Flg = 1; } else if(PowOnVal==3) {Pc2Flg = 1; } else {Pa1Flg = 1; } } //=============================================================== void SysTick(void) { if(Flg200us==1) {Flg200us = 0; TimeCnt0++; GearCnt0++; GearCnt1++; if(TimeCnt0 >= 5) //1ms {TimeCnt0 = 0; Flg1ms = 1; KeyCnt0++; ADCTime++; TimeCnt4++; FlashTime++; } if(TimerFlg==1) { TimeCnt1++; if(TimeCnt1>235)//50ms {TimeCnt1 = 0; TimeCnt2++; } if(TimeCnt2>20)//1s {TimeCnt2 = 0; TimeCnt3++; } } } } //============================================================= void GearHead(void) { if((GearCnt0>=2)&&(GearPosiFlg==1)&&(HeadFlg==0)) {GearCnt0 = 0; GearPosiFlg = 0; MotorPWM = 1; GearNegaFlg = 1; GearCnt1 = 0; } if((GearCnt1>=8)&&(GearNegaFlg==1)&&(HeadFlg==0)) {GearCnt1 = 0; GearNegaFlg = 0; MotorPWM = 0; GearPosiFlg = 1; GearCnt0 = 0; GearCnt2++; if(GearCnt2>50)//100ms {GearCnt2 = 0; GearCnt3++; if(GearCnt3>7) {HeadFlg = 1; GearCnt0 = 0; GearCnt1 = 0; GearCnt2 = 0; GearCnt3 = 0; } } } } //================================================================ void GearOne(void) { if(HeadFlg==1) {MotorPWM = 1; //all on } } //================================================================ void GearTwo(void) { if((GearCnt0>=13)&&(GearPosiFlg==1)&&(HeadFlg==1))//2.5ms high {GearCnt0 = 0; GearPosiFlg = 0; MotorPWM = 1; GearNegaFlg = 1; GearCnt1 = 0; } if((GearCnt1>=8)&&(GearNegaFlg==1)&&(HeadFlg==1))//1.6ms low {GearCnt1 = 0; GearNegaFlg = 0; MotorPWM = 0; GearPosiFlg = 1; GearCnt0 = 0; } } //================================================================ void GearThr(void) { if((GearCnt0>=8)&&(GearPosiFlg==1)&&(HeadFlg==1))//1.6ms high {GearCnt0 = 0; GearPosiFlg = 0; MotorPWM = 1; GearNegaFlg = 1; GearCnt1 = 0; } if((GearCnt1>=11)&&(GearNegaFlg==1)&&(HeadFlg==1))//2.2ms low {GearCnt1 = 0; GearNegaFlg = 0; MotorPWM = 0; GearPosiFlg = 1; GearCnt0 = 0; } } //========================================================== void ScanKey(void) { if((Kp1Flg==0)&&(Rlv1Flg==0)) {if(OnOffKey==1)//no press {Rlv1Flg = 0; } else {Rlv1Flg = 1; Kp1Flg = 1; KeyCnt0 = 0; } } if((Kp2Flg==0)&&(Rlv2Flg==0)) {if(GearKey==1)//no press {Rlv2Flg = 0; } else {Rlv2Flg = 1; Kp2Flg = 1; KeyCnt0 = 0; } } if((Kp1Flg==1)&&(KeyCnt0>20))//30 {KeyCnt0 = 0; Kp1Flg = 0; if(OnOffKey==0) {Kp3Flg = 1; } else {Rlv1Flg = 0; } } if((Kp2Flg==1)&&(KeyCnt0>20))//30 {KeyCnt0 = 0;