-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmain.ino
47 lines (35 loc) · 1.15 KB
/
main.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
#include <NewPing.h>
#define SONAR_NUM 2
#define MAX_DISTANCE 50
NewPing sonar[SONAR_NUM] = {
NewPing(4, 5, MAX_DISTANCE), // trigger, echo, max distance.
NewPing(8, 9, MAX_DISTANCE)
};
void setup() {
Serial.begin(9600);
Serial.println("-----------------------");
}
void loop() {
Serial.print("SENSOR PING AB = ");
float pingSensor1=sonar[0].ping_median(6);
//float pingSensor1=sonar[0].ping();
Serial.print(pingSensor1);
Serial.println(" us");
delay(1000);
Serial.print("SENSOR PING BA = ");
float pingSensor2=sonar[1].ping_median(6);
//float pingSensor2=sonar[1].ping();
Serial.print(pingSensor2);
Serial.println(" us");
//https://wikimedia.org/api/rest_v1/media/math/render/svg/fef32b5ef4e6b21aa4a76e1af24085f5f1b9f778
float WaterSpeed=(0.3/2)*((pingSensor1/1000000-pingSensor2/1000000)/(pingSensor1/1000000*pingSensor2/1000000));
float error=100-(pingSensor2/pingSensor1)*100;
Serial.print("Error = ");
Serial.print(error);
Serial.println("%");
Serial.print("Water flow =");
Serial.print(WaterSpeed);
Serial.println("m/s");
Serial.println("-----------------------");
delay(1000);
}