Difference between revisions of "ECE 110/Equipment/Ping Sensor"
(→Sample Code) |
EBortolomiol (talk | contribs) (Removed alternate mount. Changed the simplified code to use pin 50 instead of pin 35) |
||
Line 134: | Line 134: | ||
modified 5 Sep 2022 | modified 5 Sep 2022 | ||
by Michael Gustafson | by Michael Gustafson | ||
+ | modified 25 July 2024 | ||
+ | by Eduardo Bortolomiol | ||
This example code is in the public domain. | This example code is in the public domain. | ||
Line 139: | Line 141: | ||
original: https://www.arduino.cc/en/Tutorial/BuiltInExamples/Ping | original: https://www.arduino.cc/en/Tutorial/BuiltInExamples/Ping | ||
*/ | */ | ||
− | #include <Servo.h> | + | #include <Servo.h> |
− | const int pingPin = | + | |
+ | // this constant won't change. It's the pin number of the sensor's output: | ||
+ | const int pingPin = 50; | ||
+ | |||
Servo servoLeft; | Servo servoLeft; | ||
Servo servoRight; | Servo servoRight; | ||
void setup() { | void setup() { | ||
+ | // initialize serial communication: | ||
Serial.begin(9600); | Serial.begin(9600); | ||
− | |||
− | |||
− | |||
− | |||
servoLeft.attach(12); | servoLeft.attach(12); | ||
Line 199: | Line 201: | ||
} | } | ||
</syntaxhighlight> | </syntaxhighlight> | ||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
− | |||
== Notes == | == Notes == |
Revision as of 16:24, 25 July 2024
Introduction
The PING ultrasonic sensor is capable of measuring distances by using ultrasonic signals that it bounces off objects. Based on the time it takes for the signal to go from the transmitter, to the object, and back the the receiver, the sensor can estimate distance travelled and then report half that as the distance away from the object.
Leads
There are two styles of PING sensor - one has three leads and the other has four leads. The CX-Bot has a header in place for the three-pin version so that will be the one used in ECE 110. Information on the four-pin version is also provided below.
For the three-pin version of the PING sensor, going from left to right when looking at the front:
- GND: Ground
- VCC: Supply voltage, typically 5 V
- SIG: Pin to set high to trigger the Ping to send a pulse and to monitor to detect the pulse
For the four-pin version of the PING sensor, going from left to right when looking at the front:
- VCC: Supply voltage, typically 5 V
- TRIG: Pin to set high to trigger the Ping to send a pulse
- ECHO: Pin to read to detect the pulse
- GND: Ground
Operation
Sample Code
The following code is adapted from https://docs.arduino.cc/built-in-examples/sensors/Ping; the only change is the the CX-Bot uses pin 50 to communicate with the sensor.
/*
Ping))) Sensor
This sketch reads a PING))) ultrasonic rangefinder and returns the distance
to the closest object in range. To do this, it sends a pulse to the sensor to
initiate a reading, then listens for a pulse to return. The length of the
returning pulse is proportional to the distance of the object from the sensor.
The circuit:
- +V connection of the PING))) attached to +5V
- GND connection of the PING))) attached to ground
- SIG connection of the PING))) attached to digital pin 7
created 3 Nov 2008
by David A. Mellis
modified 30 Aug 2011
by Tom Igoe
This example code is in the public domain.
https://www.arduino.cc/en/Tutorial/BuiltInExamples/Ping
*/
// this constant won't change. It's the pin number of the sensor's output:
const int pingPin = 50;
void setup() {
// initialize serial communication:
Serial.begin(9600);
}
void loop() {
// establish variables for duration of the ping, and the distance result
// in inches and centimeters:
long duration, inches, cm;
// The PING))) is triggered by a HIGH pulse of 2 or more microseconds.
// Give a short LOW pulse beforehand to ensure a clean HIGH pulse:
pinMode(pingPin, OUTPUT);
digitalWrite(pingPin, LOW);
delayMicroseconds(2);
digitalWrite(pingPin, HIGH);
delayMicroseconds(5);
digitalWrite(pingPin, LOW);
// The same pin is used to read the signal from the PING))): a HIGH pulse
// whose duration is the time (in microseconds) from the sending of the ping
// to the reception of its echo off of an object.
pinMode(pingPin, INPUT);
duration = pulseIn(pingPin, HIGH);
// convert the time into a distance
inches = microsecondsToInches(duration);
cm = microsecondsToCentimeters(duration);
Serial.print(inches);
Serial.print("in, ");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(100);
}
long microsecondsToInches(long microseconds) {
// According to Parallax's datasheet for the PING))), there are 73.746
// microseconds per inch (i.e. sound travels at 1130 feet per second).
// This gives the distance travelled by the ping, outbound and return,
// so we divide by 2 to get the distance of the obstacle.
// See: https://www.parallax.com/package/ping-ultrasonic-distance-sensor-downloads/
return microseconds / 74 / 2;
}
long microsecondsToCentimeters(long microseconds) {
// The speed of sound is 340 m/s or 29 microseconds per centimeter.
// The ping travels out and back, so to find the distance of the object we
// take half of the distance travelled.
return microseconds / 29 / 2;
}
- The above code will round to the nearest inch or centimeter. If you want higher resolution, you can use floats for those items instead of long integers. Here is how to change the code to make it more accurate:
- replace
long duration, inches, cm;
- with
long duration; float inches, cm;
- replace
long
- in front of the microsecondsToInches and microsecondsToCentimeters functions with
float
- replace the integers in the returns with floats; that is:
return microseconds / 74 / 2;
- and
return microseconds / 29 / 2;
- with
return microseconds / 74.074 / 2.0;
- and
return microseconds / 29.155 / 2.0;
Here is a simplified version of the whole code (using 1125 ft/s and 343 m/s as the speed of sound):
/*
Ping))) Sensor - higher res
created 3 Nov 2008
by David A. Mellis
modified 30 Aug 2011
by Tom Igoe
modified 5 Sep 2022
by Michael Gustafson
modified 25 July 2024
by Eduardo Bortolomiol
This example code is in the public domain.
original: https://www.arduino.cc/en/Tutorial/BuiltInExamples/Ping
*/
#include <Servo.h>
// this constant won't change. It's the pin number of the sensor's output:
const int pingPin = 50;
Servo servoLeft;
Servo servoRight;
void setup() {
// initialize serial communication:
Serial.begin(9600);
servoLeft.attach(12);
servoRight.attach(11);
}
void loop() {
long duration;
float inches, cm;
// short LOW pulse to ensure a clean HIGH pulse:
pinMode(pingPin, OUTPUT);
digitalWrite(pingPin, LOW);
// 2 ms HIGH pulse
delayMicroseconds(2);
digitalWrite(pingPin, HIGH);
// back to LOW
delayMicroseconds(5);
digitalWrite(pingPin, LOW);
// The same pin is used to read the signal from the PING))):
// a HIGH pulse whose duration is the time (in microseconds)
// from the sending of the ping to the reception of
// its echo off of an object.
pinMode(pingPin, INPUT);
duration = pulseIn(pingPin, HIGH);
// convert the time into a distance
inches = microsecondsToInches(duration);
cm = microsecondsToCentimeters(duration);
Serial.print(inches);
Serial.print("in, ");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(200);
}
float microsecondsToInches(long microseconds) {
// The speed of sound is about 1125 ft/s
// Sound takes about 74.074 us to travel 1 in
return microseconds / 74.074 / 2;
}
float microsecondsToCentimeters(long microseconds) {
// The speed of sound is about 343 m/s
// Sound takes about 29.155 us to travel 1 cm
return microseconds / 29.155 / 2.0;
}
Notes
References
- Three-pin Data Sheet from Parallax via DigiKey.
- Four-pin Data Sheet from Mouser.