Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define trigPin 13
- #define echoPin 12
- #define BPin 7
- #define piezoPin 9
- #define RPin 4
- #define GPin 8
- void setup() {
- Serial.begin (9600);
- pinMode(trigPin, OUTPUT);
- pinMode(echoPin, INPUT);
- pinMode(BPin, OUTPUT);
- pinMode(piezoPin, OUTPUT);
- pinMode(RPin, OUTPUT);
- pinMode(GPin, OUTPUT);
- }
- void loop() {
- long duration, distance;
- digitalWrite(trigPin, LOW);
- delayMicroseconds(2);
- digitalWrite(trigPin, HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin, LOW);
- duration = pulseIn(echoPin, HIGH);
- distance = (duration/2) / 29.1;
- if (distance >= 200 || distance <= 0){
- Serial.println("Out of range");
- }
- else {
- Serial.print(distance);
- Serial.println(" cm");
- }
- delay(1000);
- {if (distance <= 25 || distance <= 0){
- digitalWrite(RPin, HIGH);
- }
- else{
- digitalWrite(RPin, LOW);
- }
- }
- {
- if (distance >= 25 && distance <= 50){
- digitalWrite(GPin, HIGH);
- }
- else {
- digitalWrite(GPin, LOW);
- }
- { if (distance >= 50 && distance <= 75){
- digitalWrite(GPin, HIGH);
- }
- else {
- digitalWrite(BPin, LOW);
- }
- {if (distance >= 75 && distance <= 100){
- digitalWrite(BPin, HIGH);
- }
- else {
- digitalWrite(GPin, LOW);
- {
- {if (distance >= 100 && distance <= 200){
- digitalWrite(piezoPin, HIGH);
- }
- else {
- digitalWrite(piezoPin, LOW);
- }
- }
- }
- }
- }
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement