Erste Versuche mit wärmebildkamera,

2 ultraschallsensoren an einen esp angeschlossen
This commit is contained in:
Johannes Krug
2019-06-19 15:31:43 +02:00
parent 4441a65bfc
commit 944d0a19b1
15 changed files with 2347 additions and 20 deletions
@@ -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;
}