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:
2026-06-17 00:03:17 +02:00
parent 23d5003788
commit c053a296a5
3 changed files with 51 additions and 18 deletions
+35 -12
View File
@@ -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;
}