Commit 5fa8013d19e32706a53bc7747f966c1f04c750ab
1 parent
7e5eb8957b
Exists in
master
Lot of changes can't mention
Showing 24 changed files with 123 additions and 75 deletions Side-by-side Diff
- PA2_final2/logs/log_seeds3/seed_0/configuration.json
- PA2_final2/logs/log_seeds3/seed_1/configuration.json
- PA2_final2/logs/log_seeds3/seed_1/metric_results.json
- PA2_final2/logs/log_seeds3/seed_1/std_dev_results.json
- PA2_final2/logs/log_seeds3/seed_1/time_results.json
- PA2_final2/logs/log_seeds3/seed_100/configuration.json
- PA2_final2/logs/log_seeds3/seed_100/metric_results.json
- PA2_final2/logs/log_seeds3/seed_100/std_dev_results.json
- PA2_final2/logs/log_seeds3/seed_100/time_results.json
- PA2_final2/logs/log_seeds3/seed_3/configuration.json
- PA2_final2/logs/log_seeds3/seed_3/metric_results.json
- PA2_final2/logs/log_seeds3/seed_3/std_dev_results.json
- PA2_final2/logs/log_seeds3/seed_3/time_results.json
- PA2_final2/logs/log_seeds3/seed_9/configuration.json
- PA2_final2/map/MAP.png
- PA2_final2/map/stage.world
- PA2_final2/map/stage.yaml
- PA2_final2/rviz/PA2.rviz
- PA2_final2/scripts/configuration.json
- PA2_final2/scripts/metric_results.json
- PA2_final2/scripts/robot.py
- PA2_final2/scripts/std_dev_results.json
- PA2_final2/scripts/test_metric.py
- PA2_final2/scripts/time_results.json
PA2_final2/logs/log_seeds3/seed_0/configuration.json
View file @
5fa8013
1 | 1 | { |
2 | 2 | |
3 | - "seed": 0 | |
3 | + "seed": 0, | |
4 | 4 | |
5 | 5 | "move_list": [ |
6 | 6 | [0.0, 5.0,24], |
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/logs/log_seeds3/seed_1/configuration.json
View file @
5fa8013
1 | 1 | { |
2 | 2 | |
3 | - "seed": 1 | |
3 | + "seed": 1, | |
4 | 4 | |
5 | 5 | "move_list": [ |
6 | 6 | [0.0, 5.0,24], |
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/logs/log_seeds3/seed_1/metric_results.json
View file @
5fa8013
PA2_final2/logs/log_seeds3/seed_1/std_dev_results.json
View file @
5fa8013
1 | +{ | |
2 | +"std_dev_x" : [72.67294079455658, 132.09895365149464, 131.6037862389534, 15.36313400545684, 15.07225697714103, 15.495711131211916] | |
3 | +} | |
4 | +{ | |
5 | +"std_dev_y" : [57.754087049913004, 33.40434621983984, 31.63286848549998, 11.567760396843116, 131.97188641885, 142.12453873531828] | |
6 | +} | |
7 | +{ | |
8 | +"std_dev_angle" : [1.811602678529423, 2.439484416869617, 2.874551402596871, 3.4857881328337146, 2.8984217333727913, 2.8955277495231933] | |
9 | +} |
PA2_final2/logs/log_seeds3/seed_1/time_results.json
View file @
5fa8013
PA2_final2/logs/log_seeds3/seed_100/configuration.json
View file @
5fa8013
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/logs/log_seeds3/seed_100/metric_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"metric" : [3.0, 3.1230210977046977, 3.0690548553171153, 4.4391141662963385, 3.01662397928847, 3.097849083557044, 3.250719693956948, 3.023001202236289, 10.75224050952996, 2.255228444332777, 2.2490320374684227, 2.008355281857834, 4.023075085380298, 34.662783052938295] | |
2 | +"metric" : [2.0, 1.255122694134589, 1.3677448924917321, 4.7678214655569136, 1.493727131754932, 1.4332167484558647, 1.35222161766123, 1.2407375091338992, 9.330162566065018] | |
3 | 3 | } |
PA2_final2/logs/log_seeds3/seed_100/std_dev_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"std_dev_x" : [75.14032723274629, 112.66766563692022, 114.22725057129338, 36.53796674255203, 48.92231205953101, 42.16778512661692, 34.71011779362071, 38.16108905391716, 21.221192485973795, 138.44145687310646, 138.7895351343245, 178.922162288191, 67.36167715300158, 8.37214031891855] | |
2 | +"std_dev_x" : [75.14032723274629, 175.0153246323058, 154.66195748591215, 18.505117120726347, 27.434637279186052, 27.59700191579456, 15.224136503406239, 13.88431882597507, 8.37734930853692] | |
3 | 3 | } |
4 | 4 | { |
5 | -"std_dev_y" : [56.621614368670805, 37.810497591173494, 34.63783044611571, 29.50808656264989, 94.10409629532955, 109.7863647569753, 126.73083053063388, 134.90217847882164, 8.532865164148552, 45.30249785094974, 55.280646284071274, 47.56348389264536, 21.869762997266502, 4.111219425283383] | |
5 | +"std_dev_y" : [56.621614368670805, 18.594497715172025, 16.57970327738344, 11.561042658924382, 117.66709628933917, 126.78295433104391, 120.99499317477213, 146.27646060547403, 6.810029490614684] | |
6 | 6 | } |
7 | 7 | { |
8 | -"std_dev_angle" : [1.8108835899975961, 1.889110516794672, 2.3319152124947076, 3.904757089881186, 2.0601129836414698, 2.2631272234132833, 2.8333253609383084, 2.855167523617228, 3.145448627437756, 3.9144655461632243, 2.6499044674693923, 4.550515094456697, 5.684543679481683, 0.15197998435151389] | |
8 | +"std_dev_angle" : [1.8108835899975961, 2.513206134572855, 2.3737442012656595, 3.972450595111907, 2.5326251425629276, 2.55739280954278, 3.118412846430211, 3.016066018027615, 2.942496179584507] | |
9 | 9 | } |
PA2_final2/logs/log_seeds3/seed_100/time_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"time_elapsed" : [0.0491790808737278, 2.144494365900755, 2.412723932415247, 3.484662912786007, 4.2719509825110435, 4.386699479073286, 6.090533033013344, 6.19188816472888, 7.198458798229694, 8.040174797177315, 8.457702230662107, 8.9626992829144, 9.065497167408466, 9.687891565263271] | |
2 | +"time_elapsed" : [0.04321293532848358, 2.3422266840934753, 2.6050062850117683, 3.7588519491255283, 4.585372284054756, 4.6997894160449505, 5.714456085115671, 6.01973969861865, 6.731148734688759] | |
3 | 3 | } |
PA2_final2/logs/log_seeds3/seed_3/configuration.json
View file @
5fa8013
1 | 1 | { |
2 | 2 | |
3 | - "seed": 3 | |
3 | + "seed": 3, | |
4 | 4 | |
5 | 5 | "move_list": [ |
6 | 6 | [0.0, 5.0,24], |
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/logs/log_seeds3/seed_3/metric_results.json
View file @
5fa8013
PA2_final2/logs/log_seeds3/seed_3/std_dev_results.json
View file @
5fa8013
1 | +{ | |
2 | +"std_dev_x" : [75.29445706760256, 197.85988866540802, 174.77799561288876, 7.424109748284507, 13.420795160982415, 13.617511999894298] | |
3 | +} | |
4 | +{ | |
5 | +"std_dev_y" : [55.166854597354295, 23.2629821875162, 21.20965564273314, 8.386703518048716, 138.66694223149509, 148.35908632262718] | |
6 | +} | |
7 | +{ | |
8 | +"std_dev_angle" : [1.823933683962769, 2.866673071401528, 2.7914221332162263, 3.2010866094180113, 3.0049805342936318, 3.0016065065352353] | |
9 | +} |
PA2_final2/logs/log_seeds3/seed_3/time_results.json
View file @
5fa8013
PA2_final2/logs/log_seeds3/seed_9/configuration.json
View file @
5fa8013
1 | 1 | { |
2 | 2 | |
3 | - "seed": 9 | |
3 | + "seed": 9, | |
4 | 4 | |
5 | 5 | "move_list": [ |
6 | 6 | [0.0, 5.0,24], |
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/map/MAP.png
View file @
5fa8013
PA2_final2/map/stage.world
View file @
5fa8013
PA2_final2/map/stage.yaml
View file @
5fa8013
PA2_final2/rviz/PA2.rviz
View file @
5fa8013
... | ... | @@ -7,8 +7,8 @@ |
7 | 7 | - /Global Options1 |
8 | 8 | - /Grid1 |
9 | 9 | - /TF1/Frames1 |
10 | + - /LaserScan1 | |
10 | 11 | - /Map1 |
11 | - - /Odometry1 | |
12 | 12 | - /PoseArray1 |
13 | 13 | - /Map2 |
14 | 14 | Splitter Ratio: 0.5 |
... | ... | @@ -31,7 +31,7 @@ |
31 | 31 | Experimental: false |
32 | 32 | Name: Time |
33 | 33 | SyncMode: 0 |
34 | - SyncSource: "" | |
34 | + SyncSource: LaserScan | |
35 | 35 | Visualization Manager: |
36 | 36 | Class: "" |
37 | 37 | Displays: |
... | ... | @@ -64,6 +64,10 @@ |
64 | 64 | Value: true |
65 | 65 | base_link: |
66 | 66 | Value: true |
67 | + base_scan: | |
68 | + Value: true | |
69 | + map: | |
70 | + Value: true | |
67 | 71 | odom: |
68 | 72 | Value: true |
69 | 73 | Marker Scale: 1 |
... | ... | @@ -72,7 +76,14 @@ |
72 | 76 | Show Axes: true |
73 | 77 | Show Names: false |
74 | 78 | Tree: |
75 | - {} | |
79 | + map: | |
80 | + base_scan: | |
81 | + {} | |
82 | + odom: | |
83 | + base_footprint: | |
84 | + base_link: | |
85 | + base_laser_link: | |
86 | + {} | |
76 | 87 | Update Interval: 0 |
77 | 88 | Value: true |
78 | 89 | - Alpha: 1 |
79 | 90 | |
80 | 91 | |
81 | 92 | |
... | ... | @@ -88,19 +99,20 @@ |
88 | 99 | Color Transformer: Intensity |
89 | 100 | Decay Time: 0 |
90 | 101 | Enabled: true |
91 | - Invert Rainbow: false | |
102 | + Invert Rainbow: true | |
92 | 103 | Max Color: 255; 255; 255 |
93 | 104 | Max Intensity: 1 |
94 | - Min Color: 0; 0; 0 | |
105 | + Min Color: 255; 85; 255 | |
95 | 106 | Min Intensity: 1 |
96 | 107 | Name: LaserScan |
97 | 108 | Position Transformer: XYZ |
98 | 109 | Queue Size: 10 |
99 | 110 | Selectable: true |
100 | 111 | Size (Pixels): 3 |
101 | - Size (m): 0.01 | |
112 | + Size (m): 1 | |
102 | 113 | Style: Flat Squares |
103 | 114 | Topic: /base_scan |
115 | + Unreliable: false | |
104 | 116 | Use Fixed Frame: true |
105 | 117 | Use rainbow: true |
106 | 118 | Value: true |
... | ... | @@ -111,6 +123,7 @@ |
111 | 123 | Enabled: true |
112 | 124 | Name: Map |
113 | 125 | Topic: /map |
126 | + Unreliable: false | |
114 | 127 | Value: true |
115 | 128 | - Alpha: 1 |
116 | 129 | Class: rviz/PointStamped |
117 | 130 | |
118 | 131 | |
... | ... | @@ -120,13 +133,14 @@ |
120 | 133 | Name: PointStamped |
121 | 134 | Radius: 0.2 |
122 | 135 | Topic: /clicked_point |
136 | + Unreliable: false | |
123 | 137 | Value: true |
124 | 138 | - Angle Tolerance: 0.1 |
125 | 139 | Class: rviz/Odometry |
126 | - Color: 255; 25; 0 | |
140 | + Color: 0; 0; 0 | |
127 | 141 | Enabled: true |
128 | - Keep: 100 | |
129 | - Length: 1 | |
142 | + Keep: 5 | |
143 | + Length: 5 | |
130 | 144 | Name: Odometry |
131 | 145 | Position Tolerance: 0.1 |
132 | 146 | Topic: /base_pose_ground_truth |
... | ... | @@ -137,6 +151,7 @@ |
137 | 151 | Enabled: true |
138 | 152 | Name: PoseArray |
139 | 153 | Topic: /particlecloud |
154 | + Unreliable: false | |
140 | 155 | Value: true |
141 | 156 | - Alpha: 0.7 |
142 | 157 | Class: rviz/Map |
... | ... | @@ -145,6 +160,7 @@ |
145 | 160 | Enabled: true |
146 | 161 | Name: Map |
147 | 162 | Topic: /likelihood_field |
163 | + Unreliable: false | |
148 | 164 | Value: true |
149 | 165 | Enabled: true |
150 | 166 | Global Options: |
... | ... | @@ -178,7 +194,7 @@ |
178 | 194 | Value: false |
179 | 195 | Name: Current View |
180 | 196 | Near Clip Distance: 0.01 |
181 | - Scale: 2.34715 | |
197 | + Scale: 1.64976 | |
182 | 198 | Target Frame: base_laser_link |
183 | 199 | Value: TopDownOrtho (rviz) |
184 | 200 | X: 76.6314 |
... | ... | @@ -190,7 +206,7 @@ |
190 | 206 | Height: 744 |
191 | 207 | Hide Left Dock: false |
192 | 208 | Hide Right Dock: true |
193 | - QMainWindow State: 000000ff00000000fd00000004000000000000013c0000025efc0200000008fb0000001200530065006c0065006300740069006f006e00000000280000009b0000006400fffffffb0000001e0054006f006f006c002000500072006f007000650072007400690065007302000002540000011a00000185000000a3fb000000120056006900650077007300200054006f006f02000001df000002110000018500000122fb000000200054006f006f006c002000500072006f0070006500720074006900650073003203000002880000011d000002210000017afb000000100044006900730070006c00610079007301000000280000025e000000dd00fffffffb0000002000730065006c0065006300740069006f006e00200062007500660066006500720200000138000000aa0000023a00000294fb00000014005700690064006500530074006500720065006f02000000e6000000d2000003ee0000030bfb0000000c004b0069006e0065006300740200000186000001060000030c00000261000000010000010f0000025efc0200000003fb0000001e0054006f006f006c002000500072006f00700065007200740069006500730100000041000000780000000000000000fb0000000a0056006900650077007300000000280000025e000000b000fffffffb0000001200530065006c0065006300740069006f006e010000025a000000b200000000000000000000000200000490000000a9fc0100000001fb0000000a00560069006500770073030000004e00000080000002e100000197000000030000050f0000003efc0100000002fb0000000800540069006d006501000000000000050f000002f600fffffffb0000000800540069006d00650100000000000004500000000000000000000003cd0000025e00000004000000040000000800000008fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000 | |
209 | + QMainWindow State: 000000ff00000000fd00000004000000000000016a0000025efc0200000008fb0000001200530065006c0065006300740069006f006e00000000280000009b0000006400fffffffb0000001e0054006f006f006c002000500072006f007000650072007400690065007302000002540000011a00000185000000a3fb000000120056006900650077007300200054006f006f02000001df000002110000018500000122fb000000200054006f006f006c002000500072006f0070006500720074006900650073003203000002880000011d000002210000017afb000000100044006900730070006c00610079007301000000280000025e000000dd00fffffffb0000002000730065006c0065006300740069006f006e00200062007500660066006500720200000138000000aa0000023a00000294fb00000014005700690064006500530074006500720065006f02000000e6000000d2000003ee0000030bfb0000000c004b0069006e0065006300740200000186000001060000030c00000261000000010000010f0000025efc0200000003fb0000001e0054006f006f006c002000500072006f00700065007200740069006500730100000041000000780000000000000000fb0000000a0056006900650077007300000000280000025e000000b000fffffffb0000001200530065006c0065006300740069006f006e010000025a000000b200000000000000000000000200000490000000a9fc0100000001fb0000000a00560069006500770073030000004e00000080000002e100000197000000030000050f0000003efc0100000002fb0000000800540069006d006501000000000000050f000002f600fffffffb0000000800540069006d006501000000000000045000000000000000000000039f0000025e00000004000000040000000800000008fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000 | |
194 | 210 | Selection: |
195 | 211 | collapsed: false |
196 | 212 | Time: |
PA2_final2/scripts/configuration.json
View file @
5fa8013
... | ... | @@ -8,10 +8,10 @@ |
8 | 8 | [90.0,10.0,10], |
9 | 9 | [-90.0,10.0,7], |
10 | 10 | [0.0,5.0,1], |
11 | - [180.0,10.0,15], | |
12 | - [0.0,5.0,1], | |
13 | - [180.0,10.0,8], | |
14 | - [90.0,10.0,8], | |
11 | + [180.0,20.0,7], | |
12 | + [0.0,5.0,3], | |
13 | + [180.0,20.0,4], | |
14 | + [90.0,20.0,4], | |
15 | 15 | [-90.0,10.0,3], |
16 | 16 | [90.0,10.0,4], |
17 | 17 | [0.0,5.0,1], |
... | ... | @@ -21,9 +21,9 @@ |
21 | 21 | "first_move_sigma_x": 2, |
22 | 22 | "first_move_sigma_y": 2, |
23 | 23 | "first_move_sigma_angle": 0.08, |
24 | - "resample_sigma_x": 0.3, | |
25 | - "resample_sigma_y": 0.3, | |
26 | - "resample_sigma_angle": 0.026, | |
24 | + "resample_sigma_x": 0.1, | |
25 | + "resample_sigma_y": 0.1, | |
26 | + "resample_sigma_angle": 0.02, | |
27 | 27 | |
28 | 28 | "laser_z_hit": 0.80, |
29 | 29 | "laser_z_rand": 0.05, |
PA2_final2/scripts/metric_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"metric" : [3.0, 3.009635523425522, 2.866357649805677, 3.447984850226044, 3.1307572175414684, 3.069963980783466] | |
2 | +"metric" : [2.0, 1.7067430792770657, 1.4983150168217945, 2.4730210322669306, 1.6974163987510016, 1.6573910336913142, 1.6383895045301693, 1.5022194981557067, 6.252232915514105, 1.279662391939394, 2.1745364017745326, 13.453712172124224, 11.875753998752808, 22.921697985100863] | |
3 | 3 | } |
PA2_final2/scripts/robot.py
View file @
5fa8013
... | ... | @@ -34,13 +34,14 @@ |
34 | 34 | def sense(self, scan_msg, likelihood_field): |
35 | 35 | xs, ys = self.laser_range_end(scan_msg) |
36 | 36 | #total_prob = 0 |
37 | - total_prob = 1 | |
37 | + total_prob = 1 # BIAS | |
38 | 38 | |
39 | - for i in range(0, len(xs), 30): | |
39 | + for i in range(0, len(xs), 5): | |
40 | 40 | likelihood = likelihood_field.get_cell(xs[i], ys[i]) |
41 | 41 | if np.isnan(likelihood): |
42 | 42 | likelihood = 0 |
43 | 43 | pz=(laser_z_hit * likelihood + laser_z_rand) |
44 | + #total_prob += pz | |
44 | 45 | total_prob += pz*pz*pz |
45 | 46 | #total_prob *= pz |
46 | 47 | |
47 | 48 | |
... | ... | @@ -56,10 +57,10 @@ |
56 | 57 | xs = [] |
57 | 58 | ys = [] |
58 | 59 | |
59 | - for i in range(len(ranges)): | |
60 | + for i in range(len(ranges)/4, 3*len(ranges)/4): | |
60 | 61 | if ranges[i] == scan_msg.range_max: |
61 | 62 | continue |
62 | - #print "Obstacle Seen" | |
63 | + #print "Obstacle Seen" | |
63 | 64 | xs.append(self.x + ranges[i] * np.cos(self.theta + theta_beam[i])) |
64 | 65 | ys.append(self.y + ranges[i] * np.sin(self.theta + theta_beam[i])) |
65 | 66 |
PA2_final2/scripts/std_dev_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"std_dev_x" : [75.29445706760256, 117.04231012918234, 112.94341414332644, 55.31325221933085, 59.740389307141015, 59.33243121257976] | |
2 | +"std_dev_x" : [75.29445706760256, 110.4656340550364, 111.43968024079918, 40.97831452669745, 43.64283268690735, 43.40163063156963, 36.941909447821075, 26.392394670257715, 13.858259198780601, 99.59084201559187, 84.24856040749864, 5.810436782944739, 6.68665740377187, 7.277817790273729] | |
3 | 3 | } |
4 | 4 | { |
5 | -"std_dev_y" : [55.166854597354295, 38.67424358146727, 38.84255948327353, 33.64842299953234, 72.24685841661191, 78.9508708911915] | |
5 | +"std_dev_y" : [55.166854597354295, 51.33974432072303, 45.68346449600554, 23.289640742281268, 98.31339589212018, 104.71684957022526, 96.11816631822906, 118.32776213442683, 12.091742044327376, 18.750450360329523, 31.200370293939947, 4.074427465075527, 4.508154573157117, 4.125298083229201] | |
6 | 6 | } |
7 | 7 | { |
8 | -"std_dev_angle" : [1.823933683962769, 1.940610331144119, 2.340077813528975, 4.078201078075731, 1.6479224938924018, 1.6548301875731364] | |
8 | +"std_dev_angle" : [1.823933683962769, 1.9393755833944504, 2.5216470116549, 3.7020312608645707, 2.1984436697315477, 2.187113070524559, 2.491977268746382, 2.4906925725330584, 1.5495309415801248, 5.086332577696456, 1.6061902382763953, 6.064114392873878, 6.054213755064956, 0.15504319460925553] | |
9 | 9 | } |
PA2_final2/scripts/test_metric.py
View file @
5fa8013
... | ... | @@ -115,7 +115,8 @@ |
115 | 115 | self.std_dev_y_data.extend([std_dev_y_value]) |
116 | 116 | self.std_dev_angle_data.extend([std_dev_angle_value]) |
117 | 117 | |
118 | - metric = (self.std_dev_x_data[0]/std_dev_x_value)+(self.std_dev_y_data[0]/std_dev_y_value)+(self.std_dev_angle_data[0]/std_dev_angle_value) | |
118 | + #RMS | |
119 | + metric = (sqrt(self.std_dev_x_data[0]**2 + self.std_dev_y_data[0]**2)/sqrt(std_dev_x_value**2 + std_dev_y_value**2))+(self.std_dev_angle_data[0]/std_dev_angle_value) | |
119 | 120 | |
120 | 121 | # if (time_elapsed_value > 10): |
121 | 122 | # metric = metric/(time_elapsed_value-9) |
PA2_final2/scripts/time_results.json
View file @
5fa8013
1 | 1 | { |
2 | -"time_elapsed" : [0.05231093242764473, 2.233462516218424, 2.49330198392272, 3.5580093637108803, 4.3344984985888, 4.43617058172822] | |
2 | +"time_elapsed" : [0.051666666666666666, 2.228333333333333, 2.4883333333333337, 3.6166666666666667, 4.451666666666667, 4.558333333333334, 5.58, 5.878333333333333, 6.635000000000001, 7.166666666666667, 7.611666666666666, 8.135, 8.245, 8.908333333333333] | |
3 | 3 | } |