Innovation Lab #17 Ultrasonic_Motor

const int trigPin = 11;
const int echoPin = 12;
long distance;
long duration;
int motor_A = 5; 
int motor_B = 6; 

void setup() {
 pinMode(motor_A, OUTPUT);
 pinMode(motor_B, OUTPUT);
 pinMode(3, OUTPUT); 
 pinMode(trigPin, OUTPUT);
 pinMode(echoPin, INPUT);
 }

void loop() {
  ultra();
  motor();
 }

void motor(){
if(distance <30){
  analogWrite(3, 255);
  digitalWrite(motor_A, HIGH);
  digitalWrite(motor_B, LOW);
}
else{
  analogWrite(3, 255);
  digitalWrite(motor_A, HIGH);
  digitalWrite(motor_B, HIGH);
}
}

void ultra(){
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance= duration*0.034/2;
}