-
Notifications
You must be signed in to change notification settings - Fork 2
/
run.py
76 lines (44 loc) · 1.51 KB
/
run.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
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
"""
All files written in python 3. See ReadMe.txt for help.
This file runs the required components for
part A by calling partA.py and the required components for part B by calling
partB.py. It provides the figures for questions
2 and 3, then prints the results to question
6 to the terminalself.
"""
from partA import*
from partB import*
if __name__ == "__main__":
#### PART B ####
# compare the control sequence between dead reckoning and UKF
# from question 8
#compare_sequence_controls()
# Specify how long to run the filter by setting iter.
# The nubmer of iteration corresponds to the number of lines
# in ds0_Odometry.dat: 0 -> 95818.
# Set iter = None and it will run until the end
# Takes aprrox. 40s to run the entire data set on i7 32GB RAM
# iter = None
iter = 5000
run_filter(iter)
# If you do not want to wait for the full data set to run
# uncomment the line bellow to plot the results from the full filter
# that were saved to filter_output.txt
# filter_results()
# plot the states x,y,theta of the robot versus time
#show_states()
#### PART A ####
#
# # Want to add noise to motion and sensor model?
# noise = True
#
# # plot for question 2
# question_two(noise)
#
# # plot for question 3 may take ~5 seconds
# # arguements are the file paths defined in params.py
# question_three(odom_path, ground_truth, noise)
#
# # print results for quesion 6
# question_six(noise)
#