Erste Versuche mit wärmebildkamera,
2 ultraschallsensoren an einen esp angeschlossen
This commit is contained in:
@@ -11,20 +11,24 @@ WiFiClient espClient;
|
||||
PubSubClient client(espClient);
|
||||
|
||||
// defines pins numbers
|
||||
const int trigPin = 2; //D4
|
||||
const int echoPin = 0; //D3
|
||||
const int trigPin = D3; //D4
|
||||
const int echoPin1 = D4; //D3
|
||||
|
||||
long duration1;
|
||||
|
||||
int distance1;
|
||||
|
||||
long duration;
|
||||
int distance;
|
||||
int bool1 = 0;
|
||||
|
||||
char msg[50];
|
||||
int value = 0;
|
||||
long lastMsg = 0;
|
||||
|
||||
void setup() {
|
||||
pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output
|
||||
pinMode(echoPin, INPUT); // Sets the echoPin as an Input
|
||||
pinMode(echoPin1, INPUT); // Sets the echoPin as an Input
|
||||
|
||||
|
||||
Serial.begin(115200);
|
||||
setup_wifi();
|
||||
client.setServer(MQTT_BROKER, 1883);
|
||||
@@ -79,45 +83,59 @@ void loop() {
|
||||
digitalWrite(trigPin, LOW);
|
||||
|
||||
// Reads the echoPin, returns the sound wave travel time in microseconds
|
||||
duration = pulseIn(echoPin, HIGH);
|
||||
|
||||
duration1 = pulseIn(echoPin1, HIGH);
|
||||
|
||||
|
||||
// Calculating the distance
|
||||
distance = duration * 0.034 / 2;
|
||||
// Prints the distance on the Serial Monitor
|
||||
/* if ((distance != (distance_alt - 1)) && (distance != (distance_alt)) && (distance != (distance_alt + 1))) { //+-1 um störungen herauszufiltern
|
||||
distance1 = getDistance(duration1);
|
||||
|
||||
// Prints the distance1 on the Serial Monitor
|
||||
/* if ((distance1!= (distance_alt - 1)) && (distance1!= (distance_alt)) && (distance1!= (distance_alt + 1))) { //+-1 um störungen herauszufiltern
|
||||
snprintf (msg, 50, "%d", distance);
|
||||
Serial.print("Publish Motion: ");
|
||||
Serial.println(msg);
|
||||
client.publish("/home/data", msg);
|
||||
delay(200);
|
||||
} */
|
||||
bool1 = presenceDetection(bool1, distance1);
|
||||
|
||||
|
||||
delay(80);
|
||||
}
|
||||
|
||||
int presenceDetection(int bool1, int distance1){
|
||||
|
||||
if (bool1 == 0) {
|
||||
//alternativ: if ((distance != (DISTANCE - 1)) && (distance != (DISTANCE)) && (distance != (DISTANCE + 1))) { //+-1
|
||||
if (((DISTANCE + 2) < distance) || ((DISTANCE - 2) > distance)) { //darf +- 2 um festgelegte entfernung schwanken, um störungen herauszufiltern
|
||||
//alternativ: if ((distance1!= (DISTANCE - 1)) && (distance1!= (DISTANCE)) && (distance1!= (DISTANCE + 1))) { //+-1
|
||||
|
||||
if (((distance1 > (DISTANCE + 2)) || (distance1 < (DISTANCE - 2))) && (distance1 < (DISTANCE + 2))) { //darf +- 2 um festgelegte entfernung schwanken, um störungen herauszufiltern
|
||||
//Meldung an PI, dass die Distanz gestört ist
|
||||
snprintf (msg, 50, "%d", 1);
|
||||
client.publish("/gso/bb/104/ultraschall/1", msg);
|
||||
//Serieller Monitor
|
||||
Serial.print("Motion detected! Distance: ");
|
||||
Serial.println(distance);
|
||||
Serial.println(distance1);
|
||||
|
||||
//Flag auf 1
|
||||
bool1 = 1;
|
||||
bool1 = 1;
|
||||
return bool1;
|
||||
}
|
||||
else {
|
||||
snprintf (msg, 50, "%d", 0);
|
||||
client.publish("/gso/bb/104/ultraschall/1", msg);
|
||||
|
||||
return bool1;
|
||||
}
|
||||
|
||||
}
|
||||
else if (bool1 == 1) {
|
||||
if (((DISTANCE + 2) < distance) || ((DISTANCE - 2) > distance)) { //darf +- 2 um festgelegte entfernung schwanken, um störungen herauszufiltern
|
||||
if (((distance1> (DISTANCE + 2)) || (distance1<(DISTANCE - 2)))) { //darf +- 2 um festgelegte entfernung schwanken, um störungen herauszufiltern
|
||||
Serial.print("Still motion detected! Distance: ");
|
||||
Serial.println(distance);
|
||||
Serial.println(distance1);
|
||||
//Meldung an PI, dass die Ausgangsdistanz wieder gemessen wird
|
||||
snprintf (msg, 50, "%d", 1);
|
||||
client.publish("/gso/bb/104/ultraschall/1", msg);
|
||||
|
||||
return bool1;
|
||||
}
|
||||
else {
|
||||
//Meldung an PI, dass die Ausgangsdistanz wieder gemessen wird
|
||||
@@ -126,8 +144,13 @@ void loop() {
|
||||
|
||||
//Flag wieder auf 0
|
||||
bool1 = 0;
|
||||
return bool1;
|
||||
|
||||
}
|
||||
}
|
||||
delay(100);
|
||||
}
|
||||
|
||||
int getDistance(int duration){
|
||||
int distance = duration * 0.034 / 2;
|
||||
return distance;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user