Ultrasonic Sensor and Servo Motor Code

You might also like

Download as docx, pdf, or txt
Download as docx, pdf, or txt
You are on page 1of 6

Digital Number increment using Ultrasonic Sensor Code

const int echo =6;


const int trig =5;

int pinA = 13;


int pinB = 12;
int pinC = 11;
int pinD = 10;
int pinE = 9;
int pinF = 8;
int pinG = 7;

int duration = 0;
int distance = 0;
int counter = 0;

void setup(){
pinMode(pinA,OUTPUT);
pinMode(pinB,OUTPUT);
pinMode(pinC,OUTPUT);
pinMode(pinD,OUTPUT);
pinMode(pinE,OUTPUT);
pinMode(pinF,OUTPUT);
pinMode(pinG,OUTPUT);
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
Serial.begin(9600);
}
void loop(){
digitalWrite(trig, HIGH);
delayMicroseconds(1000);
digitalWrite(trig, LOW);

duration = pulseIn(echo,HIGH);
distance = (duration/2) /28.5;
Serial.println(distance);

// distance of ball to score


if (distance == 5){
if (counter == 0){
counter++;
digitalWrite(pinA, LOW);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, LOW);
digitalWrite(pinE, LOW);
digitalWrite(pinF, LOW);
digitalWrite(pinG, LOW);
delay(1000);
}
else if (counter == 1){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, LOW);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 2){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, LOW);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 3){
digitalWrite(pinA, LOW);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, LOW);
digitalWrite(pinE, LOW);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 4){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, LOW);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, LOW);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 5){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, LOW);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, HIGH);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 6){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, LOW);
digitalWrite(pinE, LOW);
digitalWrite(pinF, LOW);
digitalWrite(pinG, LOW);
delay(1000);
counter++;
} else if (counter == 7){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, HIGH);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 8){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, LOW);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, HIGH);
delay(1000);
counter++;
} else if (counter == 9){
digitalWrite(pinA, HIGH);
digitalWrite(pinB, HIGH);
digitalWrite(pinC, HIGH);
digitalWrite(pinD, HIGH);
digitalWrite(pinE, HIGH);
digitalWrite(pinF, HIGH);
digitalWrite(pinG, LOW);
delay(1000);
counter=0;
}

}
}

Ultrasonic sensor detecting distance using LED


code
const int echo =6;
const int trig =5;

const int led_red= 5;


const int led_yellow= 6;
const int led_green= 7;

int duration = 0;
int distance = 0;

void setup(){
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
Serial.begin(9600);
}

void loop(){
digitalWrite(trig, HIGH);
delayMicroseconds(1000);
digitalWrite(trig, LOW);

duration = pulseIn(echo,HIGH);
distance = (duration/2) /28.5;
Serial.println(distance);

// LED ON depends on distance


if (distance >=24){
digitalWrite(led_green,HIGH);
digitalWrite(led_yellow,LOW);
digitalWrite(led_red,LOW);
}
else if (distance >=12 && distance <=24){
digitalWrite(led_green,LOW);
digitalWrite(led_yellow,HIGH);
digitalWrite(led_red,LOW);
}
else if (distance < 12){
digitalWrite(led_green,LOW);
digitalWrite(led_yellow,LOW);
digitalWrite(led_red,HIGH);
}
}
Servo motor

#include <Servo.h>

Servo servo;
void setup() {
// put your setup code here, to run once:
servo.attach(13);
servo.write(0);
delay(2000);
}

void loop() {
// put your main code here, to run repeatedly:
servo.write(90);
delay(2000);
servo.write(0);
delay(2000);
servo.write(45);
delay(2000);
}

You might also like