이하늘임동교gledel
Created August 28, 2017 © GPL3+

InoLab : Ultrasonic sensor + Motor

This project was made by Innovation Lab at Bongilcheon High School.

BeginnerProtip30 minutes95
InoLab : Ultrasonic sensor + Motor

Things used in this project

Story

Read more

Schematics

__whfxRqYKNb.png

Code

Untitled file

Arduino
const int trigPin = 3;
const int echoPin = 4;
long distance;
long duration;
int motor_A = 5; 
int motor_B = 6; 
void setup()
{
  pinMode(motor_A,OUTPUT);
  pinMode(motor_B,OUTPUT);
  pinMode(2,OUTPUT);
  pinMode(trigPin, OUTPUT); 
  pinMode(echoPin, INPUT);
}

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

void motor(){
 if(distance<30){
  analogWrite(2,255);
  digitalWrite(motor_A,HIGH);
  digitalWrite(motor_B,LOW);
   
 }
 else{
  analogWrite(2,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;
}

Credits

이하늘
5 projects • 3 followers
Contact
임동교
0 projects • 12 followers
Contact
gledel
100 projects • 116 followers
Looking back on my childhood, I was happy when I was making something and I was proud of myself. "Making is instinct!"
Contact

Comments

Please log in or sign up to comment.