超声波避障小车程序

1、精选优质文档-倾情为你奉上精选优质文档-倾情为你奉上专心-专注-专业专心-专注-专业精选优质文档-倾情为你奉上专心-专注-专业 int Motor1=8; int Motor2=9; int Motor3=10; int Motor4=11; int in=3; int out=2; int pin1=5; int pin2=6; int pwm=100; void setup() Serial.begin(9600); pinMode(in,INPUT); pinMode(out,OUTPUT); pinMode(Motor1,OUTPUT); pinMode(Motor2,OUTPUT);

2、 pinMode(pin1,OUTPUT); pinMode(Motor3,OUTPUT); pinMode(Motor4,OUTPUT); pinMode(pin2,OUTPUT); void loop() digitalWrite(out,LOW); delayMicroseconds(2); digitalWrite(out,HIGH); delayMicroseconds(10); digitalWrite(out,LOW); float pin=pulseIn(in,HIGH); pin=pin/58.0; if(pin=50) qj(100); else ht(500); zz(2

3、50); void qj(int t1) analogWrite(pin1,pwm); digitalWrite(Motor1,LOW); digitalWrite(Motor2,HIGH); analogWrite(pin2,pwm); digitalWrite(Motor3,LOW); digitalWrite(Motor4,HIGH); delay(t1); void ht(int t2) analogWrite(pin1,pwm); digitalWrite(Motor1,HIGH); digitalWrite(Motor2,LOW); analogWrite(pin2,pwm); d

4、igitalWrite(Motor3,HIGH); digitalWrite(Motor4,LOW); delay(t2); void tz(int t3) analogWrite(pin1,0); digitalWrite(Motor1,LOW); digitalWrite(Motor2,LOW); analogWrite(pin2,0); digitalWrite(Motor3,LOW); digitalWrite(Motor4,LOW); delay(t3); void zz(int t4) analogWrite(pin1,pwm); digitalWrite(Motor1,HIGH); digitalWrite(Motor2,LOW); analogWrite(pin2,pwm); digitalWrite(Motor3,LOW); digitalWrite(Motor4,HIGH); delay(t4); void yz(int t5) analogWrite(pin1,pwm); digitalWrite(Motor1,LOW); digitalWrite(Motor2,HIGH); analogWrite(