mrkd
9/22/2014 - 2:44 AM

Arduino Sonar Distance

Arduino Sonar Distance

// ---------------------------------------------------------------------------
// Example NewPing library sketch that does a ping about 20 times per second.
// ---------------------------------------------------------------------------

#include <NewPing.h>


// LED Colors
int ledcolor = 0;
int a = 1000; //this sets how long the stays one color for
int red = 2; //this sets the red led pin
int green = 3; //this sets the green led pin
int blue = 4; //this sets the blue led pin

#define TRIGGER_PIN  12  // Arduino pin tied to trigger pin on the ultrasonic sensor.
#define ECHO_PIN     11  // Arduino pin tied to echo pin on the ultrasonic sensor.
#define MAX_DISTANCE 200 // Maximum distance we want to ping for (in centimeters). Maximum sensor distance is rated at 400-500cm.

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup of pins and maximum distance.

void setup() {
  Serial.begin(115200); // Open serial monitor at 115200 baud to see ping results.
  
    pinMode(red, OUTPUT);
    pinMode(green, OUTPUT);
    pinMode(blue, OUTPUT);
  
}

void loop() {
  delay(50);                      // Wait 50ms between pings (about 20 pings/sec). 29ms should be the shortest delay between pings.
  unsigned int uS = sonar.ping(); // Send ping, get ping time in microseconds (uS).
  Serial.print("Ping: ");
  
  int distanceCMs = (uS / US_ROUNDTRIP_CM);
  Serial.print(distanceCMs); // Convert ping time to distance and print result (0 = outside set distance range, no ping echo)
  if (distanceCMs < 5) {
      showGreen();
      
  }
  else if (distanceCMs < 15) {
    showYellow();
  }
  else {
    showRed();
  }
  
  Serial.println("cm");
}



void clearValues() {
  digitalWrite(red, LOW);
  digitalWrite(blue, LOW);
  digitalWrite(green, LOW);
}

void showGreen(){
  clearValues();
  digitalWrite(green, HIGH);
}

void showRed() {
  clearValues();
  Serial.print("Red");
  analogWrite(red, 204);
}

void showYellow() {
  clearValues();
  analogWrite(red, 190);
  digitalWrite(green, HIGH);
}