双路舵机控制.docVIP

双路舵机控制 #includelt;reg52.hgt; unsigned char count1; sbit pwm=P3^0; sbit pwm2=P1^0; sbit jia=P3^7; sbit jan=P3^6; sbit zh=P3^5; bit temp=0; unsigned char jd,jd1,jd2; sbit dula=P2^6; sbit wela=P2^7; unsigned char code table[]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x77,0x7c,0x39,0x5e,0x79,0x71}; void delay(unsigned char i) {unsigned char j,k; for(j=i;jgt;0;j--) for(k=125;kgt;0;k--); } void Time0_Init() {TMOD=0x11; IE=0x82; TH0=0xfe; TL0=0x33; TR0=1; } void Time0_Int()interrupt 1 {TH0=0xfe; TL0=0x33; if(temp==0) {jd=jd1;} else jd=jd2; if(count1lt;jd) {if(temp==0) {pwm2=1;} else if(temp==1) {pwm=1;} } else {if(temp==0) {pwm2=0;} else if(temp==1) {pwm=0;} } count1=(count1+1); count1=count1%40; } void keyscan() { if(temp==0) {if(jia==0) {delay(10); if(jia==0) {jd1++; count1=0; if(jd==6) jd1=5; while(jia==0); } } if(jan==0) {delay(10); if(jan==0) {jd1--; count1=0; if(jd==0) jd1=1; while(jan==0); } } if(zh==0) {delay(10); if(zh==0) temp=~temp; while(zh==0); } } else if(temp==1) {if(jia==0) {delay(10); if(jia==0) {jd2++; count1=0; if(jd==6) jd2=5; while(jia==0); } } if(jan==0) {delay(10); if(jan==0) {jd2--; count1=0; if(jd==0) jd2=1; while(jan==0); } } if(zh==0) {delay(10); if(zh==0) temp=~temp; while(zh==0); } } } void display() { unsigned char bai,shi,ge; switch(jd) {case 1: bai=0; shi=0; ge=0; break; case 2: bai=0; shi=4; ge=5; break; case 3: bai=0; shi=9; ge=0; break; case 4: bai=1; shi=3; ge=5; break; case 5: bai=1; shi=8; ge=0; brea