Assignment code for Georgia Tech CS 3630, 2014
Merge branch 'master' of https://github.com/james7132/CS-3630-Huynh-Liu
+24
-5
+24
-5
Assignment_3/code/python/logData.py
+24
-5
Assignment_3/code/python/logData.py
···
6
6
7
7
fname = "log-%d.txt" % time.time()
8
8
9
-
s = Scribbler2('/dev/rfcomm0',fname)
9
+
s = Scribbler2('COM8', fname)
10
+
11
+
# command constants (time)
12
+
T_WAT = .6
13
+
T_TRN = 1.2
14
+
# command constants (power)
15
+
P_FWD = 200
16
+
P_TRN = 100
10
17
11
18
# Set timeout to zero
12
-
print 'Connected!'
19
+
print ('Connected!')
13
20
s.setIRPower(140)
14
21
s.setForwardness(1)
15
22
# Create a list of commands
···
17
24
# Command is a list [cmd, leftMotor, rightMotor, time]
18
25
# Setting motors to 200 will drive
19
26
# forward with the fluke facing forward
20
-
commands.append([200, 200, 4])
21
-
commands.append([0, 0, 2])
27
+
commands.append([P_FWD, P_FWD, 2.1]) # FWD
28
+
commands.append([0, 0, T_WAT]) # WAIT
29
+
commands.append([-P_TRN, P_TRN, T_TRN]) # TURN LEFT
30
+
commands.append([0, 0, T_WAT]) # WAIT
31
+
commands.append([P_FWD, P_FWD, 1.9]) # FWD
32
+
commands.append([0, 0, T_WAT]) # WAIT
33
+
commands.append([P_TRN, -P_TRN, T_TRN]) # TURN RIGHT
34
+
commands.append([0, 0, T_WAT]) # WAIT
35
+
commands.append([P_FWD, P_FWD, 4.4]) # FWD
36
+
commands.append([0, 0, T_WAT]) # WAIT
37
+
commands.append([P_TRN, -P_TRN, T_TRN]) # TURN RIGHT
38
+
commands.append([0, 0, T_WAT]) # WAIT
39
+
commands.append([P_FWD, P_FWD, 3.0]) # FWD
40
+
commands.append([0, 0, T_WAT]) # WAIT
22
41
print ("Start!")
23
42
for c in commands:
24
43
start = time.time()
···
26
45
while (time.time() - start < c[2]):
27
46
s.getObstacle(1)
28
47
time.sleep(0.1) # Read sensors at 1Hz
29
-
48
+
s.log.close()
30
49
31
50