-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathcheck_esensor_status.ino
63 lines (52 loc) · 1.21 KB
/
check_esensor_status.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
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
#include <Wire.h>
#include <WiFiNINA.h>
#include <utility/wifi_drv.h>
#define SEA_LEVEL_PRESSURE 1015.0f
void I2C_setup(){
Wire.begin();
Serial.begin(9600);
while(!Serial);
Serial.println("\nI2C Scanner");
}
int I2C_loop(){
byte error, address;
int nDevices;
Serial.println("Scanning...");
nDevices = 0;
for(address = 1; address < 127; address++){
Wire.beginTransmission(address);
error = Wire.endTransmission();
if(error == 0){
Serial.print("I2C Device found: 0x");
if (address < 16){
Serial.print("0");
}
Serial.println(address, HEX);
nDevices++;
}
}
return nDevices;
}
void setup(){
WiFiDrv::pinMode(25, OUTPUT);
WiFiDrv::pinMode(26, OUTPUT);
WiFiDrv::pinMode(27, OUTPUT);
I2C_setup();
}
void loop(){
if(I2C_loop() > 2){ //sensors connected properly
WiFiDrv::analogWrite(25, 0);
WiFiDrv::analogWrite(26, 150);
WiFiDrv::analogWrite(27, 0);
}
else{ //default MKR1010 connected only
WiFiDrv::analogWrite(25,150);
WiFiDrv::analogWrite(26,0);
WiFiDrv::analogWrite(27,0);
}
delay(2000);
WiFiDrv::analogWrite(25, 0);
WiFiDrv::analogWrite(26, 0);
WiFiDrv::analogWrite(27, 0);
delay(5000);
}