#include <NewPing.h>
#define TRIGGER_PIN 4//4端口
#define ECHO_PIN 7//7端口
#define MAX_DISTANCE 200//最大距离是400-500cm,我们需要可以设定200cm
NewPing DistanceSensor(TRIGGER_PIN,ECHO_PIN,MAX_DISTANCE);//设置端口和最大距离
int ledPin1=14;
int ledPin2=15;
int IN1=6;
int IN2=9;
int IN3=10;
int IN4=11;
int EN1=3;
int EN2=5;
int analogInPin =A2;
int C = 0;
int A = 0;
int B = 0;
int state =2;
int length;
int tonePin=13; //定义数字13 喇叭接口
void forward()
{
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
analogWrite(EN1,A);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
analogWrite(EN2,B);
goLight();
}
void backup()
{
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
analogWrite(EN1,A);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
analogWrite(EN2,B);
baLight();
}
void right()
{
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
analogWrite(EN1,A);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);