Grundfunktion für Ultraschallsensor und LED Licht

This commit is contained in:
Stefan H. 2022-05-03 22:19:00 +02:00
parent b00bf39e57
commit c11fc035db
1 changed files with 107 additions and 0 deletions

107
Abstandssensor.ino Normal file
View File

@ -0,0 +1,107 @@
#include <NeoPixelBus.h>
#include <NeoPixelSegmentBus.h>
#include <NeoPixelAnimator.h>
#include <NeoPixelBrightnessBus.h>
// DEV or PROD Setup
#define DEBUG
// Only for ESP8266 D1 Mini
#define ECHO 5 // D1
#define TRIG 16 // D0
#define POTI_IN 17 // A0, analog In
#define DATA_PIN 3
const uint16_t PixelCount = 8;
NeoPixelBus<NeoGrbFeature, NeoEsp8266Dma800KbpsMethod> strip(PixelCount, DATA_PIN);
long duration; // Variable um die Zeit der Ultraschall-Wellen zu speichern
float distance; // Variable um die Entfernung zu berechnen
int poti;
int percent=0;
int colorSaturation=255;
RgbColor red(colorSaturation, 0, 0);
RgbColor green(0, colorSaturation, 0);
RgbColor yellow(colorSaturation, colorSaturation, 0);
RgbColor blue(0, 0, colorSaturation);
RgbColor white(colorSaturation);
RgbColor black(0);
void setup() {
pinMode(TRIG, OUTPUT); // TRIG-Pin: Output
pinMode(ECHO, INPUT); // ECHO-Pin: Input
#ifdef DEBUG
Serial.begin(9600); // Baudrate: 115200
#endif
// this resets all the neopixels to an off state
strip.Begin();
for(int i=0; i<PixelCount; i++) {strip.SetPixelColor(i, red);}
strip.Show();
}
void setColor(RgbColor c) {
for(int i=0; i<PixelCount; i++) {
strip.SetPixelColor(i, c);
}
strip.Show();
}
void setRed() {
setColor(red);
}
void setYellow() {
setColor(yellow);
}
void setGreen() {
setColor(green);
}
void loop() {
// Read poti (Value range 16 - 1024)
poti=analogRead(POTI_IN);
// Measure Distance
digitalWrite(TRIG, LOW); delayMicroseconds(2);
// TRIG-Pin ist HIGH für 10 Microsekunden
digitalWrite(TRIG, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG, LOW);
// Liest das ECHO aus und speichert die Zeit von Senden / Empfangen in Microsekunden
duration = pulseIn(ECHO, HIGH);
// Berechnung der Entfernung
// Da der Weg doppel ist: Hinweg - Rückweg, muss der Wert durch 2 geteilt werden
distance = duration * 0.034 / 2;
// Set color depending on poti
// We assume poti value/20 (resulting in range <1,5 cm - 100cm)
// Green if we are more than 50% above goal, yellow below 50% of goal, red at or below goal
percent=distance/((float)poti/10)*100;
if (percent >150) { setGreen(); }
else if (percent >100) { setYellow(); }
else {setRed(); }
// Anzeige der Entfernung im seriellen Monitor
#ifdef DEBUG
Serial.println("Poti: " + String(poti));
Serial.println("Entfernung: " + String(distance) + "cm");
Serial.println("Percent: " + String(percent) + " of goal value");
#endif
delay(100);
}