超声波避障小车程序(共4页).docx

《超声波避障小车程序(共4页).docx》由会员分享，可在线阅读，更多相关《超声波避障小车程序(共4页).docx（4页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

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); pinMode(pin1,OUTPUT); pinMode(Motor3,OUTPUT); pin

2、Mode(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(250); void qj(int t1) analogWrite(pin1,pwm); digita

3、lWrite(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); digitalWrite(Motor3,HIGH); digitalWrite(Motor4,LOW)

4、; 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(pin2,pwm); digitalWrite(Motor3,HIGH); digitalWrite(Motor4,LOW); delay(t5); 专心-专注-专业