超声波舵机成功(共6页).doc

精选优质文档-倾情为你奉上#include#include #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;