Add single‑pin Sonar support with periodic reading
Implemented Sonar constructor to use a single shared pin, added mode flag and helper method for single‑pin measurements. Updated measure() to select the appropriate implementation and added timeout to pulseIn. Integrated periodic sonar updates in the main loop, tracking last update time and toggling a seatBelts flag based on distance thresholds.
This commit is contained in:
@@ -1,21 +1,26 @@
|
||||
#include "Sonar.h"
|
||||
|
||||
Sonar::Sonar(int trigPin, int echoPin, long maxDistCm)
|
||||
: _trigPin(trigPin), _echoPin(echoPin),
|
||||
_maxDistCm(maxDistCm), _lastDistance(0) {
|
||||
pinMode(_trigPin, OUTPUT);
|
||||
pinMode(_echoPin, INPUT);
|
||||
Sonar::Sonar(int sharedPin, long maxDistCm)
|
||||
: _trigPin(sharedPin),
|
||||
_echoPin(sharedPin),
|
||||
_singlePinMode(true),
|
||||
_maxDistCm(maxDistCm),
|
||||
_lastDistance(0) {
|
||||
}
|
||||
|
||||
long Sonar::measure() {
|
||||
digitalWrite(_trigPin, LOW);
|
||||
delayMicroseconds(2);
|
||||
digitalWrite(_trigPin, HIGH);
|
||||
delayMicroseconds(10);
|
||||
digitalWrite(_trigPin, LOW);
|
||||
if (_singlePinMode) {
|
||||
_lastDistance = _measureSinglePin();
|
||||
} else {
|
||||
digitalWrite(_trigPin, LOW);
|
||||
delayMicroseconds(2);
|
||||
digitalWrite(_trigPin, HIGH);
|
||||
delayMicroseconds(10);
|
||||
digitalWrite(_trigPin, LOW);
|
||||
|
||||
long duration = pulseIn(_echoPin, HIGH);
|
||||
_lastDistance = duration / 58;
|
||||
long duration = pulseIn(_echoPin, HIGH, 30000UL);
|
||||
_lastDistance = duration / 58;
|
||||
}
|
||||
|
||||
if (_lastDistance > _maxDistCm) {
|
||||
_lastDistance = _maxDistCm;
|
||||
@@ -24,6 +29,24 @@ long Sonar::measure() {
|
||||
return _lastDistance;
|
||||
}
|
||||
|
||||
long Sonar::_measureSinglePin() {
|
||||
pinMode(_trigPin, OUTPUT);
|
||||
digitalWrite(_trigPin, LOW);
|
||||
delayMicroseconds(4);
|
||||
|
||||
digitalWrite(_trigPin, HIGH);
|
||||
delayMicroseconds(10);
|
||||
digitalWrite(_trigPin, LOW);
|
||||
|
||||
pinMode(_echoPin, INPUT);
|
||||
|
||||
delayMicroseconds(15);
|
||||
|
||||
long duration = pulseIn(_echoPin, HIGH, 30000UL);
|
||||
|
||||
return duration / 58;
|
||||
}
|
||||
|
||||
long Sonar::getDistance() const {
|
||||
return _lastDistance;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user