1
1
#!/usr/bin/env python3
2
2
from MenuLib import init , initthread , runCurrentMission
3
3
from time import sleep
4
+ from sys import stderr
4
5
loopIndex = 0
5
6
6
7
init ('robot.cfg' )
7
8
initthread ()
8
9
from MenuLib import *
9
10
calibrate ()
10
11
robot .reflectCal ()
12
+ print ("Finished Init" , file = stderr )
11
13
12
14
def left ():
13
- robot .btn .wait_for_released ('left, right, up, down, enter' )
14
15
if not mission .is_alive ():
15
16
minusCount ()
16
17
display ()
@@ -19,7 +20,6 @@ def left():
19
20
minusCount ()
20
21
display ()
21
22
def right ():
22
- robot .btn .wait_for_released ('left, right, up, down, enter' )
23
23
if not mission .is_alive ():
24
24
addCount ()
25
25
display ()
@@ -28,23 +28,20 @@ def right():
28
28
minusCount ()
29
29
display ()
30
30
def down ():
31
- robot .btn .wait_for_released ('left, right, up, down, enter' )
32
31
if not mission .is_alive ():
33
32
calibrate ()
34
33
else :
35
34
abort ()
36
35
minusCount ()
37
36
display ()
38
37
def up ():
39
- robot .btn .wait_for_released ('left, right, up, down, enter' )
40
38
if not mission .is_alive ():
41
39
robot .reflectCal ()
42
40
8000
else :
43
41
abort ()
44
42
minusCount ()
45
43
display ()
46
44
def enter ():
47
- robot .btn .wait_for_released ('left, right, up, down, enter' )
48
45
if not mission .is_alive ():
49
46
run ()
50
47
addCount ()
@@ -54,16 +51,22 @@ def enter():
54
51
minusCount ()
55
52
display ()
56
53
54
+ print ("Functions Defined" , file = stderr )
55
+
57
56
buttonMap = {
58
- 'left' : left () ,
59
- 'right' : right () ,
60
- 'enter' : enter () ,
61
- 'up' : up () ,
62
- 'down' : down ()
57
+ 'left' : left ,
58
+ 'right' : right ,
59
+ 'enter' : enter ,
60
+ 'up' : up ,
61
+ 'down' : down
63
62
}
64
63
64
+ print ("Map Defined" , file = stderr )
65
+
65
66
while True :
66
- buttonMap [robot .btn .buttons_pressed ]()
67
+ buttonlist = robot .btn .buttons_pressed
68
+ if buttonlist :
69
+ buttonMap [buttonlist [0 ]]()
70
+ loopIndex = (loopIndex + 1 ) % 100
67
71
checkDrift ()
68
- displaySensor ()
69
- loopIndex = (loopIndex + 1 ) % 100
72
+ displaySensor ()
0 commit comments