超声波舵机成功.docVIP

#includeAT89x51.H #include intrins.h #define Sevro_moto_pwm P2_7 //接舵机信号端输入PWM信号调节速度 #define ECHO P2_4 //超声波接口定义 #define TRIG P2_5 //超声波接口定义 #define Left_moto_go {P1_0=1,P1_1=0,P1_2=1,P1_3=0;} //左边两个电机向前走 #define Left_moto_back {P1_0=0,P1_1=1,P1_2=0,P1_3=1;} //左边两个电机向后转 #define Left_moto_Stop {P1_0=0,P1_1=0,P1_2=0,P1_3=0;} //左边两个电机停转 #define Right_moto_go {P1_4=1,P1_5=0,P1_6=1,P1_7=0;} //右边两个电机向前走 #define Right_moto_back {P1_4=0,P1_5=1,P1_6=0,P1_7=1;} //右边两个电机向前走 #define Right_moto_Stop {P1_4=0,P1_5=0,P1_6=0,P1_7=0;} //右边两个电机停转 unsigned char const discode[] ={ 0xC0,0xF9,0xA4,0xB0,