-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathsvicka.py
56 lines (53 loc) · 1.85 KB
/
svicka.py
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
import mpu6050, machine, neopixel, time
while 1:
try:
acl = mpu6050.accel()
print("accel init");
break
except:
print("accelinit iicerror")
np = neopixel.NeoPixel(machine.Pin(14), 1)
np[0] = (0, 255, 0)
np.write()
max_val = 30000
val = None
while 1:
try:
val = acl.get_values()
break
except:
print("getval0 iicerror")
while 1:
try:
val = acl.get_values()
except:
print("getval1 iicerror")
if abs(val["GyX"]) > max_val or abs(val["GyY"]) > max_val or abs(val["GyZ"]) > max_val:
print("1:"+str(val["GyX"]) + " " + str(val["GyY"]) + " " + str(val["GyZ"]))
try:
val = acl.get_values()
except:
print("getval2 iicerror")
if abs(val["GyX"]) > max_val or abs(val["GyY"]) > max_val or abs(val["GyZ"]) > max_val:
print("2:"+str(val["GyX"]) + " " + str(val["GyY"]) + " " + str(val["GyZ"]))
try:
val = acl.get_values()
except:
print("getval3 iicerror")
if abs(val["GyX"]) > max_val or abs(val["GyY"]) > max_val or abs(val["GyZ"]) > max_val:
print("3:"+str(val["GyX"]) + " " + str(val["GyY"]) + " " + str(val["GyZ"]))
try:
val = acl.get_values()
except:
print("getval4 iicerror")
if abs(val["GyX"]) > max_val or abs(val["GyY"]) > max_val or abs(val["GyZ"]) > max_val:
print("4:"+str(val["GyX"]) + " " + str(val["GyY"]) + " " + str(val["GyZ"]))
np[0] = (255, 0, 0)
np.write()
time.sleep(2)
try:
acl.get_values()
except:
pass
np[0] = (0, 255, 0)
np.write()