diff --git a/arena_bringup/launch/start_arena_flatland.launch b/arena_bringup/launch/start_arena_flatland.launch index c4f4c84f2..9dc493390 100755 --- a/arena_bringup/launch/start_arena_flatland.launch +++ b/arena_bringup/launch/start_arena_flatland.launch @@ -5,6 +5,12 @@ + + + + + + @@ -71,6 +77,10 @@ + + + + diff --git a/arena_bringup/launch/sublaunch/flatland_simulator.launch b/arena_bringup/launch/sublaunch/flatland_simulator.launch index 595ef0492..00a75c67d 100755 --- a/arena_bringup/launch/sublaunch/flatland_simulator.launch +++ b/arena_bringup/launch/sublaunch/flatland_simulator.launch @@ -14,6 +14,7 @@ + @@ -46,4 +47,4 @@ - \ No newline at end of file + diff --git a/arena_bringup/launch/sublaunch/scan_process.launch b/arena_bringup/launch/sublaunch/scan_process.launch new file mode 100644 index 000000000..34107c41a --- /dev/null +++ b/arena_bringup/launch/sublaunch/scan_process.launch @@ -0,0 +1,9 @@ + + + + + + + + + diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs05_vel01.json new file mode 100644 index 000000000..afabc8b19 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 172.45, + 164.0, + 172.5, + 173.55, + 172.0, + 164.0, + 162.5, + 163.05, + 163.95, + 155.0, + 174.0, + 173.0, + 215.55, + 173.0, + 173.5, + 173.5, + 173.5, + 173.55, + 172.95, + 149.0, + 173.0, + 161.95, + 173.0, + 173.05, + 173.0, + 162.0, + 173.45 + ], + "path": [ + 34.07, + 32.916, + 33.982, + 34.224, + 34.357, + 32.924, + 32.581, + 32.696, + 32.886, + 30.719, + 34.113, + 34.148, + 41.639, + 34.164, + 34.056, + 34.011, + 34.187, + 34.256, + 34.101, + 29.749, + 33.962, + 32.517, + 33.927, + 34.13, + 34.174, + 32.437, + 34.244 + ], + "velocity": [ + 0.198, + 0.201, + 0.197, + 0.197, + 0.2, + 0.201, + 0.2, + 0.201, + 0.201, + 0.198, + 0.196, + 0.197, + 0.193, + 0.197, + 0.196, + 0.196, + 0.197, + 0.197, + 0.197, + 0.2, + 0.196, + 0.201, + 0.196, + 0.197, + 0.198, + 0.2, + 0.197 + ], + "collision": [ + 2, + 1, + 2, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2, + 2, + 2, + 1, + 0, + 1, + 2, + 1, + 0, + 1, + 1, + 0, + 2, + 2, + 1, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel01.json new file mode 100644 index 000000000..e18434840 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 150.0, + 150.5, + 150.5, + 150.0, + 151.0, + 150.5, + 150.0, + 150.0, + 150.0, + 150.0, + 151.5, + 150.0, + 151.0, + 150.0, + 150.0, + 151.0, + 150.5, + 149.0, + 150.5, + 151.0, + 151.0, + 150.5, + 151.0, + 150.0, + 150.5, + 150.0, + 150.0 + ], + "path": [ + 29.938, + 30.044, + 30.015, + 29.944, + 30.037, + 30.023, + 29.929, + 29.948, + 29.989, + 29.931, + 30.21, + 29.894, + 30.084, + 29.921, + 29.922, + 30.172, + 30.017, + 29.749, + 30.049, + 30.165, + 30.148, + 30.037, + 30.103, + 29.914, + 30.041, + 29.936, + 29.904 + ], + "velocity": [ + 0.2, + 0.2, + 0.199, + 0.2, + 0.199, + 0.199, + 0.2, + 0.2, + 0.2, + 0.2, + 0.199, + 0.199, + 0.199, + 0.199, + 0.199, + 0.2, + 0.199, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.199, + 0.199, + 0.2, + 0.2, + 0.199 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel02.json new file mode 100644 index 000000000..981449f4f --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 191.0, + 186.5, + 165.5, + 186.0, + 165.0, + 169.5, + 165.5, + 185.0, + 182.5, + 191.0, + 184.5, + 188.0, + 188.0, + 180.5, + 186.5, + 189.0, + 195.5, + 184.0, + 188.0, + 183.5, + 186.5, + 188.5, + 181.0, + 184.0, + 201.5, + 188.5, + 184.0 + ], + "path": [ + 37.95, + 36.996, + 32.988, + 36.946, + 32.886, + 32.764, + 33.027, + 36.686, + 36.392, + 37.931, + 36.637, + 37.358, + 37.386, + 35.906, + 37.028, + 37.554, + 38.648, + 36.6, + 37.402, + 36.507, + 37.107, + 37.404, + 36.089, + 36.611, + 39.742, + 37.448, + 36.653 + ], + "velocity": [ + 0.199, + 0.198, + 0.199, + 0.199, + 0.199, + 0.193, + 0.2, + 0.198, + 0.199, + 0.199, + 0.199, + 0.199, + 0.199, + 0.199, + 0.199, + 0.199, + 0.198, + 0.199, + 0.199, + 0.199, + 0.199, + 0.198, + 0.199, + 0.199, + 0.197, + 0.199, + 0.199 + ], + "collision": [ + 2, + 2, + 1, + 2, + 1, + 1, + 1, + 2, + 2, + 2, + 2, + 2, + 2, + 1, + 2, + 2, + 2, + 2, + 2, + 2, + 2, + 2, + 1, + 1, + 3, + 2, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel03.json new file mode 100644 index 000000000..50cd52699 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 171.5, + 175.5, + 184.0, + 177.5, + 212.0, + 180.0, + 154.0, + 189.5, + 184.0, + 213.0, + 183.0, + 198.5, + 210.0, + 184.0, + 181.0, + 185.5, + 208.5, + 190.0, + 214.0, + 180.0, + 154.5, + 181.0, + 182.5, + 182.5, + 181.0, + 181.5, + 181.5 + ], + "path": [ + 34.254, + 34.137, + 37.659, + 35.225, + 42.844, + 35.805, + 30.244, + 37.9, + 37.0, + 43.295, + 36.642, + 40.417, + 42.226, + 36.867, + 36.098, + 37.109, + 42.182, + 38.628, + 42.001, + 35.815, + 30.337, + 36.108, + 36.538, + 36.495, + 36.03, + 36.304, + 36.3 + ], + "velocity": [ + 0.2, + 0.195, + 0.205, + 0.198, + 0.202, + 0.199, + 0.196, + 0.2, + 0.201, + 0.203, + 0.2, + 0.204, + 0.201, + 0.2, + 0.199, + 0.2, + 0.202, + 0.203, + 0.196, + 0.199, + 0.196, + 0.199, + 0.2, + 0.2, + 0.199, + 0.2, + 0.2 + ], + "collision": [ + 2, + 3, + 3, + 3, + 5, + 3, + 2, + 4, + 4, + 5, + 4, + 4, + 5, + 4, + 3, + 4, + 5, + 4, + 5, + 3, + 1, + 4, + 4, + 4, + 4, + 4, + 4 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel01.json new file mode 100644 index 000000000..8a8f9ebcf --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 159.5, + 161.5, + 160.5, + 158.95, + 159.95, + 159.5, + 160.0, + 160.5, + 160.0, + 159.0, + 157.5, + 161.5, + 160.5, + 159.0, + 161.45, + 161.0, + 160.0, + 159.5, + 159.5, + 159.5, + 159.5, + 158.5, + 160.0, + 161.0, + 161.5, + 158.5, + 157.5 + ], + "path": [ + 31.935, + 32.322, + 32.085, + 31.81, + 32.001, + 31.918, + 32.014, + 32.107, + 31.993, + 31.796, + 31.52, + 32.311, + 32.093, + 31.81, + 32.296, + 32.214, + 32.013, + 31.891, + 31.909, + 31.913, + 31.908, + 31.698, + 32.052, + 32.21, + 32.339, + 31.735, + 31.506 + ], + "velocity": [ + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel02.json new file mode 100644 index 000000000..ca6b0b62b --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 162.5, + 189.5, + 162.0, + 200.5, + 159.0, + 174.0, + 170.5, + 161.0, + 156.5, + 173.5, + 159.0, + 161.5, + 206.0, + 161.5, + 177.5, + 163.5, + 234.0, + 195.0, + 185.0, + 199.5, + 203.0, + 170.5, + 162.5, + 161.5, + 168.0, + 208.5, + 198.5 + ], + "path": [ + 32.455, + 37.577, + 32.439, + 38.911, + 31.814, + 34.594, + 34.072, + 32.203, + 31.311, + 34.666, + 31.817, + 32.29, + 40.577, + 32.26, + 35.343, + 32.699, + 46.589, + 38.712, + 36.768, + 39.226, + 40.374, + 34.028, + 32.454, + 32.259, + 33.508, + 41.823, + 38.997 + ], + "velocity": [ + 0.2, + 0.198, + 0.2, + 0.194, + 0.2, + 0.199, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.197, + 0.2, + 0.199, + 0.2, + 0.199, + 0.199, + 0.199, + 0.197, + 0.199, + 0.2, + 0.2, + 0.2, + 0.199, + 0.201, + 0.196 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 2, + 1, + 1, + 2, + 2, + 0, + 0, + 0, + 0, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel03.json new file mode 100644 index 000000000..28c936a7b --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_empty_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 162.5, + 162.0, + 162.0, + 179.5, + 158.5, + 205.5, + 174.5, + 167.0, + 188.5, + 166.0, + 165.0, + 161.0, + 215.5, + 231.5, + 187.5, + 204.0, + 167.0, + 181.5, + 232.5, + 181.5, + 231.0, + 172.5, + 185.5, + 204.5, + 188.0, + 230.0, + 210.5 + ], + "path": [ + 32.532, + 32.377, + 32.388, + 35.68, + 31.69, + 39.745, + 34.843, + 33.387, + 37.387, + 33.104, + 32.994, + 32.206, + 41.562, + 46.693, + 37.15, + 40.557, + 33.337, + 36.082, + 45.719, + 35.872, + 45.214, + 34.349, + 36.665, + 40.591, + 37.334, + 44.91, + 41.339 + ], + "velocity": [ + 0.2, + 0.2, + 0.2, + 0.199, + 0.2, + 0.193, + 0.2, + 0.2, + 0.198, + 0.199, + 0.2, + 0.2, + 0.193, + 0.202, + 0.198, + 0.199, + 0.2, + 0.199, + 0.197, + 0.198, + 0.196, + 0.199, + 0.198, + 0.198, + 0.199, + 0.195, + 0.196 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 2, + 1, + 0, + 1, + 0, + 0, + 0, + 2, + 2, + 1, + 1, + 0, + 2, + 3, + 2, + 3, + 0, + 2, + 1, + 2, + 3, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel01.json new file mode 100644 index 000000000..3e2e3b912 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 138.0, + 135.5, + 148.5, + 138.5, + 138.0, + 126.5, + 142.5, + 139.5, + 137.5, + 159.5, + 126.0, + 138.5, + 138.0, + 127.5, + 161.0, + 164.0, + 163.0, + 126.5, + 154.0, + 127.0, + 165.0, + 165.5, + 137.5, + 167.5, + 167.0, + 165.0, + 168.55 + ], + "path": [ + 27.557, + 26.64, + 29.104, + 27.588, + 27.53, + 25.091, + 28.21, + 27.742, + 27.372, + 31.47, + 24.957, + 27.599, + 27.488, + 25.26, + 30.482, + 30.678, + 30.618, + 25.007, + 30.332, + 25.101, + 30.848, + 30.748, + 26.506, + 31.106, + 31.208, + 30.857, + 31.328 + ], + "velocity": [ + 0.2, + 0.197, + 0.196, + 0.199, + 0.199, + 0.198, + 0.198, + 0.199, + 0.199, + 0.197, + 0.198, + 0.199, + 0.199, + 0.198, + 0.189, + 0.187, + 0.188, + 0.198, + 0.197, + 0.198, + 0.187, + 0.186, + 0.193, + 0.186, + 0.187, + 0.187, + 0.186 + ], + "collision": [ + 0, + 0, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1, + 0, + 1, + 1, + 0, + 1, + 2, + 1, + 0, + 0, + 0, + 1, + 1, + 1, + 1, + 1, + 2, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel02.json new file mode 100644 index 000000000..84888a06c --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel02.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 80.5, + 79.0, + 80.5, + 80.0, + 80.0, + 79.51, + 80.5, + 79.5, + 80.0, + 80.5, + 80.0, + 79.5 + ], + "path": [ + 24.043, + 23.672, + 24.097, + 23.885, + 23.94, + 23.805, + 24.109, + 23.885, + 23.921, + 24.114, + 24.009, + 23.863 + ], + "velocity": [ + 0.299, + 0.3, + 0.299, + 0.299, + 0.299, + 0.299, + 0.299, + 0.3, + 0.299, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel03.json new file mode 100644 index 000000000..538dabfdd --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs05_vel03.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 82.0, + 83.0, + 83.0, + 83.0, + 82.5, + 83.0, + 83.5, + 82.5, + 82.5, + 84.04, + 82.0, + 83.0 + ], + "path": [ + 24.592, + 24.825, + 24.853, + 24.8, + 24.747, + 24.822, + 24.981, + 24.684, + 24.659, + 25.048, + 24.572, + 24.831 + ], + "velocity": [ + 0.3, + 0.299, + 0.299, + 0.299, + 0.3, + 0.299, + 0.299, + 0.299, + 0.299, + 0.298, + 0.3, + 0.299 + ], + "collision": [ + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel01.json new file mode 100644 index 000000000..d489bd417 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel01.json @@ -0,0 +1,247 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29", + "run_30", + "run_31", + "run_32", + "run_33", + "run_34", + "run_35", + "run_36", + "run_37", + "run_38", + "run_39", + "run_40", + "run_41", + "run_42", + "run_43", + "run_44", + "run_45", + "run_46", + "run_47", + "run_48" + ], + "time": [ + 158.5, + 159.5, + 158.0, + 203.5, + 162.5, + 158.5, + 160.5, + 165.5, + 159.0, + 206.5, + 160.0, + 201.5, + 160.0, + 215.5, + 161.0, + 162.0, + 163.0, + 165.5, + 159.0, + 222.0, + 162.0, + 158.5, + 159.0, + 164.0, + 158.0, + 166.5, + 168.0, + 158.5, + 154.5, + 159.5, + 158.5, + 159.0, + 219.0, + 161.5, + 167.5, + 165.5, + 164.5, + 159.5, + 158.0, + 159.5, + 158.0, + 210.5, + 207.5, + 215.0, + 206.5, + 224.5, + 165.0 + ], + "path": [ + 31.697, + 31.88, + 31.623, + 39.725, + 32.477, + 31.701, + 32.109, + 32.819, + 31.751, + 39.526, + 32.017, + 39.407, + 31.883, + 41.093, + 32.208, + 32.338, + 32.574, + 32.836, + 31.803, + 42.412, + 32.355, + 31.716, + 31.831, + 32.476, + 31.582, + 32.952, + 33.334, + 31.708, + 30.902, + 31.894, + 31.701, + 31.762, + 42.272, + 32.229, + 33.125, + 32.823, + 32.619, + 31.869, + 31.635, + 31.91, + 31.62, + 40.77, + 39.584, + 41.462, + 40.313, + 43.171, + 32.687 + ], + "velocity": [ + 0.2, + 0.2, + 0.2, + 0.195, + 0.2, + 0.2, + 0.2, + 0.198, + 0.2, + 0.191, + 0.2, + 0.196, + 0.199, + 0.191, + 0.2, + 0.2, + 0.2, + 0.198, + 0.2, + 0.191, + 0.2, + 0.2, + 0.2, + 0.198, + 0.2, + 0.198, + 0.198, + 0.2, + 0.2, + 0.2, + 0.2, + 0.2, + 0.193, + 0.2, + 0.198, + 0.198, + 0.198, + 0.2, + 0.2, + 0.2, + 0.2, + 0.194, + 0.191, + 0.193, + 0.195, + 0.192, + 0.198 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 1, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 1, + 0, + 1, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 1, + 1, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 2, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel02.json new file mode 100644 index 000000000..22640313c --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel02.json @@ -0,0 +1,77 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14" + ], + "time": [ + 196.5, + 191.0, + 177.5, + 197.01, + 197.0, + 228.0, + 175.99, + 179.95, + 175.0, + 171.0, + 191.5, + 213.0, + 191.49 + ], + "path": [ + 37.653, + 36.284, + 35.216, + 37.721, + 37.889, + 42.349, + 34.972, + 35.821, + 34.789, + 34.017, + 36.809, + 38.737, + 36.776 + ], + "velocity": [ + 0.192, + 0.19, + 0.198, + 0.191, + 0.192, + 0.186, + 0.199, + 0.199, + 0.199, + 0.199, + 0.192, + 0.182, + 0.192 + ], + "collision": [ + 1, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel03.json new file mode 100644 index 000000000..613de98df --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs10_vel03.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 322.5, + 171.0, + 170.5, + 189.0, + 172.5, + 187.0, + 414.0, + 188.5, + 168.5, + 220.5, + 188.0, + 201.5 + ], + "path": [ + 57.792, + 33.635, + 33.095, + 35.609, + 33.991, + 36.757, + 74.557, + 36.768, + 32.43, + 43.859, + 36.028, + 39.823 + ], + "velocity": [ + 0.179, + 0.197, + 0.194, + 0.188, + 0.197, + 0.197, + 0.18, + 0.195, + 0.192, + 0.199, + 0.192, + 0.198 + ], + "collision": [ + 3, + 1, + 0, + 1, + 1, + 2, + 6, + 2, + 0, + 2, + 1, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel01.json new file mode 100644 index 000000000..7d56869a7 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 163.0, + 166.5, + 161.5, + 169.0, + 167.0, + 166.0, + 166.5, + 171.5, + 169.5, + 167.0, + 240.0, + 165.5, + 167.5, + 168.0, + 164.5, + 165.5, + 168.5, + 166.0, + 166.0, + 170.0, + 168.5, + 165.5, + 169.0, + 169.0, + 166.0, + 161.0, + 162.5 + ], + "path": [ + 32.571, + 32.992, + 32.212, + 32.857, + 33.11, + 32.888, + 33.028, + 33.979, + 32.744, + 33.057, + 44.429, + 32.814, + 33.118, + 33.173, + 32.624, + 32.853, + 33.355, + 32.9, + 32.834, + 32.938, + 33.403, + 32.788, + 32.777, + 33.492, + 32.808, + 32.106, + 32.458 + ], + "velocity": [ + 0.2, + 0.198, + 0.199, + 0.194, + 0.198, + 0.198, + 0.198, + 0.198, + 0.193, + 0.198, + 0.185, + 0.198, + 0.198, + 0.197, + 0.198, + 0.199, + 0.198, + 0.198, + 0.198, + 0.194, + 0.198, + 0.198, + 0.194, + 0.198, + 0.198, + 0.199, + 0.2 + ], + "collision": [ + 0, + 1, + 0, + 0, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 0, + 1, + 1, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel02.json new file mode 100644 index 000000000..c25cf19a7 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel02.json @@ -0,0 +1,77 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14" + ], + "time": [ + 117.0, + 124.0, + 119.5, + 116.5, + 120.5, + 121.52, + 142.0, + 127.0, + 118.49, + 121.0, + 119.0, + 123.0, + 119.5 + ], + "path": [ + 33.745, + 36.298, + 34.883, + 34.184, + 34.961, + 34.984, + 39.544, + 35.949, + 34.86, + 35.233, + 34.664, + 35.609, + 34.815 + ], + "velocity": [ + 0.288, + 0.293, + 0.292, + 0.293, + 0.29, + 0.288, + 0.278, + 0.283, + 0.294, + 0.291, + 0.291, + 0.29, + 0.291 + ], + "collision": [ + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel03.json new file mode 100644 index 000000000..c2513ad20 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/cadrl_map1_obs20_vel03.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 128.5, + 127.48, + 128.5, + 127.0, + 126.5, + 126.99, + 127.49, + 126.95, + 126.99, + 126.99, + 126.5, + 123.0 + ], + "path": [ + 37.824, + 37.913, + 38.286, + 37.75, + 37.74, + 37.81, + 37.922, + 37.786, + 37.771, + 37.789, + 37.097, + 36.574 + ], + "velocity": [ + 0.294, + 0.297, + 0.298, + 0.297, + 0.298, + 0.298, + 0.297, + 0.298, + 0.297, + 0.298, + 0.293, + 0.297 + ], + "collision": [ + 2, + 1, + 2, + 2, + 1, + 2, + 1, + 1, + 1, + 2, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel01.json new file mode 100644 index 000000000..3c6e14059 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel01.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 34.834, + 33.0, + 33.167, + 33.167, + 34.166, + 33.502, + 33.167, + 33.666, + 33.5, + 32.833, + 33.5, + 34.913, + 34.808, + 33.713, + 33.166, + 33.167, + 33.167, + 33.43, + 32.904, + 33.044, + 33.334, + 33.167, + 32.832, + 33.333, + 33.5, + 33.0, + 33.001, + 32.834 + ], + "path": [ + 29.74, + 29.707, + 29.851, + 29.857, + 30.064, + 30.12, + 29.819, + 30.313, + 30.153, + 29.526, + 30.182, + 29.732, + 29.859, + 30.004, + 29.881, + 29.857, + 29.846, + 29.973, + 29.595, + 29.739, + 30.034, + 29.827, + 29.55, + 30.041, + 30.185, + 29.729, + 29.712, + 29.527 + ], + "velocity": [ + 0.854, + 0.9, + 0.9, + 0.9, + 0.88, + 0.899, + 0.899, + 0.9, + 0.9, + 0.899, + 0.901, + 0.852, + 0.858, + 0.89, + 0.901, + 0.9, + 0.9, + 0.897, + 0.899, + 0.9, + 0.901, + 0.899, + 0.9, + 0.901, + 0.901, + 0.901, + 0.9, + 0.899 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel02.json new file mode 100644 index 000000000..e59174880 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 39.5, + 35.166, + 35.167, + 35.496, + 35.0, + 35.333, + 35.0, + 35.333, + 35.333, + 35.333, + 35.167, + 34.833, + 34.833, + 35.333, + 35.167, + 35.167, + 34.833, + 35.166, + 35.0, + 34.834, + 35.0, + 35.167, + 35.0, + 35.333, + 35.166, + 35.0, + 35.334, + 35.166 + ], + "path": [ + 33.619, + 31.678, + 31.655, + 31.894, + 31.494, + 31.795, + 31.495, + 31.798, + 31.799, + 31.804, + 31.652, + 31.347, + 31.38, + 31.829, + 31.641, + 31.65, + 31.321, + 31.654, + 31.471, + 31.318, + 31.48, + 31.661, + 31.522, + 31.812, + 31.648, + 31.504, + 31.82, + 31.616 + ], + "velocity": [ + 0.851, + 0.901, + 0.9, + 0.899, + 0.9, + 0.9, + 0.9, + 0.9, + 0.9, + 0.9, + 0.9, + 0.9, + 0.901, + 0.901, + 0.9, + 0.9, + 0.899, + 0.9, + 0.899, + 0.899, + 0.899, + 0.9, + 0.901, + 0.9, + 0.9, + 0.9, + 0.901, + 0.899 + ], + "collision": [ + 2, + 1, + 1, + 0, + 1, + 0, + 1, + 0, + 0, + 1, + 0, + 0, + 0, + 1, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel03.json new file mode 100644 index 000000000..0dac32822 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs05_vel03.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 38.335, + 35.002, + 34.166, + 49.667, + 38.334, + 39.0, + 53.5, + 40.332, + 41.334, + 34.833, + 41.667, + 45.833, + 46.834, + 34.333, + 34.834, + 40.665, + 43.501, + 35.334, + 39.667, + 41.833, + 43.833, + 34.666, + 46.334, + 41.5, + 47.167, + 35.0, + 35.167, + 34.334 + ], + "path": [ + 32.816, + 31.467, + 30.743, + 44.362, + 34.493, + 35.088, + 48.28, + 36.304, + 36.331, + 31.32, + 37.505, + 41.053, + 41.91, + 30.929, + 31.377, + 36.374, + 38.719, + 31.799, + 35.749, + 37.557, + 38.172, + 31.196, + 41.498, + 35.652, + 42.361, + 31.512, + 31.641, + 30.904 + ], + "velocity": [ + 0.856, + 0.899, + 0.9, + 0.893, + 0.9, + 0.9, + 0.902, + 0.9, + 0.879, + 0.899, + 0.9, + 0.896, + 0.895, + 0.901, + 0.901, + 0.894, + 0.89, + 0.9, + 0.901, + 0.898, + 0.871, + 0.9, + 0.896, + 0.859, + 0.898, + 0.9, + 0.9, + 0.9 + ], + "collision": [ + 1, + 0, + 0, + 2, + 0, + 0, + 3, + 2, + 1, + 0, + 1, + 1, + 2, + 0, + 0, + 1, + 0, + 0, + 1, + 1, + 3, + 0, + 0, + 2, + 3, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel01.json new file mode 100644 index 000000000..179119866 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel01.json @@ -0,0 +1,137 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26" + ], + "time": [ + 93.0, + 93.5, + 93.0, + 95.5, + 95.0, + 95.5, + 95.5, + 95.0, + 95.0, + 94.5, + 94.5, + 94.0, + 92.0, + 94.5, + 93.5, + 96.0, + 94.0, + 93.0, + 93.5, + 92.0, + 95.5, + 94.5, + 96.5, + 93.5, + 92.5 + ], + "path": [ + 27.87, + 28.036, + 27.904, + 28.625, + 28.51, + 28.66, + 28.648, + 28.51, + 28.508, + 28.351, + 28.38, + 28.211, + 27.64, + 28.359, + 28.063, + 28.776, + 28.209, + 27.818, + 28.082, + 27.613, + 28.696, + 28.327, + 28.947, + 28.052, + 27.755 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.299, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel02.json new file mode 100644 index 000000000..2c99c5929 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 99.0, + 96.5, + 99.5, + 96.0, + 96.5, + 95.5, + 99.5, + 96.0, + 96.55, + 95.5, + 97.5, + 99.5, + 100.5, + 94.0, + 93.0, + 97.0, + 94.5, + 93.0, + 98.5, + 98.0, + 98.5, + 97.0, + 93.5, + 97.0, + 94.0, + 98.5, + 99.0 + ], + "path": [ + 29.743, + 28.955, + 29.849, + 28.805, + 28.944, + 28.625, + 29.887, + 28.802, + 28.946, + 28.621, + 29.251, + 29.904, + 30.144, + 28.203, + 27.933, + 29.068, + 28.351, + 27.902, + 29.549, + 29.401, + 29.532, + 29.128, + 28.026, + 29.107, + 28.197, + 29.514, + 29.704 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.301, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 1, + 0, + 1, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 1, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel03.json new file mode 100644 index 000000000..58d205f22 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 98.0, + 101.0, + 97.5, + 112.5, + 94.0, + 105.0, + 99.0, + 98.0, + 111.5, + 100.0, + 98.0, + 111.5, + 98.0, + 94.5, + 95.0, + 102.0, + 94.5, + 95.0, + 105.5, + 99.0, + 100.0, + 101.5, + 112.5, + 96.5, + 98.0, + 105.55, + 97.0 + ], + "path": [ + 29.414, + 30.376, + 29.272, + 33.765, + 28.171, + 31.622, + 29.704, + 29.459, + 33.489, + 30.066, + 29.428, + 33.36, + 29.423, + 28.328, + 28.497, + 30.649, + 28.356, + 28.477, + 31.683, + 29.745, + 30.069, + 30.54, + 33.751, + 28.951, + 29.435, + 31.743, + 29.091 + ], + "velocity": [ + 0.3, + 0.301, + 0.3, + 0.3, + 0.3, + 0.301, + 0.3, + 0.301, + 0.3, + 0.301, + 0.3, + 0.299, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.301, + 0.301, + 0.3, + 0.3, + 0.3, + 0.301, + 0.3 + ], + "collision": [ + 1, + 1, + 1, + 2, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 0, + 1, + 0, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel01.json new file mode 100644 index 000000000..b08fc20c6 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 102.5, + 100.0, + 101.0, + 103.0, + 98.0, + 120.5, + 97.0, + 110.95, + 100.5, + 117.0, + 103.5, + 97.5, + 101.5, + 136.0, + 124.5, + 121.0, + 130.0, + 123.0, + 96.95, + 104.5, + 104.5, + 111.5, + 107.5, + 114.5, + 105.5, + 123.0, + 121.0 + ], + "path": [ + 30.536, + 29.201, + 30.299, + 30.692, + 29.371, + 34.877, + 29.069, + 32.267, + 30.148, + 34.045, + 30.529, + 29.14, + 30.452, + 39.696, + 36.547, + 34.863, + 38.347, + 36.212, + 29.111, + 31.336, + 31.145, + 33.237, + 32.067, + 33.493, + 31.179, + 35.893, + 35.042 + ], + "velocity": [ + 0.298, + 0.292, + 0.3, + 0.298, + 0.3, + 0.289, + 0.3, + 0.291, + 0.3, + 0.291, + 0.295, + 0.299, + 0.3, + 0.292, + 0.294, + 0.288, + 0.295, + 0.294, + 0.3, + 0.3, + 0.298, + 0.298, + 0.298, + 0.293, + 0.296, + 0.292, + 0.29 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 1, + 1, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel02.json new file mode 100644 index 000000000..e2daa28d0 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 120.5, + 123.5, + 122.5, + 123.5, + 114.5, + 167.0, + 131.0, + 123.05, + 116.5, + 114.45, + 111.0, + 164.0, + 134.0, + 117.5, + 110.0, + 121.5, + 112.0, + 125.95, + 110.5, + 131.5, + 137.0, + 117.5, + 113.5, + 111.5, + 112.0, + 123.0, + 135.0 + ], + "path": [ + 34.484, + 35.374, + 36.614, + 36.864, + 34.315, + 46.95, + 37.662, + 36.62, + 34.549, + 34.109, + 33.128, + 47.24, + 39.09, + 35.179, + 32.902, + 35.553, + 33.079, + 37.011, + 33.145, + 37.89, + 40.493, + 35.075, + 34.065, + 33.447, + 33.342, + 36.784, + 39.147 + ], + "velocity": [ + 0.286, + 0.286, + 0.299, + 0.298, + 0.3, + 0.281, + 0.287, + 0.298, + 0.297, + 0.298, + 0.298, + 0.288, + 0.292, + 0.299, + 0.299, + 0.293, + 0.295, + 0.294, + 0.3, + 0.288, + 0.296, + 0.299, + 0.3, + 0.3, + 0.298, + 0.299, + 0.29 + ], + "collision": [ + 1, + 1, + 1, + 3, + 0, + 2, + 2, + 1, + 2, + 0, + 0, + 2, + 0, + 0, + 0, + 1, + 0, + 2, + 0, + 1, + 2, + 1, + 0, + 0, + 2, + 2, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel03.json new file mode 100644 index 000000000..e9438789a --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_empty_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 229.5, + 118.5, + 123.5, + 136.5, + 152.0, + 153.5, + 136.05, + 120.5, + 99.5, + 166.0, + 147.0, + 111.0, + 136.55, + 148.0, + 149.5, + 106.0, + 124.5, + 182.0, + 189.0, + 204.5, + 121.5, + 112.5, + 127.5, + 147.0, + 121.0, + 136.0, + 149.55 + ], + "path": [ + 65.662, + 35.509, + 35.866, + 39.276, + 45.272, + 45.557, + 39.013, + 35.659, + 28.816, + 48.911, + 43.443, + 33.257, + 40.402, + 43.768, + 44.347, + 31.369, + 36.909, + 53.685, + 55.776, + 56.004, + 36.309, + 33.408, + 35.987, + 43.15, + 35.496, + 40.205, + 44.407 + ], + "velocity": [ + 0.286, + 0.3, + 0.29, + 0.288, + 0.298, + 0.297, + 0.287, + 0.296, + 0.29, + 0.295, + 0.296, + 0.3, + 0.296, + 0.296, + 0.297, + 0.296, + 0.296, + 0.295, + 0.295, + 0.274, + 0.299, + 0.297, + 0.282, + 0.294, + 0.293, + 0.296, + 0.297 + ], + "collision": [ + 7, + 1, + 2, + 4, + 5, + 5, + 2, + 2, + 2, + 3, + 5, + 1, + 4, + 2, + 5, + 1, + 3, + 7, + 6, + 9, + 1, + 1, + 4, + 4, + 2, + 3, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel01.json new file mode 100644 index 000000000..7f6dc7641 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 92.0, + 93.5, + 92.0, + 93.0, + 93.0, + 92.0, + 124.0, + 105.5, + 91.5, + 92.0, + 91.0, + 91.5, + 93.0, + 101.0, + 91.5, + 98.5, + 93.0, + 95.0, + 100.0, + 105.0, + 93.0, + 92.0, + 101.5, + 104.5, + 93.5, + 92.0, + 102.5 + ], + "path": [ + 27.269, + 27.501, + 27.374, + 27.816, + 27.556, + 27.414, + 35.599, + 30.413, + 27.317, + 27.383, + 27.285, + 27.319, + 26.353, + 28.267, + 27.214, + 27.533, + 27.657, + 28.341, + 29.115, + 30.042, + 27.84, + 27.45, + 29.57, + 29.756, + 27.407, + 27.536, + 29.906 + ], + "velocity": [ + 0.296, + 0.294, + 0.298, + 0.299, + 0.296, + 0.298, + 0.287, + 0.288, + 0.299, + 0.298, + 0.3, + 0.299, + 0.283, + 0.28, + 0.297, + 0.28, + 0.297, + 0.298, + 0.291, + 0.286, + 0.299, + 0.298, + 0.291, + 0.285, + 0.293, + 0.299, + 0.292 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 1, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel02.json new file mode 100644 index 000000000..9a135aadb --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 81.5, + 85.0, + 81.0, + 82.5, + 82.5, + 83.5, + 81.5, + 99.0, + 82.0, + 82.0, + 114.0, + 81.5, + 93.5, + 82.0, + 82.0, + 82.0, + 83.0, + 81.5, + 91.0, + 83.0, + 81.0, + 82.5, + 84.0, + 84.0, + 82.0, + 83.0, + 81.5 + ], + "path": [ + 24.477, + 24.579, + 24.245, + 24.581, + 24.386, + 24.529, + 24.167, + 28.313, + 24.294, + 24.263, + 33.905, + 24.214, + 27.491, + 24.104, + 24.486, + 24.373, + 24.513, + 24.465, + 27.27, + 24.554, + 24.192, + 24.426, + 24.644, + 24.888, + 24.125, + 24.397, + 24.226 + ], + "velocity": [ + 0.3, + 0.289, + 0.299, + 0.298, + 0.296, + 0.294, + 0.297, + 0.286, + 0.296, + 0.296, + 0.297, + 0.297, + 0.294, + 0.294, + 0.299, + 0.297, + 0.295, + 0.3, + 0.3, + 0.296, + 0.299, + 0.296, + 0.293, + 0.296, + 0.294, + 0.294, + 0.297 + ], + "collision": [ + 1, + 1, + 1, + 1, + 0, + 0, + 1, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 0, + 1, + 1, + 1, + 1, + 0, + 0, + 1, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel03.json new file mode 100644 index 000000000..59a78c2ee --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs05_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 82.5, + 82.5, + 81.5, + 82.5, + 82.5, + 82.0, + 81.5, + 81.5, + 83.5, + 81.0, + 85.0, + 81.5, + 80.5, + 80.5, + 81.0, + 80.5, + 82.5, + 82.5, + 81.0, + 81.0, + 82.0, + 80.5, + 81.5, + 84.0, + 80.5, + 84.5, + 82.0 + ], + "path": [ + 24.557, + 24.62, + 24.207, + 24.425, + 24.551, + 24.519, + 24.358, + 24.463, + 24.349, + 24.293, + 24.3, + 24.125, + 24.139, + 24.113, + 24.151, + 24.021, + 24.55, + 24.454, + 23.997, + 24.147, + 24.253, + 24.04, + 24.498, + 24.768, + 24.176, + 24.901, + 24.392 + ], + "velocity": [ + 0.298, + 0.298, + 0.297, + 0.296, + 0.298, + 0.299, + 0.299, + 0.3, + 0.292, + 0.3, + 0.286, + 0.296, + 0.3, + 0.3, + 0.298, + 0.298, + 0.298, + 0.296, + 0.296, + 0.298, + 0.296, + 0.299, + 0.301, + 0.295, + 0.3, + 0.295, + 0.297 + ], + "collision": [ + 1, + 1, + 0, + 0, + 1, + 1, + 1, + 1, + 0, + 0, + 0, + 1, + 0, + 0, + 1, + 0, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel01.json new file mode 100644 index 000000000..4b5de1823 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel01.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 35.499, + 34.667, + 34.333, + 34.167, + 35.334, + 34.333, + 34.5, + 34.167, + 34.333, + 34.333, + 35.0, + 35.0, + 35.166, + 34.333, + 35.334, + 34.833, + 34.333, + 34.166, + 34.333, + 34.0, + 34.666, + 34.833, + 34.333, + 46.666, + 34.5, + 34.5, + 34.5, + 34.167 + ], + "path": [ + 31.0, + 30.989, + 30.839, + 30.716, + 31.388, + 30.798, + 30.953, + 30.665, + 30.834, + 30.362, + 31.145, + 30.893, + 31.311, + 30.787, + 31.532, + 30.989, + 30.793, + 30.683, + 30.564, + 30.43, + 30.816, + 31.134, + 30.67, + 38.866, + 30.932, + 30.861, + 30.746, + 30.692 + ], + "velocity": [ + 0.873, + 0.894, + 0.898, + 0.899, + 0.888, + 0.897, + 0.897, + 0.898, + 0.898, + 0.884, + 0.89, + 0.883, + 0.89, + 0.897, + 0.892, + 0.89, + 0.897, + 0.898, + 0.89, + 0.895, + 0.889, + 0.894, + 0.893, + 0.833, + 0.897, + 0.895, + 0.891, + 0.898 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 2, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel02.json new file mode 100644 index 000000000..12ef158aa --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 41.167, + 45.333, + 39.167, + 44.833, + 47.0, + 45.333, + 57.333, + 47.667, + 47.666, + 48.333, + 47.832, + 47.334, + 46.333, + 47.5, + 47.5, + 45.333, + 45.0, + 40.667, + 46.834, + 46.5, + 47.333, + 46.333, + 48.333, + 46.0, + 46.333, + 46.834, + 44.0, + 46.5 + ], + "path": [ + 35.788, + 39.966, + 34.747, + 39.384, + 40.845, + 39.818, + 46.98, + 41.814, + 42.04, + 42.311, + 42.034, + 41.172, + 39.194, + 41.163, + 41.869, + 39.901, + 39.373, + 36.143, + 40.393, + 40.62, + 39.813, + 40.494, + 42.234, + 40.343, + 40.844, + 41.496, + 38.359, + 40.5 + ], + "velocity": [ + 0.869, + 0.882, + 0.887, + 0.878, + 0.869, + 0.878, + 0.819, + 0.877, + 0.882, + 0.875, + 0.879, + 0.87, + 0.846, + 0.867, + 0.881, + 0.88, + 0.875, + 0.889, + 0.862, + 0.874, + 0.841, + 0.874, + 0.874, + 0.877, + 0.882, + 0.886, + 0.872, + 0.871 + ], + "collision": [ + 2, + 2, + 2, + 2, + 2, + 2, + 4, + 2, + 3, + 3, + 3, + 2, + 2, + 3, + 3, + 3, + 2, + 2, + 4, + 2, + 2, + 2, + 2, + 2, + 2, + 2, + 2, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel03.json new file mode 100644 index 000000000..515a3171e --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs10_vel03.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 57.502, + 62.0, + 54.333, + 54.5, + 80.999, + 47.0, + 52.0, + 45.5, + 35.667, + 64.5, + 47.0, + 61.667, + 46.167, + 70.166, + 46.833, + 62.167, + 62.167, + 52.167, + 35.332, + 77.833, + 62.166, + 90.501, + 60.666, + 62.167, + 86.834, + 70.001, + 77.5, + 62.0 + ], + "path": [ + 47.558, + 52.168, + 46.559, + 46.504, + 63.784, + 40.751, + 44.955, + 39.508, + 31.172, + 53.893, + 40.453, + 53.29, + 40.19, + 58.347, + 40.447, + 52.41, + 53.13, + 43.74, + 30.805, + 62.755, + 50.349, + 70.754, + 50.892, + 53.331, + 70.139, + 57.374, + 64.48, + 52.81 + ], + "velocity": [ + 0.827, + 0.841, + 0.857, + 0.853, + 0.787, + 0.867, + 0.865, + 0.868, + 0.874, + 0.836, + 0.861, + 0.864, + 0.871, + 0.832, + 0.864, + 0.843, + 0.855, + 0.838, + 0.872, + 0.806, + 0.81, + 0.782, + 0.839, + 0.858, + 0.808, + 0.82, + 0.832, + 0.852 + ], + "collision": [ + 4, + 3, + 4, + 2, + 6, + 2, + 2, + 1, + 1, + 4, + 2, + 3, + 3, + 5, + 3, + 4, + 3, + 2, + 1, + 5, + 5, + 6, + 5, + 3, + 7, + 4, + 6, + 4 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel01.json new file mode 100644 index 000000000..406163e3b --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel01.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 109.5, + 108.0, + 122.0, + 109.5, + 106.0, + 115.0, + 109.0, + 126.5, + 148.0, + 111.0, + 111.0, + 142.0, + 127.0, + 114.55, + 141.0, + 122.0, + 137.5, + 107.5, + 123.5, + 122.0, + 109.5, + 169.5, + 124.5, + 120.45, + 117.0, + 118.5, + 122.5, + 126.5 + ], + "path": [ + 31.533, + 31.665, + 35.53, + 31.854, + 31.396, + 33.3, + 31.44, + 35.546, + 41.915, + 32.644, + 32.642, + 40.75, + 35.968, + 33.256, + 39.941, + 34.523, + 38.145, + 31.469, + 34.257, + 36.43, + 32.805, + 47.05, + 36.285, + 33.974, + 33.907, + 33.667, + 35.567, + 35.223 + ], + "velocity": [ + 0.288, + 0.293, + 0.291, + 0.291, + 0.296, + 0.29, + 0.288, + 0.281, + 0.283, + 0.294, + 0.294, + 0.287, + 0.283, + 0.29, + 0.283, + 0.283, + 0.277, + 0.293, + 0.277, + 0.299, + 0.3, + 0.278, + 0.291, + 0.282, + 0.29, + 0.284, + 0.29, + 0.278 + ], + "collision": [ + 0, + 1, + 3, + 3, + 2, + 1, + 2, + 3, + 2, + 1, + 1, + 2, + 2, + 2, + 3, + 2, + 2, + 1, + 1, + 0, + 1, + 4, + 1, + 2, + 3, + 2, + 1, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel02.json new file mode 100644 index 000000000..2a27f15dc --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 124.0, + 127.0, + 116.5, + 123.0, + 127.5, + 112.0, + 112.5, + 129.5, + 110.0, + 158.5, + 112.0, + 112.0, + 110.5, + 116.95, + 109.5, + 115.0, + 117.0, + 110.5, + 114.5, + 112.0, + 114.0, + 115.5, + 113.5, + 115.0, + 116.0, + 119.0, + 113.0, + 115.5 + ], + "path": [ + 36.02, + 37.43, + 34.35, + 35.468, + 36.444, + 33.191, + 32.957, + 38.16, + 32.364, + 45.036, + 32.777, + 33.023, + 32.743, + 34.792, + 32.432, + 32.664, + 34.906, + 32.596, + 33.818, + 33.224, + 33.725, + 33.94, + 33.244, + 33.844, + 33.268, + 34.918, + 33.275, + 34.19 + ], + "velocity": [ + 0.29, + 0.295, + 0.295, + 0.288, + 0.286, + 0.296, + 0.293, + 0.295, + 0.294, + 0.284, + 0.293, + 0.295, + 0.296, + 0.297, + 0.296, + 0.284, + 0.298, + 0.295, + 0.295, + 0.297, + 0.296, + 0.294, + 0.293, + 0.294, + 0.287, + 0.293, + 0.294, + 0.296 + ], + "collision": [ + 2, + 2, + 1, + 2, + 1, + 1, + 1, + 2, + 1, + 2, + 1, + 1, + 1, + 2, + 1, + 1, + 2, + 1, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel03.json new file mode 100644 index 000000000..ef7ff3549 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/esdf_map1_obs20_vel03.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 127.5, + 177.5, + 129.5, + 123.5, + 171.0, + 165.5, + 157.0, + 174.05, + 119.0, + 136.0, + 138.5, + 118.0, + 116.5, + 148.5, + 105.5, + 161.0, + 1445.0, + 135.55, + 160.5, + 165.5, + 119.5, + 121.0, + 114.0, + 111.0, + 132.5, + 135.5, + 164.0, + 124.0 + ], + "path": [ + 36.045, + 49.318, + 37.45, + 36.71, + 47.602, + 46.074, + 45.061, + 50.419, + 34.325, + 38.065, + 38.523, + 34.372, + 33.797, + 42.833, + 31.374, + 45.261, + 117.468, + 38.775, + 45.484, + 46.605, + 35.037, + 33.773, + 33.064, + 32.019, + 37.552, + 39.538, + 44.055, + 36.063 + ], + "velocity": [ + 0.283, + 0.278, + 0.289, + 0.297, + 0.278, + 0.278, + 0.287, + 0.29, + 0.288, + 0.28, + 0.278, + 0.291, + 0.29, + 0.288, + 0.297, + 0.281, + 0.081, + 0.286, + 0.283, + 0.282, + 0.293, + 0.279, + 0.29, + 0.288, + 0.283, + 0.292, + 0.269, + 0.291 + ], + "collision": [ + 2, + 6, + 3, + 3, + 8, + 8, + 6, + 8, + 3, + 2, + 4, + 3, + 2, + 1, + 1, + 4, + 19, + 3, + 5, + 6, + 6, + 1, + 4, + 3, + 5, + 4, + 5, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel01.json new file mode 100644 index 000000000..8dfe81e52 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 76.5, + 77.5, + 77.5, + 76.0, + 77.05, + 77.45, + 78.5, + 78.0, + 78.0, + 80.5, + 76.55, + 76.5, + 75.5, + 76.5, + 76.5, + 76.5, + 75.5, + 77.5, + 78.5, + 76.5, + 76.5, + 77.0, + 76.55, + 77.5, + 78.0, + 76.5, + 78.5 + ], + "path": [ + 29.711, + 30.023, + 29.818, + 29.729, + 29.784, + 29.982, + 29.986, + 29.854, + 29.846, + 30.234, + 29.88, + 29.642, + 29.507, + 29.659, + 29.763, + 29.667, + 29.57, + 29.901, + 29.774, + 29.738, + 29.664, + 29.821, + 29.705, + 29.933, + 29.867, + 29.605, + 29.865 + ], + "velocity": [ + 0.388, + 0.387, + 0.385, + 0.391, + 0.387, + 0.387, + 0.382, + 0.383, + 0.383, + 0.376, + 0.39, + 0.387, + 0.391, + 0.388, + 0.389, + 0.388, + 0.392, + 0.386, + 0.379, + 0.389, + 0.388, + 0.387, + 0.388, + 0.386, + 0.383, + 0.387, + 0.38 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel02.json new file mode 100644 index 000000000..8cb7172d3 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 77.0, + 75.5, + 76.0, + 76.0, + 77.5, + 76.5, + 75.5, + 74.55, + 76.0, + 75.0, + 75.45, + 75.05, + 75.0, + 76.0, + 76.05, + 76.0, + 77.0, + 75.95, + 75.0, + 76.0, + 76.5, + 75.0, + 75.45, + 78.0, + 75.0, + 75.5, + 76.5, + 75.5 + ], + "path": [ + 29.851, + 29.778, + 29.971, + 29.949, + 29.964, + 29.967, + 29.75, + 29.45, + 29.968, + 29.843, + 29.854, + 29.696, + 29.778, + 29.776, + 29.944, + 29.772, + 29.96, + 29.756, + 29.674, + 29.925, + 29.858, + 29.683, + 29.774, + 30.012, + 29.627, + 29.832, + 30.042, + 29.671 + ], + "velocity": [ + 0.388, + 0.394, + 0.394, + 0.394, + 0.387, + 0.392, + 0.394, + 0.395, + 0.394, + 0.398, + 0.396, + 0.396, + 0.397, + 0.392, + 0.394, + 0.392, + 0.389, + 0.392, + 0.396, + 0.394, + 0.39, + 0.396, + 0.395, + 0.385, + 0.395, + 0.395, + 0.393, + 0.393 + ], + "collision": [ + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel03.json new file mode 100644 index 000000000..57549009e --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs05_vel03.json @@ -0,0 +1,42 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7" + ], + "time": [ + 105.95, + 116.5, + 129.0, + 118.0, + 91.5, + 108.0 + ], + "path": [ + 35.125, + 33.567, + 34.776, + 33.479, + 33.123, + 35.026 + ], + "velocity": [ + 0.332, + 0.288, + 0.27, + 0.284, + 0.362, + 0.324 + ], + "collision": [ + 3, + 2, + 3, + 2, + 2, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel01.json new file mode 100644 index 000000000..831bc19a0 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 71.5, + 72.55, + 72.0, + 73.5, + 71.95, + 70.95, + 74.55, + 73.0, + 71.5, + 72.5, + 73.5, + 72.0, + 72.5, + 72.5, + 74.0, + 72.0, + 72.0, + 72.0, + 71.0, + 72.5, + 73.0, + 72.0, + 72.5, + 72.5, + 71.5, + 72.0, + 72.0 + ], + "path": [ + 27.834, + 27.941, + 27.818, + 28.094, + 28.006, + 27.848, + 28.179, + 27.926, + 27.888, + 28.089, + 27.852, + 28.078, + 27.868, + 27.979, + 28.136, + 28.058, + 27.935, + 27.801, + 27.838, + 27.986, + 27.929, + 28.05, + 28.057, + 27.964, + 27.963, + 28.076, + 27.99 + ], + "velocity": [ + 0.389, + 0.385, + 0.386, + 0.382, + 0.389, + 0.393, + 0.378, + 0.383, + 0.39, + 0.387, + 0.379, + 0.39, + 0.384, + 0.386, + 0.38, + 0.39, + 0.388, + 0.386, + 0.392, + 0.386, + 0.383, + 0.39, + 0.387, + 0.386, + 0.391, + 0.39, + 0.389 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel02.json new file mode 100644 index 000000000..d430f402d --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 73.0, + 74.0, + 74.0, + 74.0, + 73.5, + 73.5, + 77.5, + 72.0, + 75.05, + 73.55, + 75.0, + 73.5, + 74.95, + 73.0, + 75.5, + 75.5, + 74.0, + 73.0, + 75.5, + 75.0, + 72.5, + 76.0, + 75.95, + 73.0, + 75.0, + 76.0, + 73.5 + ], + "path": [ + 27.92, + 28.123, + 28.238, + 28.107, + 28.149, + 28.159, + 28.375, + 27.635, + 28.139, + 28.01, + 28.214, + 28.151, + 28.18, + 28.085, + 28.158, + 28.07, + 28.116, + 28.068, + 28.19, + 28.127, + 28.011, + 28.171, + 28.299, + 28.154, + 28.117, + 28.358, + 28.08 + ], + "velocity": [ + 0.382, + 0.38, + 0.382, + 0.38, + 0.383, + 0.383, + 0.366, + 0.384, + 0.375, + 0.381, + 0.376, + 0.383, + 0.376, + 0.385, + 0.373, + 0.372, + 0.38, + 0.384, + 0.373, + 0.375, + 0.386, + 0.371, + 0.373, + 0.386, + 0.375, + 0.373, + 0.382 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 1, + 0, + 1, + 1, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel03.json new file mode 100644 index 000000000..c8b0931a9 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 87.0, + 76.5, + 78.0, + 339.0, + 73.0, + 82.0, + 105.5, + 75.5, + 75.0, + 131.5, + 93.0, + 79.45, + 75.5, + 93.0, + 75.5, + 77.0, + 77.95, + 92.5, + 75.0, + 75.0, + 76.0, + 91.5, + 75.0, + 82.5, + 80.5, + 78.5, + 76.05 + ], + "path": [ + 30.299, + 28.412, + 29.09, + 33.774, + 28.183, + 30.076, + 31.757, + 28.136, + 28.626, + 34.512, + 31.8, + 28.573, + 28.268, + 31.489, + 28.159, + 28.205, + 28.399, + 31.607, + 28.21, + 28.287, + 28.457, + 30.91, + 27.971, + 28.846, + 29.286, + 28.69, + 28.452 + ], + "velocity": [ + 0.348, + 0.371, + 0.373, + 0.1, + 0.386, + 0.367, + 0.301, + 0.373, + 0.382, + 0.262, + 0.342, + 0.36, + 0.374, + 0.339, + 0.373, + 0.366, + 0.364, + 0.342, + 0.376, + 0.377, + 0.374, + 0.338, + 0.373, + 0.35, + 0.364, + 0.365, + 0.374 + ], + "collision": [ + 0, + 1, + 1, + 18, + 1, + 1, + 1, + 2, + 1, + 2, + 1, + 1, + 1, + 1, + 1, + 2, + 1, + 0, + 1, + 1, + 1, + 0, + 0, + 1, + 1, + 2, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel01.json new file mode 100644 index 000000000..12159cba7 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel01.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 109.0, + 75.0, + 74.5, + 74.5, + 73.5, + 75.0, + 74.5, + 75.5, + 75.0, + 75.5, + 75.0, + 74.5, + 76.0, + 76.0, + 75.0, + 75.5, + 74.5, + 75.5, + 74.5, + 75.5, + 74.5, + 75.5, + 75.5, + 75.0, + 75.5, + 75.0, + 75.5, + 75.0 + ], + "path": [ + 29.557, + 28.55, + 28.784, + 28.936, + 28.497, + 28.926, + 28.64, + 28.813, + 28.726, + 28.851, + 28.758, + 28.689, + 28.838, + 28.836, + 28.884, + 28.961, + 28.765, + 28.656, + 28.712, + 29.036, + 28.668, + 28.786, + 28.648, + 28.727, + 28.949, + 28.672, + 28.896, + 28.812 + ], + "velocity": [ + 0.271, + 0.381, + 0.386, + 0.388, + 0.388, + 0.386, + 0.384, + 0.382, + 0.383, + 0.382, + 0.383, + 0.385, + 0.379, + 0.379, + 0.385, + 0.384, + 0.386, + 0.38, + 0.385, + 0.385, + 0.385, + 0.381, + 0.379, + 0.383, + 0.383, + 0.382, + 0.383, + 0.384 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel02.json new file mode 100644 index 000000000..c7f7eb55c --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel02.json @@ -0,0 +1,37 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6" + ], + "time": [ + 117.5, + 77.0, + 174.5, + 107.5, + 78.0 + ], + "path": [ + 38.699, + 29.234, + 44.455, + 36.407, + 29.453 + ], + "velocity": [ + 0.329, + 0.38, + 0.255, + 0.339, + 0.378 + ], + "collision": [ + 2, + 1, + 4, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel03.json new file mode 100644 index 000000000..0a5a97786 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_empty_obs20_vel03.json @@ -0,0 +1,17 @@ +{ + "run": [ + "run_2" + ], + "time": [ + 84.5 + ], + "path": [ + 30.229 + ], + "velocity": [ + 0.358 + ], + "collision": [ + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel01.json new file mode 100644 index 000000000..505de0a0a --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 60.95, + 61.5, + 62.0, + 61.5, + 64.5, + 61.05, + 62.0, + 62.5, + 61.0, + 62.95, + 62.5, + 61.5, + 63.0, + 62.55, + 62.0, + 63.05, + 60.5, + 61.0, + 62.5, + 62.45, + 63.0, + 63.05, + 62.0, + 63.5, + 62.95, + 62.45, + 63.0 + ], + "path": [ + 23.667, + 23.732, + 23.642, + 23.764, + 23.863, + 23.603, + 23.572, + 23.744, + 23.719, + 23.716, + 23.704, + 23.533, + 24.0, + 23.517, + 23.741, + 23.753, + 23.633, + 23.594, + 23.756, + 23.77, + 23.875, + 23.659, + 23.715, + 23.656, + 23.755, + 23.922, + 23.603 + ], + "velocity": [ + 0.388, + 0.386, + 0.381, + 0.386, + 0.37, + 0.387, + 0.38, + 0.38, + 0.389, + 0.377, + 0.379, + 0.383, + 0.381, + 0.376, + 0.383, + 0.377, + 0.391, + 0.387, + 0.38, + 0.381, + 0.379, + 0.375, + 0.382, + 0.373, + 0.377, + 0.383, + 0.375 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel02.json new file mode 100644 index 000000000..351a8d81d --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 111.0, + 75.0, + 75.0, + 76.0, + 79.05, + 74.45, + 72.5, + 74.0, + 73.0, + 84.5, + 73.05, + 74.45, + 72.0, + 84.5, + 73.5, + 74.5, + 74.0, + 72.95, + 78.0, + 74.45, + 76.5, + 74.0, + 76.5, + 73.45, + 74.0, + 73.45, + 74.5, + 75.0 + ], + "path": [ + 26.776, + 26.581, + 26.562, + 26.713, + 27.5, + 26.265, + 26.151, + 26.281, + 25.855, + 26.892, + 26.013, + 26.348, + 26.081, + 27.933, + 26.355, + 26.31, + 26.255, + 25.752, + 27.151, + 26.394, + 26.747, + 26.268, + 26.78, + 26.256, + 26.103, + 26.166, + 26.192, + 26.244 + ], + "velocity": [ + 0.241, + 0.354, + 0.354, + 0.351, + 0.348, + 0.353, + 0.361, + 0.355, + 0.354, + 0.318, + 0.356, + 0.354, + 0.362, + 0.331, + 0.359, + 0.353, + 0.355, + 0.353, + 0.348, + 0.355, + 0.35, + 0.355, + 0.35, + 0.357, + 0.353, + 0.356, + 0.352, + 0.35 + ], + "collision": [ + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel03.json new file mode 100644 index 000000000..d98e50019 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs05_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 66.55, + 67.5, + 70.0, + 69.55, + 66.95, + 70.0, + 69.95, + 66.45, + 73.5, + 73.5, + 70.5, + 68.5, + 69.5, + 69.0, + 68.0, + 68.5, + 70.0, + 68.55, + 72.5, + 71.0, + 68.55, + 67.55, + 68.55, + 67.05, + 73.5, + 67.5, + 71.0 + ], + "path": [ + 24.354, + 24.651, + 24.816, + 24.682, + 24.629, + 24.857, + 24.861, + 24.506, + 25.531, + 25.173, + 24.813, + 24.497, + 24.933, + 24.573, + 24.673, + 24.747, + 24.676, + 24.808, + 25.097, + 24.768, + 24.778, + 24.36, + 24.808, + 24.567, + 25.228, + 24.532, + 25.077 + ], + "velocity": [ + 0.366, + 0.365, + 0.355, + 0.355, + 0.368, + 0.355, + 0.355, + 0.369, + 0.347, + 0.342, + 0.352, + 0.358, + 0.359, + 0.356, + 0.363, + 0.361, + 0.353, + 0.362, + 0.346, + 0.349, + 0.361, + 0.361, + 0.362, + 0.366, + 0.343, + 0.363, + 0.353 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 1, + 1, + 0, + 0, + 0, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 0, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel01.json new file mode 100644 index 000000000..0d4a30992 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 73.0, + 73.0, + 72.5, + 73.5, + 72.5, + 73.5, + 73.0, + 74.0, + 73.0, + 72.5, + 72.5, + 73.5, + 72.5, + 72.5, + 73.0, + 72.5, + 72.5, + 72.5, + 72.5, + 73.5, + 72.5, + 72.5, + 73.0, + 72.5, + 73.0, + 72.5, + 73.5 + ], + "path": [ + 28.92, + 28.843, + 28.78, + 28.97, + 28.679, + 28.92, + 28.819, + 28.966, + 28.867, + 28.811, + 28.757, + 29.125, + 28.736, + 28.746, + 28.937, + 28.867, + 28.904, + 28.766, + 28.878, + 28.975, + 28.91, + 28.938, + 28.955, + 28.773, + 28.891, + 28.85, + 28.899 + ], + "velocity": [ + 0.396, + 0.395, + 0.397, + 0.394, + 0.396, + 0.393, + 0.395, + 0.391, + 0.395, + 0.397, + 0.397, + 0.396, + 0.396, + 0.396, + 0.396, + 0.398, + 0.399, + 0.397, + 0.398, + 0.394, + 0.399, + 0.399, + 0.397, + 0.397, + 0.396, + 0.398, + 0.393 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel02.json new file mode 100644 index 000000000..1883fe571 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 75.0, + 76.5, + 75.5, + 101.5, + 77.0, + 75.5, + 75.5, + 74.5, + 77.5, + 80.5, + 76.0, + 108.5, + 76.0, + 75.0, + 75.0, + 76.0, + 79.5, + 75.0, + 76.0, + 79.0, + 75.5, + 107.5, + 79.5, + 75.0, + 75.5, + 76.0, + 75.5 + ], + "path": [ + 29.538, + 29.833, + 29.582, + 33.731, + 29.871, + 29.817, + 29.668, + 29.342, + 30.099, + 30.638, + 29.522, + 33.216, + 29.795, + 29.482, + 29.549, + 29.751, + 30.214, + 29.557, + 29.692, + 30.161, + 29.628, + 33.584, + 30.697, + 29.702, + 29.584, + 29.71, + 29.628 + ], + "velocity": [ + 0.394, + 0.39, + 0.392, + 0.332, + 0.388, + 0.395, + 0.393, + 0.394, + 0.388, + 0.381, + 0.388, + 0.306, + 0.392, + 0.393, + 0.394, + 0.391, + 0.38, + 0.394, + 0.391, + 0.382, + 0.392, + 0.312, + 0.386, + 0.396, + 0.392, + 0.391, + 0.392 + ], + "collision": [ + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel03.json new file mode 100644 index 000000000..e4650726d --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 93.0, + 93.5, + 93.5, + 94.0, + 90.0, + 96.5, + 100.5, + 93.5, + 100.0, + 93.0, + 99.5, + 93.0, + 93.5, + 92.5, + 101.0, + 92.0, + 98.0, + 93.5, + 102.5, + 93.5, + 93.5, + 90.5, + 91.5, + 92.0, + 91.5, + 100.0, + 102.0 + ], + "path": [ + 32.54, + 32.58, + 32.751, + 32.826, + 32.438, + 32.531, + 32.861, + 32.624, + 32.901, + 32.868, + 32.82, + 32.442, + 32.779, + 32.48, + 33.17, + 32.416, + 32.896, + 32.573, + 33.042, + 32.604, + 32.814, + 32.402, + 32.458, + 32.552, + 32.548, + 32.59, + 32.959 + ], + "velocity": [ + 0.35, + 0.348, + 0.35, + 0.349, + 0.36, + 0.337, + 0.327, + 0.349, + 0.329, + 0.353, + 0.33, + 0.349, + 0.351, + 0.351, + 0.328, + 0.352, + 0.336, + 0.348, + 0.322, + 0.349, + 0.351, + 0.358, + 0.355, + 0.354, + 0.356, + 0.326, + 0.323 + ], + "collision": [ + 2, + 1, + 0, + 0, + 1, + 3, + 3, + 2, + 3, + 1, + 3, + 1, + 3, + 1, + 3, + 1, + 2, + 0, + 3, + 1, + 2, + 1, + 1, + 1, + 0, + 3, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel01.json new file mode 100644 index 000000000..c12c2a466 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 77.5, + 75.55, + 78.5, + 76.5, + 78.5, + 76.5, + 75.5, + 76.5, + 76.45, + 75.0, + 75.5, + 75.5, + 76.0, + 76.5, + 78.0, + 77.5, + 75.5, + 77.0, + 77.0, + 76.5, + 76.0, + 77.0, + 76.0, + 76.5, + 76.0, + 76.5, + 78.5 + ], + "path": [ + 29.851, + 29.674, + 29.848, + 29.629, + 29.973, + 29.627, + 29.712, + 29.859, + 29.766, + 29.566, + 29.612, + 29.755, + 29.987, + 29.768, + 29.84, + 29.807, + 29.691, + 29.887, + 29.64, + 29.804, + 29.814, + 29.679, + 29.714, + 29.804, + 29.717, + 29.805, + 29.779 + ], + "velocity": [ + 0.385, + 0.393, + 0.38, + 0.387, + 0.382, + 0.387, + 0.394, + 0.39, + 0.389, + 0.394, + 0.392, + 0.394, + 0.395, + 0.389, + 0.383, + 0.385, + 0.393, + 0.388, + 0.385, + 0.39, + 0.392, + 0.385, + 0.391, + 0.39, + 0.391, + 0.39, + 0.379 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel02.json new file mode 100644 index 000000000..892cf8b51 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 82.5, + 80.0, + 77.5, + 81.0, + 79.5, + 77.0, + 79.5, + 78.0, + 77.0, + 77.5, + 80.5, + 79.5, + 79.5, + 78.5, + 81.0, + 79.5, + 77.0, + 79.0, + 77.5, + 80.0, + 79.5, + 78.0, + 80.0, + 78.5, + 79.0, + 78.5, + 80.5 + ], + "path": [ + 29.939, + 30.22, + 29.878, + 30.039, + 29.893, + 29.738, + 30.004, + 29.81, + 29.946, + 29.809, + 29.975, + 29.805, + 30.103, + 29.837, + 29.95, + 29.792, + 29.88, + 29.943, + 29.882, + 30.071, + 29.861, + 29.968, + 29.92, + 29.791, + 29.975, + 29.739, + 29.914 + ], + "velocity": [ + 0.363, + 0.378, + 0.386, + 0.371, + 0.376, + 0.386, + 0.377, + 0.382, + 0.389, + 0.385, + 0.372, + 0.375, + 0.379, + 0.38, + 0.37, + 0.375, + 0.388, + 0.379, + 0.386, + 0.376, + 0.376, + 0.384, + 0.374, + 0.38, + 0.379, + 0.379, + 0.372 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel03.json new file mode 100644 index 000000000..641305bed --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/mpc_map1_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 81.5, + 84.5, + 80.5, + 82.0, + 81.5, + 83.0, + 80.5, + 82.5, + 83.5, + 81.5, + 82.5, + 84.0, + 86.0, + 82.0, + 84.0, + 84.0, + 80.0, + 81.0, + 80.0, + 85.0, + 82.5, + 84.0, + 82.0, + 83.0, + 80.5, + 81.0, + 82.5 + ], + "path": [ + 30.414, + 30.194, + 30.35, + 30.281, + 30.331, + 30.431, + 30.28, + 30.782, + 30.395, + 30.428, + 30.583, + 30.582, + 30.696, + 30.088, + 30.63, + 30.594, + 30.564, + 30.194, + 30.238, + 30.579, + 30.478, + 30.674, + 30.338, + 30.368, + 30.717, + 30.252, + 30.515 + ], + "velocity": [ + 0.373, + 0.357, + 0.377, + 0.369, + 0.372, + 0.367, + 0.376, + 0.373, + 0.364, + 0.373, + 0.371, + 0.364, + 0.357, + 0.367, + 0.365, + 0.364, + 0.382, + 0.373, + 0.378, + 0.36, + 0.369, + 0.365, + 0.37, + 0.366, + 0.382, + 0.373, + 0.37 + ], + "collision": [ + 3, + 3, + 3, + 3, + 2, + 2, + 2, + 3, + 3, + 3, + 4, + 3, + 3, + 3, + 3, + 3, + 2, + 4, + 1, + 3, + 2, + 4, + 3, + 2, + 3, + 2, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel01.json new file mode 100644 index 000000000..224332f79 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 103.0, + 102.5, + 102.0, + 101.55, + 102.0, + 102.05, + 101.5, + 101.5, + 101.5, + 101.5, + 102.0, + 102.0, + 102.0, + 101.5, + 101.5, + 101.95, + 102.0, + 102.0, + 102.0, + 102.0, + 101.5, + 101.5, + 102.5, + 101.5, + 102.0, + 101.5, + 102.0 + ], + "path": [ + 30.905, + 30.721, + 30.611, + 30.446, + 30.57, + 30.594, + 30.439, + 30.422, + 30.443, + 30.45, + 30.599, + 30.589, + 30.593, + 30.453, + 30.422, + 30.597, + 30.593, + 30.572, + 30.602, + 30.588, + 30.452, + 30.482, + 30.784, + 30.452, + 30.606, + 30.413, + 30.598 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel03.json new file mode 100644 index 000000000..1285c8132 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs05_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 102.0, + 102.0, + 108.5, + 102.5, + 119.0, + 101.5, + 110.0, + 119.0, + 103.5, + 102.0, + 102.0, + 122.5, + 104.5, + 119.0, + 106.0, + 102.0, + 102.5, + 102.0, + 106.5, + 108.0, + 101.95, + 108.0, + 102.5, + 110.0, + 117.0, + 105.5, + 122.5 + ], + "path": [ + 30.428, + 30.489, + 32.526, + 30.546, + 35.472, + 30.123, + 32.996, + 35.515, + 30.759, + 30.435, + 30.525, + 36.697, + 31.117, + 35.154, + 31.782, + 30.51, + 30.616, + 30.525, + 31.717, + 32.345, + 30.508, + 32.392, + 30.338, + 32.38, + 33.44, + 31.393, + 36.646 + ], + "velocity": [ + 0.298, + 0.299, + 0.3, + 0.298, + 0.298, + 0.297, + 0.3, + 0.298, + 0.297, + 0.298, + 0.299, + 0.3, + 0.298, + 0.295, + 0.3, + 0.299, + 0.299, + 0.299, + 0.298, + 0.299, + 0.299, + 0.3, + 0.296, + 0.294, + 0.286, + 0.298, + 0.299 + ], + "collision": [ + 0, + 0, + 2, + 1, + 1, + 1, + 1, + 2, + 1, + 0, + 0, + 1, + 1, + 0, + 0, + 0, + 0, + 0, + 1, + 2, + 0, + 2, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel01.json new file mode 100644 index 000000000..bb7fe7d01 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 94.0, + 97.5, + 94.5, + 94.0, + 94.0, + 94.0, + 93.0, + 93.0, + 93.5, + 94.0, + 93.0, + 97.0, + 93.0, + 94.5, + 94.5, + 94.5, + 94.5, + 94.0, + 94.5, + 94.45, + 94.0, + 94.0, + 94.0, + 93.05, + 94.5, + 94.0, + 94.0 + ], + "path": [ + 28.229, + 29.373, + 28.348, + 28.201, + 28.23, + 28.203, + 27.873, + 27.91, + 28.056, + 28.172, + 27.935, + 29.239, + 27.906, + 28.314, + 28.352, + 28.323, + 28.347, + 28.168, + 28.326, + 28.355, + 28.178, + 28.198, + 28.203, + 27.906, + 28.318, + 28.234, + 28.211 + ], + "velocity": [ + 0.3, + 0.301, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.301, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel02.json new file mode 100644 index 000000000..443ecd31f --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 97.5, + 97.5, + 97.5, + 97.5, + 97.0, + 98.0, + 96.5, + 98.0, + 97.0, + 97.5, + 97.0, + 97.5, + 97.0, + 95.0, + 97.5, + 97.0, + 97.0, + 98.0, + 98.0, + 97.5, + 97.0, + 96.0, + 96.5, + 97.0, + 97.5, + 97.0, + 95.5 + ], + "path": [ + 29.243, + 29.228, + 29.217, + 29.222, + 29.099, + 29.378, + 28.977, + 29.374, + 29.086, + 29.246, + 29.104, + 29.255, + 29.074, + 28.474, + 29.257, + 29.101, + 29.09, + 29.374, + 29.376, + 29.285, + 29.096, + 28.768, + 28.941, + 29.072, + 29.22, + 29.109, + 28.623 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel03.json new file mode 100644 index 000000000..51b3380fb --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 107.5, + 103.0, + 102.5, + 102.5, + 109.0, + 106.0, + 102.5, + 102.5, + 102.5, + 103.0, + 103.05, + 102.0, + 104.0, + 96.5, + 103.0, + 102.0, + 102.5, + 102.0, + 102.5, + 102.5, + 102.5, + 106.5, + 102.5, + 108.5, + 102.0, + 102.0, + 107.0 + ], + "path": [ + 32.218, + 30.916, + 30.791, + 30.774, + 32.668, + 31.768, + 30.787, + 30.801, + 30.738, + 30.919, + 30.92, + 30.593, + 31.203, + 28.948, + 30.906, + 30.626, + 30.725, + 30.621, + 30.747, + 30.776, + 30.772, + 31.955, + 30.777, + 32.52, + 30.608, + 30.635, + 32.103 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.301, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3 + ], + "collision": [ + 0, + 1, + 1, + 1, + 1, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 1, + 0, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel01.json new file mode 100644 index 000000000..2acd76991 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 120.5, + 100.5, + 120.0, + 120.5, + 121.0, + 119.5, + 116.0, + 117.0, + 120.0, + 120.5, + 121.5, + 120.0, + 101.5, + 120.55, + 120.5, + 120.5, + 120.0, + 120.5, + 116.5, + 120.5, + 120.0, + 121.0, + 120.0, + 117.05, + 120.0, + 120.0, + 120.0 + ], + "path": [ + 35.656, + 30.421, + 35.497, + 35.675, + 35.733, + 35.242, + 34.291, + 34.633, + 35.416, + 35.586, + 35.916, + 35.495, + 30.547, + 35.64, + 35.467, + 35.61, + 35.403, + 35.641, + 34.4, + 35.622, + 35.413, + 35.754, + 35.474, + 34.571, + 35.416, + 35.474, + 35.426 + ], + "velocity": [ + 0.296, + 0.303, + 0.296, + 0.296, + 0.295, + 0.295, + 0.296, + 0.296, + 0.295, + 0.295, + 0.296, + 0.296, + 0.301, + 0.296, + 0.294, + 0.296, + 0.295, + 0.296, + 0.295, + 0.296, + 0.295, + 0.295, + 0.296, + 0.295, + 0.295, + 0.296, + 0.295 + ], + "collision": [ + 0, + 1, + 0, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 1, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel02.json new file mode 100644 index 000000000..72196cbb4 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 146.0, + 120.5, + 140.0, + 124.5, + 140.0, + 145.45, + 125.5, + 120.5, + 117.5, + 121.05, + 122.05, + 123.0, + 118.5, + 116.0, + 124.0, + 127.5, + 139.5, + 123.5, + 122.0, + 118.5, + 130.0, + 125.0, + 119.0, + 127.0, + 129.0, + 120.55, + 130.5 + ], + "path": [ + 42.389, + 35.966, + 41.706, + 37.062, + 41.219, + 42.043, + 37.432, + 35.899, + 35.078, + 36.131, + 36.384, + 36.722, + 35.414, + 34.675, + 36.642, + 37.996, + 41.322, + 36.827, + 36.421, + 35.513, + 38.42, + 33.933, + 35.502, + 37.273, + 37.91, + 36.053, + 38.497 + ], + "velocity": [ + 0.29, + 0.298, + 0.298, + 0.298, + 0.294, + 0.289, + 0.298, + 0.298, + 0.299, + 0.298, + 0.298, + 0.299, + 0.299, + 0.299, + 0.295, + 0.298, + 0.296, + 0.298, + 0.299, + 0.3, + 0.296, + 0.271, + 0.298, + 0.293, + 0.294, + 0.299, + 0.295 + ], + "collision": [ + 3, + 1, + 3, + 2, + 3, + 2, + 1, + 2, + 1, + 2, + 2, + 2, + 1, + 1, + 3, + 2, + 4, + 2, + 2, + 2, + 4, + 0, + 2, + 2, + 3, + 2, + 4 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel03.json new file mode 100644 index 000000000..4799053ff --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_empty_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 176.5, + 141.5, + 145.0, + 257.5, + 138.0, + 133.5, + 201.0, + 180.5, + 178.0, + 208.5, + 218.0, + 308.5, + 99.55, + 178.0, + 195.5, + 255.5, + 256.45, + 160.0, + 210.5, + 236.5, + 227.5, + 191.95, + 163.0, + 226.5, + 194.5, + 175.5, + 123.5 + ], + "path": [ + 52.859, + 42.45, + 43.242, + 75.907, + 40.877, + 40.009, + 58.626, + 53.991, + 53.296, + 60.549, + 62.788, + 88.124, + 29.824, + 52.44, + 57.726, + 74.747, + 74.719, + 48.433, + 62.179, + 69.178, + 66.883, + 57.469, + 48.79, + 65.365, + 58.065, + 51.348, + 37.085 + ], + "velocity": [ + 0.299, + 0.3, + 0.298, + 0.295, + 0.296, + 0.3, + 0.292, + 0.299, + 0.299, + 0.29, + 0.288, + 0.286, + 0.3, + 0.295, + 0.295, + 0.293, + 0.291, + 0.303, + 0.295, + 0.293, + 0.294, + 0.299, + 0.299, + 0.289, + 0.299, + 0.293, + 0.3 + ], + "collision": [ + 4, + 3, + 3, + 6, + 3, + 4, + 6, + 4, + 4, + 6, + 4, + 11, + 0, + 3, + 4, + 7, + 7, + 3, + 6, + 6, + 6, + 3, + 2, + 4, + 3, + 5, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel01.json new file mode 100644 index 000000000..240459442 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 121.0, + 82.5, + 79.55, + 375.5, + 80.5, + 79.5, + 81.5, + 80.0, + 80.0, + 80.0, + 87.35, + 83.45, + 83.45, + 85.5, + 80.5, + 125.5, + 87.0, + 90.5, + 114.35, + 91.05, + 93.1, + 82.5, + 85.5, + 103.0, + 96.45, + 87.95, + 83.55 + ], + "path": [ + 30.001, + 24.732, + 23.842, + 74.173, + 24.035, + 23.741, + 24.351, + 23.89, + 23.872, + 23.846, + 25.659, + 24.519, + 24.405, + 25.247, + 24.088, + 34.161, + 25.266, + 25.276, + 32.311, + 26.625, + 27.118, + 24.61, + 24.692, + 27.889, + 27.596, + 25.89, + 24.858 + ], + "velocity": [ + 0.248, + 0.3, + 0.3, + 0.198, + 0.299, + 0.299, + 0.299, + 0.299, + 0.298, + 0.298, + 0.294, + 0.294, + 0.292, + 0.295, + 0.299, + 0.272, + 0.29, + 0.279, + 0.283, + 0.292, + 0.291, + 0.298, + 0.289, + 0.271, + 0.286, + 0.294, + 0.298 + ], + "collision": [ + 1, + 0, + 2, + 6, + 1, + 2, + 2, + 1, + 1, + 1, + 0, + 1, + 2, + 0, + 1, + 1, + 1, + 1, + 3, + 1, + 1, + 1, + 2, + 1, + 2, + 2, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel02.json new file mode 100644 index 000000000..de773c421 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 91.0, + 90.5, + 81.55, + 84.0, + 89.5, + 84.5, + 88.95, + 79.5, + 85.95, + 82.0, + 91.0, + 86.45, + 83.5, + 105.0, + 117.5, + 106.5, + 82.5, + 84.0, + 80.0, + 80.0, + 81.5, + 80.0, + 79.45, + 85.0, + 89.5, + 81.55, + 110.0 + ], + "path": [ + 27.327, + 26.341, + 24.173, + 24.904, + 26.267, + 25.12, + 24.457, + 23.857, + 24.63, + 24.126, + 26.396, + 24.456, + 24.74, + 29.597, + 32.568, + 29.291, + 24.483, + 25.188, + 23.778, + 24.0, + 24.087, + 23.974, + 23.844, + 25.185, + 24.898, + 24.36, + 32.251 + ], + "velocity": [ + 0.3, + 0.291, + 0.296, + 0.296, + 0.293, + 0.297, + 0.275, + 0.3, + 0.287, + 0.294, + 0.29, + 0.283, + 0.296, + 0.282, + 0.277, + 0.275, + 0.297, + 0.3, + 0.297, + 0.3, + 0.296, + 0.3, + 0.3, + 0.296, + 0.278, + 0.299, + 0.293 + ], + "collision": [ + 1, + 0, + 1, + 0, + 0, + 0, + 1, + 0, + 1, + 1, + 1, + 0, + 0, + 1, + 2, + 0, + 1, + 1, + 1, + 0, + 1, + 0, + 0, + 0, + 1, + 1, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel03.json new file mode 100644 index 000000000..7d4c0dec5 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs05_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 86.0, + 88.5, + 82.0, + 87.5, + 90.0, + 98.0, + 88.0, + 86.0, + 92.5, + 91.5, + 87.0, + 88.0, + 561.5, + 87.5, + 80.5, + 85.0, + 84.5, + 80.0, + 82.5, + 85.5, + 82.05, + 87.5, + 107.55, + 86.5, + 104.5, + 87.0, + 89.5 + ], + "path": [ + 25.533, + 26.058, + 24.604, + 25.911, + 26.261, + 28.577, + 25.537, + 25.224, + 27.203, + 26.942, + 24.914, + 25.906, + 96.125, + 26.151, + 24.07, + 23.897, + 25.327, + 23.919, + 24.511, + 25.547, + 24.469, + 25.322, + 31.334, + 25.678, + 29.753, + 25.538, + 26.184 + ], + "velocity": [ + 0.297, + 0.294, + 0.3, + 0.296, + 0.292, + 0.292, + 0.29, + 0.293, + 0.294, + 0.294, + 0.286, + 0.294, + 0.171, + 0.299, + 0.299, + 0.281, + 0.3, + 0.299, + 0.297, + 0.299, + 0.298, + 0.289, + 0.291, + 0.297, + 0.285, + 0.294, + 0.293 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 2, + 1, + 0, + 0, + 0, + 1, + 0, + 8, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 0, + 0, + 2, + 1, + 0, + 0, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel01.json new file mode 100644 index 000000000..187a27ef5 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 100.5, + 100.5, + 102.0, + 101.0, + 100.5, + 102.0, + 101.0, + 100.5, + 100.5, + 101.0, + 100.5, + 102.0, + 101.0, + 101.0, + 100.5, + 100.5, + 101.5, + 100.5, + 100.5, + 101.5, + 100.5, + 101.0, + 100.0, + 101.0, + 101.0, + 101.0, + 101.5 + ], + "path": [ + 30.161, + 30.127, + 30.599, + 30.316, + 30.16, + 30.58, + 30.302, + 30.14, + 30.151, + 30.264, + 30.121, + 30.556, + 30.288, + 30.32, + 30.15, + 30.139, + 30.438, + 30.156, + 30.15, + 30.419, + 30.147, + 30.269, + 30.006, + 30.276, + 30.272, + 30.247, + 30.425 + ], + "velocity": [ + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.3, + 0.299, + 0.3 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel02.json new file mode 100644 index 000000000..6c568a259 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 114.5, + 115.5, + 116.5, + 117.0, + 116.0, + 116.0, + 115.0, + 116.5, + 115.5, + 115.5, + 137.0, + 137.0, + 116.0, + 115.0, + 116.0, + 116.5, + 116.0, + 115.5, + 117.0, + 116.0, + 116.0, + 115.0, + 116.0, + 117.0, + 116.0, + 116.5, + 116.5, + 115.5 + ], + "path": [ + 34.021, + 34.178, + 34.576, + 34.617, + 34.374, + 34.44, + 34.086, + 34.493, + 34.226, + 34.259, + 39.997, + 39.968, + 34.341, + 34.082, + 34.382, + 34.551, + 34.379, + 34.252, + 34.654, + 34.361, + 34.393, + 34.04, + 34.364, + 34.621, + 34.297, + 34.497, + 34.415, + 34.185 + ], + "velocity": [ + 0.297, + 0.296, + 0.297, + 0.296, + 0.296, + 0.297, + 0.296, + 0.296, + 0.296, + 0.297, + 0.292, + 0.292, + 0.296, + 0.296, + 0.296, + 0.297, + 0.296, + 0.297, + 0.296, + 0.296, + 0.296, + 0.296, + 0.296, + 0.296, + 0.296, + 0.296, + 0.295, + 0.296 + ], + "collision": [ + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel03.json new file mode 100644 index 000000000..b66495644 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs10_vel03.json @@ -0,0 +1,137 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26" + ], + "time": [ + 168.0, + 143.5, + 168.5, + 168.5, + 168.0, + 157.0, + 167.5, + 168.5, + 168.0, + 168.5, + 168.0, + 142.0, + 193.5, + 169.0, + 143.5, + 141.5, + 142.5, + 168.5, + 167.0, + 168.5, + 168.5, + 169.5, + 167.5, + 387.0, + 235.0 + ], + "path": [ + 46.472, + 42.398, + 46.54, + 46.576, + 46.304, + 45.042, + 46.38, + 46.387, + 46.438, + 46.492, + 46.439, + 41.441, + 53.055, + 46.603, + 41.942, + 41.749, + 42.067, + 46.446, + 46.215, + 46.524, + 46.486, + 46.779, + 46.348, + 45.789, + 60.935 + ], + "velocity": [ + 0.277, + 0.295, + 0.276, + 0.276, + 0.276, + 0.287, + 0.277, + 0.275, + 0.276, + 0.276, + 0.276, + 0.292, + 0.274, + 0.276, + 0.292, + 0.295, + 0.295, + 0.276, + 0.277, + 0.276, + 0.276, + 0.276, + 0.277, + 0.118, + 0.259 + ], + "collision": [ + 3, + 3, + 5, + 5, + 5, + 2, + 4, + 5, + 4, + 4, + 5, + 4, + 2, + 5, + 4, + 3, + 3, + 5, + 2, + 4, + 3, + 5, + 4, + 4, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel01.json new file mode 100644 index 000000000..2d3a7eb00 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 205.5, + 139.5, + 131.5, + 134.5, + 136.0, + 388.0, + 185.5, + 139.5, + 156.0, + 152.5, + 156.5, + 141.5, + 151.5, + 136.5, + 180.5, + 151.0, + 148.0, + 153.0, + 147.0, + 736.0, + 222.5, + 129.5, + 128.0, + 148.0, + 139.5, + 153.35, + 151.95 + ], + "path": [ + 58.866, + 40.869, + 38.544, + 39.471, + 40.709, + 50.066, + 53.347, + 40.867, + 46.22, + 45.102, + 46.532, + 41.766, + 44.11, + 40.183, + 53.088, + 44.582, + 43.575, + 45.255, + 43.364, + 57.625, + 65.097, + 38.802, + 38.113, + 43.072, + 40.989, + 45.458, + 45.206 + ], + "velocity": [ + 0.286, + 0.293, + 0.293, + 0.293, + 0.299, + 0.129, + 0.288, + 0.293, + 0.296, + 0.296, + 0.297, + 0.295, + 0.291, + 0.294, + 0.294, + 0.295, + 0.294, + 0.296, + 0.295, + 0.078, + 0.293, + 0.3, + 0.298, + 0.291, + 0.294, + 0.296, + 0.298 + ], + "collision": [ + 5, + 4, + 3, + 3, + 1, + 5, + 6, + 3, + 4, + 4, + 3, + 2, + 4, + 1, + 5, + 3, + 3, + 3, + 3, + 4, + 7, + 4, + 2, + 3, + 3, + 5, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel02.json new file mode 100644 index 000000000..d505c628d --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 131.5, + 190.5, + 157.0, + 154.0, + 149.5, + 159.5, + 126.95, + 157.0, + 183.5, + 151.5, + 150.5, + 135.0, + 146.5, + 154.5, + 149.55, + 158.0, + 158.5, + 127.5, + 133.05, + 150.45, + 150.05, + 148.0, + 223.5, + 151.95, + 151.55, + 129.45, + 147.05 + ], + "path": [ + 38.601, + 52.797, + 44.997, + 45.417, + 44.462, + 46.024, + 37.66, + 45.8, + 52.086, + 45.332, + 44.352, + 39.977, + 43.183, + 45.299, + 43.727, + 46.607, + 46.45, + 37.685, + 39.201, + 43.595, + 43.94, + 42.904, + 60.318, + 44.808, + 43.089, + 38.553, + 43.39 + ], + "velocity": [ + 0.294, + 0.277, + 0.287, + 0.295, + 0.297, + 0.289, + 0.297, + 0.292, + 0.284, + 0.299, + 0.295, + 0.296, + 0.295, + 0.293, + 0.292, + 0.295, + 0.293, + 0.296, + 0.295, + 0.29, + 0.293, + 0.29, + 0.27, + 0.295, + 0.284, + 0.298, + 0.295 + ], + "collision": [ + 3, + 8, + 5, + 4, + 3, + 4, + 2, + 4, + 6, + 3, + 3, + 1, + 3, + 5, + 3, + 4, + 3, + 3, + 3, + 5, + 3, + 4, + 5, + 4, + 3, + 2, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel03.json new file mode 100644 index 000000000..d5cb5bf51 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/subsample_map1_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 126.0, + 151.0, + 149.5, + 151.0, + 147.0, + 159.0, + 217.05, + 144.5, + 155.5, + 146.5, + 149.5, + 129.5, + 155.0, + 153.55, + 131.5, + 148.0, + 156.5, + 152.0, + 151.5, + 150.5, + 113.5, + 177.0, + 128.5, + 149.5, + 154.5, + 143.0, + 151.5 + ], + "path": [ + 37.404, + 45.132, + 43.749, + 41.911, + 42.332, + 46.899, + 55.891, + 42.958, + 45.543, + 42.716, + 43.448, + 38.248, + 45.768, + 44.629, + 38.762, + 43.233, + 46.711, + 45.066, + 44.897, + 43.852, + 34.127, + 51.299, + 38.501, + 43.972, + 45.938, + 41.197, + 44.965 + ], + "velocity": [ + 0.297, + 0.299, + 0.293, + 0.278, + 0.288, + 0.295, + 0.258, + 0.297, + 0.293, + 0.292, + 0.291, + 0.295, + 0.295, + 0.291, + 0.295, + 0.292, + 0.298, + 0.296, + 0.296, + 0.291, + 0.301, + 0.29, + 0.3, + 0.294, + 0.297, + 0.288, + 0.297 + ], + "collision": [ + 2, + 3, + 2, + 4, + 3, + 3, + 5, + 3, + 4, + 3, + 2, + 2, + 4, + 2, + 3, + 4, + 3, + 4, + 4, + 4, + 1, + 5, + 3, + 3, + 4, + 3, + 3 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel01.json new file mode 100644 index 000000000..4918ca11a --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 74.55, + 74.5, + 74.55, + 74.0, + 74.5, + 75.05, + 74.5, + 74.5, + 75.55, + 75.5, + 74.5, + 75.0, + 75.05, + 75.0, + 74.5, + 75.0, + 74.5, + 74.5, + 74.5, + 74.5, + 75.0, + 74.5, + 75.0, + 74.5, + 74.5, + 75.0, + 75.0 + ], + "path": [ + 29.679, + 29.598, + 29.661, + 29.466, + 29.643, + 29.621, + 29.633, + 29.674, + 29.777, + 29.717, + 29.575, + 29.682, + 29.613, + 29.739, + 29.523, + 29.797, + 29.643, + 29.66, + 29.631, + 29.617, + 29.75, + 29.628, + 29.623, + 29.67, + 29.694, + 29.71, + 29.602 + ], + "velocity": [ + 0.398, + 0.397, + 0.398, + 0.398, + 0.398, + 0.395, + 0.398, + 0.398, + 0.394, + 0.394, + 0.397, + 0.396, + 0.395, + 0.397, + 0.396, + 0.397, + 0.398, + 0.398, + 0.398, + 0.398, + 0.397, + 0.398, + 0.395, + 0.398, + 0.399, + 0.396, + 0.395 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel02.json new file mode 100644 index 000000000..6f68d224e --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel02.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 101.95, + 104.05, + 102.0, + 103.5, + 78.5, + 102.0, + 103.05, + 102.0, + 78.0, + 102.5, + 102.5, + 103.0, + 79.0, + 102.0, + 104.0, + 102.5, + 102.5, + 103.0, + 77.95, + 101.95, + 102.55, + 77.5, + 76.5, + 102.5, + 103.0, + 78.0, + 103.5, + 102.05 + ], + "path": [ + 33.777, + 33.987, + 33.797, + 33.824, + 30.319, + 33.786, + 33.929, + 33.918, + 30.195, + 33.898, + 33.862, + 33.706, + 30.382, + 33.686, + 33.97, + 33.988, + 33.619, + 33.977, + 30.146, + 33.745, + 33.913, + 30.12, + 30.042, + 33.603, + 33.961, + 30.183, + 34.113, + 33.908 + ], + "velocity": [ + 0.331, + 0.327, + 0.331, + 0.327, + 0.386, + 0.331, + 0.329, + 0.333, + 0.387, + 0.331, + 0.33, + 0.327, + 0.385, + 0.33, + 0.327, + 0.332, + 0.328, + 0.33, + 0.387, + 0.331, + 0.331, + 0.389, + 0.393, + 0.328, + 0.33, + 0.387, + 0.33, + 0.332 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel03.json new file mode 100644 index 000000000..fe9b80cc0 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs05_vel03.json @@ -0,0 +1,152 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28", + "run_29" + ], + "time": [ + 96.55, + 100.5, + 97.0, + 102.0, + 110.5, + 124.5, + 88.55, + 101.0, + 97.5, + 103.0, + 96.95, + 100.05, + 125.0, + 100.5, + 97.95, + 97.5, + 96.0, + 87.45, + 87.5, + 100.5, + 88.05, + 101.55, + 100.05, + 96.55, + 90.0, + 86.5, + 105.55, + 93.5 + ], + "path": [ + 34.123, + 34.859, + 33.779, + 35.864, + 35.651, + 37.523, + 32.939, + 34.874, + 33.888, + 33.85, + 33.701, + 34.939, + 37.794, + 35.005, + 33.953, + 33.862, + 33.83, + 32.634, + 32.504, + 34.174, + 32.825, + 35.028, + 35.303, + 33.272, + 32.793, + 32.718, + 34.813, + 33.636 + ], + "velocity": [ + 0.353, + 0.347, + 0.348, + 0.352, + 0.323, + 0.301, + 0.372, + 0.345, + 0.348, + 0.329, + 0.348, + 0.349, + 0.302, + 0.348, + 0.347, + 0.347, + 0.352, + 0.373, + 0.371, + 0.34, + 0.373, + 0.345, + 0.353, + 0.345, + 0.364, + 0.378, + 0.33, + 0.36 + ], + "collision": [ + 1, + 1, + 1, + 2, + 1, + 2, + 1, + 2, + 1, + 1, + 1, + 1, + 4, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel01.json new file mode 100644 index 000000000..28653f6ed --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 69.95, + 70.5, + 70.0, + 70.5, + 70.0, + 70.05, + 70.5, + 70.45, + 70.0, + 70.0, + 70.45, + 70.0, + 70.5, + 70.5, + 70.5, + 70.5, + 70.05, + 70.55, + 70.5, + 70.0, + 70.0, + 70.0, + 70.55, + 70.5, + 70.05, + 69.5, + 70.0 + ], + "path": [ + 27.864, + 28.021, + 27.879, + 27.919, + 27.817, + 27.78, + 27.985, + 27.938, + 27.824, + 27.81, + 28.103, + 27.82, + 27.957, + 27.938, + 27.942, + 27.918, + 27.793, + 28.054, + 27.953, + 27.872, + 27.799, + 27.822, + 27.996, + 28.001, + 27.836, + 27.654, + 27.782 + ], + "velocity": [ + 0.398, + 0.397, + 0.398, + 0.396, + 0.397, + 0.397, + 0.397, + 0.397, + 0.397, + 0.397, + 0.399, + 0.397, + 0.397, + 0.396, + 0.396, + 0.396, + 0.397, + 0.398, + 0.397, + 0.398, + 0.397, + 0.397, + 0.397, + 0.397, + 0.397, + 0.398, + 0.397 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel02.json new file mode 100644 index 000000000..4f6fa4723 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 69.95, + 70.5, + 70.0, + 70.5, + 70.5, + 70.5, + 70.45, + 70.5, + 70.5, + 69.45, + 70.0, + 70.5, + 70.0, + 70.0, + 70.5, + 70.0, + 70.5, + 70.05, + 70.0, + 70.55, + 70.0, + 70.5, + 70.5, + 70.0, + 70.0, + 70.0, + 70.5 + ], + "path": [ + 27.84, + 28.008, + 27.853, + 28.01, + 28.016, + 28.006, + 28.085, + 27.997, + 27.933, + 27.644, + 27.811, + 28.024, + 27.839, + 27.866, + 27.99, + 27.83, + 28.077, + 27.84, + 27.878, + 28.07, + 27.819, + 27.98, + 28.028, + 27.89, + 27.847, + 27.901, + 28.056 + ], + "velocity": [ + 0.398, + 0.397, + 0.398, + 0.397, + 0.397, + 0.397, + 0.399, + 0.397, + 0.396, + 0.398, + 0.397, + 0.398, + 0.398, + 0.398, + 0.397, + 0.398, + 0.398, + 0.397, + 0.398, + 0.398, + 0.397, + 0.397, + 0.398, + 0.398, + 0.398, + 0.399, + 0.398 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel03.json new file mode 100644 index 000000000..b8579e5a3 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs10_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 70.0, + 70.0, + 70.0, + 70.55, + 70.0, + 70.5, + 70.0, + 70.55, + 70.0, + 70.0, + 70.5, + 70.5, + 70.0, + 71.0, + 70.5, + 70.45, + 70.5, + 70.0, + 70.0, + 70.0, + 71.0, + 69.5, + 70.0, + 70.5, + 70.0, + 70.5, + 70.45 + ], + "path": [ + 27.808, + 27.821, + 27.807, + 27.956, + 27.87, + 28.037, + 27.842, + 28.045, + 27.875, + 27.839, + 27.946, + 28.047, + 27.839, + 28.107, + 27.981, + 28.018, + 27.968, + 27.819, + 27.788, + 27.792, + 28.186, + 27.538, + 27.928, + 27.978, + 27.772, + 28.029, + 28.036 + ], + "velocity": [ + 0.397, + 0.397, + 0.397, + 0.396, + 0.398, + 0.398, + 0.398, + 0.398, + 0.398, + 0.398, + 0.396, + 0.398, + 0.398, + 0.396, + 0.397, + 0.398, + 0.397, + 0.397, + 0.397, + 0.397, + 0.397, + 0.396, + 0.399, + 0.397, + 0.397, + 0.398, + 0.398 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel01.json new file mode 100644 index 000000000..3f1032c6f --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 74.5, + 74.0, + 75.0, + 74.0, + 74.5, + 73.5, + 74.0, + 74.0, + 75.0, + 87.0, + 74.5, + 76.0, + 75.0, + 74.5, + 74.5, + 74.5, + 74.0, + 74.5, + 73.5, + 73.5, + 75.5, + 75.0, + 74.5, + 74.5, + 75.0, + 74.0, + 75.0 + ], + "path": [ + 28.913, + 28.919, + 29.088, + 28.798, + 28.928, + 28.817, + 28.861, + 28.738, + 28.93, + 31.169, + 28.874, + 29.159, + 28.965, + 28.894, + 28.853, + 29.125, + 28.811, + 28.921, + 28.84, + 28.94, + 29.111, + 29.075, + 28.915, + 28.867, + 28.978, + 28.679, + 29.065 + ], + "velocity": [ + 0.388, + 0.391, + 0.388, + 0.389, + 0.388, + 0.392, + 0.39, + 0.388, + 0.386, + 0.358, + 0.388, + 0.384, + 0.386, + 0.388, + 0.387, + 0.391, + 0.389, + 0.388, + 0.392, + 0.394, + 0.386, + 0.388, + 0.388, + 0.387, + 0.386, + 0.388, + 0.388 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel02.json new file mode 100644 index 000000000..6e0e5b908 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel02.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 101.5, + 259.0, + 75.5, + 77.0, + 159.5, + 80.0, + 292.5, + 84.5, + 101.0, + 102.0, + 101.5, + 101.0, + 80.5, + 102.0, + 90.5, + 162.0, + 78.5, + 86.0, + 82.5, + 100.5, + 76.5, + 102.0, + 102.0, + 85.5, + 157.0, + 89.5, + 79.0 + ], + "path": [ + 34.75, + 60.649, + 28.472, + 29.426, + 43.646, + 29.238, + 62.478, + 31.03, + 34.98, + 34.76, + 35.022, + 35.03, + 29.807, + 35.056, + 31.67, + 47.889, + 29.573, + 30.993, + 29.728, + 35.433, + 28.781, + 34.915, + 35.011, + 31.02, + 44.528, + 30.982, + 29.137 + ], + "velocity": [ + 0.342, + 0.234, + 0.377, + 0.382, + 0.274, + 0.365, + 0.214, + 0.367, + 0.346, + 0.341, + 0.345, + 0.347, + 0.37, + 0.344, + 0.35, + 0.296, + 0.377, + 0.36, + 0.36, + 0.353, + 0.376, + 0.342, + 0.343, + 0.363, + 0.284, + 0.346, + 0.369 + ], + "collision": [ + 1, + 4, + 0, + 1, + 2, + 0, + 1, + 0, + 2, + 2, + 1, + 1, + 0, + 1, + 1, + 1, + 0, + 0, + 0, + 1, + 0, + 1, + 2, + 0, + 2, + 1, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel03.json new file mode 100644 index 000000000..03105195e --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_empty_obs20_vel03.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 96.5, + 260.5, + 85.5, + 86.5, + 86.0, + 183.5, + 88.0, + 86.5, + 93.0, + 186.5, + 189.0, + 75.5, + 87.0, + 87.5, + 84.5, + 85.5, + 93.0, + 84.5, + 88.5, + 219.0, + 84.0, + 266.0, + 92.0, + 89.0, + 142.0, + 117.0, + 121.5 + ], + "path": [ + 32.11, + 60.439, + 31.389, + 31.209, + 31.278, + 48.78, + 31.248, + 31.845, + 33.174, + 48.43, + 50.35, + 28.668, + 31.71, + 32.288, + 31.065, + 31.423, + 33.145, + 31.138, + 32.291, + 54.886, + 31.234, + 58.583, + 32.963, + 31.616, + 43.163, + 37.825, + 39.738 + ], + "velocity": [ + 0.333, + 0.232, + 0.367, + 0.361, + 0.364, + 0.266, + 0.355, + 0.368, + 0.357, + 0.26, + 0.266, + 0.38, + 0.364, + 0.369, + 0.368, + 0.368, + 0.356, + 0.368, + 0.365, + 0.251, + 0.372, + 0.22, + 0.358, + 0.355, + 0.304, + 0.323, + 0.327 + ], + "collision": [ + 1, + 2, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2, + 0, + 1, + 1, + 1, + 1, + 1, + 1, + 1, + 2, + 1, + 3, + 1, + 1, + 2, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel01.json new file mode 100644 index 000000000..a49a7c2ea --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 60.5, + 61.0, + 60.95, + 60.05, + 61.0, + 60.45, + 60.05, + 60.05, + 60.0, + 60.5, + 60.0, + 59.95, + 60.05, + 60.0, + 60.0, + 60.45, + 60.45, + 60.45, + 60.0, + 60.0, + 60.0, + 60.5, + 60.0, + 60.95, + 60.0, + 60.0, + 60.0 + ], + "path": [ + 23.998, + 23.88, + 23.941, + 23.868, + 24.055, + 23.79, + 23.89, + 23.744, + 23.808, + 24.007, + 23.7, + 23.841, + 23.825, + 23.811, + 23.843, + 24.037, + 23.967, + 24.055, + 23.719, + 23.799, + 23.89, + 23.877, + 23.845, + 24.099, + 23.853, + 23.785, + 23.782 + ], + "velocity": [ + 0.397, + 0.391, + 0.393, + 0.397, + 0.394, + 0.394, + 0.398, + 0.395, + 0.397, + 0.397, + 0.395, + 0.398, + 0.397, + 0.397, + 0.397, + 0.398, + 0.396, + 0.398, + 0.395, + 0.397, + 0.398, + 0.395, + 0.397, + 0.395, + 0.398, + 0.396, + 0.396 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel02.json new file mode 100644 index 000000000..0b3a5250f --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel02.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 67.02, + 68.5, + 67.0, + 67.0, + 68.49, + 67.99, + 67.5, + 67.5, + 67.97, + 66.5, + 67.5, + 68.5 + ], + "path": [ + 25.446, + 25.9, + 25.545, + 25.413, + 25.778, + 25.503, + 25.465, + 25.517, + 25.749, + 25.32, + 25.404, + 25.78 + ], + "velocity": [ + 0.38, + 0.378, + 0.381, + 0.379, + 0.376, + 0.375, + 0.377, + 0.378, + 0.379, + 0.381, + 0.376, + 0.376 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel03.json new file mode 100644 index 000000000..b71b9c70d --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs05_vel03.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 64.01, + 67.49, + 66.49, + 65.49, + 65.0, + 85.0, + 68.0, + 65.0, + 130.0, + 67.5, + 65.0, + 65.5 + ], + "path": [ + 24.781, + 25.31, + 24.97, + 24.926, + 24.8, + 29.794, + 25.377, + 24.749, + 40.69, + 24.969, + 24.772, + 24.632 + ], + "velocity": [ + 0.387, + 0.375, + 0.376, + 0.381, + 0.382, + 0.351, + 0.373, + 0.381, + 0.313, + 0.37, + 0.381, + 0.376 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 2, + 1, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel01.json new file mode 100644 index 000000000..9ab4450fe --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 75.0, + 75.0, + 74.5, + 75.0, + 75.0, + 74.5, + 75.5, + 75.0, + 74.5, + 74.5, + 74.5, + 75.0, + 74.5, + 74.5, + 74.5, + 74.5, + 74.5, + 75.0, + 75.0, + 74.5, + 75.0, + 75.0, + 74.5, + 75.5, + 75.5, + 75.5, + 74.5 + ], + "path": [ + 29.027, + 29.098, + 28.984, + 29.112, + 29.105, + 29.0, + 29.145, + 29.047, + 28.993, + 29.017, + 28.963, + 29.066, + 28.976, + 29.019, + 29.026, + 28.979, + 29.015, + 29.055, + 29.049, + 29.007, + 29.017, + 28.998, + 28.974, + 29.032, + 29.138, + 29.136, + 28.93 + ], + "velocity": [ + 0.387, + 0.388, + 0.389, + 0.388, + 0.388, + 0.389, + 0.386, + 0.387, + 0.389, + 0.389, + 0.389, + 0.388, + 0.389, + 0.39, + 0.39, + 0.389, + 0.389, + 0.387, + 0.387, + 0.389, + 0.387, + 0.387, + 0.389, + 0.385, + 0.386, + 0.386, + 0.388 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel02.json new file mode 100644 index 000000000..bd3570d26 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel02.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 77.02, + 75.51, + 77.48, + 76.01, + 75.5, + 75.47, + 75.51, + 77.46, + 76.49, + 77.52, + 78.02, + 76.52 + ], + "path": [ + 29.638, + 29.434, + 29.68, + 29.505, + 29.409, + 29.427, + 29.364, + 29.507, + 29.603, + 29.711, + 29.715, + 29.566 + ], + "velocity": [ + 0.385, + 0.39, + 0.383, + 0.388, + 0.39, + 0.39, + 0.389, + 0.381, + 0.387, + 0.383, + 0.381, + 0.386 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel03.json new file mode 100644 index 000000000..45615bea6 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs10_vel03.json @@ -0,0 +1,72 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13" + ], + "time": [ + 94.52, + 93.0, + 95.5, + 93.01, + 97.99, + 94.52, + 93.48, + 94.0, + 93.0, + 94.0, + 99.49, + 94.47 + ], + "path": [ + 33.115, + 32.734, + 33.026, + 32.992, + 33.687, + 32.787, + 32.752, + 32.8, + 32.85, + 33.229, + 34.778, + 33.111 + ], + "velocity": [ + 0.35, + 0.352, + 0.346, + 0.355, + 0.344, + 0.347, + 0.35, + 0.349, + 0.353, + 0.353, + 0.35, + 0.35 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 1, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel01.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel01.json new file mode 100644 index 000000000..a80870a57 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel01.json @@ -0,0 +1,147 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14", + "run_15", + "run_16", + "run_17", + "run_18", + "run_19", + "run_20", + "run_21", + "run_22", + "run_23", + "run_24", + "run_25", + "run_26", + "run_27", + "run_28" + ], + "time": [ + 76.5, + 76.5, + 76.5, + 76.5, + 77.0, + 76.5, + 76.5, + 76.0, + 76.5, + 77.0, + 76.0, + 76.5, + 76.5, + 77.0, + 77.0, + 77.0, + 77.0, + 76.5, + 76.5, + 77.0, + 76.5, + 76.5, + 76.5, + 76.5, + 76.5, + 77.0, + 77.0 + ], + "path": [ + 29.857, + 29.805, + 29.867, + 29.862, + 29.916, + 29.806, + 29.88, + 29.738, + 29.749, + 29.872, + 29.735, + 29.849, + 29.809, + 29.937, + 29.938, + 29.895, + 29.995, + 29.854, + 29.833, + 29.882, + 29.905, + 29.863, + 29.85, + 29.858, + 29.929, + 29.986, + 29.83 + ], + "velocity": [ + 0.39, + 0.39, + 0.39, + 0.39, + 0.389, + 0.39, + 0.391, + 0.391, + 0.389, + 0.388, + 0.391, + 0.39, + 0.39, + 0.389, + 0.389, + 0.388, + 0.39, + 0.39, + 0.39, + 0.388, + 0.391, + 0.39, + 0.39, + 0.39, + 0.391, + 0.389, + 0.387 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel02.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel02.json new file mode 100644 index 000000000..88a554701 --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel02.json @@ -0,0 +1,77 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14" + ], + "time": [ + 81.0, + 78.0, + 77.5, + 77.5, + 77.5, + 77.5, + 115.0, + 77.5, + 77.5, + 77.5, + 77.5, + 77.5, + 77.0 + ], + "path": [ + 30.018, + 29.987, + 30.028, + 29.971, + 29.897, + 30.006, + 37.923, + 29.862, + 29.946, + 30.046, + 29.946, + 29.956, + 29.84 + ], + "velocity": [ + 0.371, + 0.384, + 0.387, + 0.387, + 0.386, + 0.387, + 0.33, + 0.385, + 0.386, + 0.388, + 0.386, + 0.387, + 0.388 + ], + "collision": [ + 0, + 0, + 0, + 0, + 0, + 0, + 1, + 0, + 0, + 0, + 0, + 0, + 0 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel03.json b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel03.json new file mode 100644 index 000000000..1c36aa8fb --- /dev/null +++ b/arena_navigation/arena_local_planner/evaluation/scripts/quantitative/run_1_2/teb_map1_obs20_vel03.json @@ -0,0 +1,77 @@ +{ + "run": [ + "run_2", + "run_3", + "run_4", + "run_5", + "run_6", + "run_7", + "run_8", + "run_9", + "run_10", + "run_11", + "run_12", + "run_13", + "run_14" + ], + "time": [ + 104.0, + 77.49, + 101.0, + 92.99, + 102.0, + 77.49, + 77.5, + 88.0, + 101.0, + 86.51, + 88.49, + 78.48, + 78.98 + ], + "path": [ + 35.66, + 30.171, + 35.595, + 33.121, + 35.533, + 30.176, + 30.151, + 32.041, + 35.607, + 31.568, + 32.975, + 30.251, + 30.223 + ], + "velocity": [ + 0.343, + 0.389, + 0.352, + 0.356, + 0.348, + 0.389, + 0.389, + 0.364, + 0.353, + 0.365, + 0.373, + 0.385, + 0.383 + ], + "collision": [ + 1, + 1, + 1, + 2, + 1, + 1, + 1, + 2, + 1, + 2, + 2, + 1, + 1 + ] +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/MLP_ARENA2D_2021_04_12__16_08/hyperparameters.json b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/MLP_ARENA2D_2021_04_12__16_08/hyperparameters.json new file mode 100644 index 000000000..f0c79ff63 --- /dev/null +++ b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/MLP_ARENA2D_2021_04_12__16_08/hyperparameters.json @@ -0,0 +1,20 @@ +{ + "agent_name": "MLP_ARENA2D_2021_04_12__16_08", + "robot": "myrobot", + "gamma": 0.99, + "n_steps": 128, + "ent_coef": 0.01, + "learning_rate": 0.00025, + "vf_coef": 0.5, + "max_grad_norm": 0.5, + "gae_lambda": 0.95, + "batch_size": 64, + "n_epochs": 4, + "clip_range": 0.2, + "reward_fnc": "rule_01", + "discrete_action_space": false, + "normalize": true, + "task_mode": "staged", + "curr_stage": 1, + "n_timesteps": 0 +} \ No newline at end of file diff --git a/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/drl_local_planner_03_25/best_model.zip b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/drl_local_planner_03_25/best_model.zip index 43cc83c0b..77a008da2 100644 Binary files a/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/drl_local_planner_03_25/best_model.zip and b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/agents/drl_local_planner_03_25/best_model.zip differ diff --git a/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/noise_parameter b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/noise_parameter new file mode 100644 index 000000000..0cfbf0888 --- /dev/null +++ b/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/noise_parameter @@ -0,0 +1 @@ +2 diff --git a/docs/Readme_for_noise_and_delay_modules.md b/docs/Readme_for_noise_and_delay_modules.md new file mode 100644 index 000000000..746f38ef4 --- /dev/null +++ b/docs/Readme_for_noise_and_delay_modules.md @@ -0,0 +1,55 @@ +## 1.Goals +Adding noise and latency to laser scan sensors + + +## 2.Principle +We renamed the original "scan" topic to "scan_original" topic and added a new node "scan_process " +to receive the information from "scan_original", and process the sensor information in the new node +to increase the noise and delay. Finally,the processed sensor information is broadcast with the "scan" topic. +So no additional files need to be changed to accommodate the noise and delay modules. + + + +##3. Mode and start-up commands for noise and delay modules + +###3.1 Mode for noise and delay modules + +#### Mode for noise module +- The first noise mode is the gaussian noise.It is a noise that fits a Gaussian normal distribution. +- The second noise mode is the offset noise.It simulate by Random Walk errors. +- The third noise mode is the angle noise. It simulate angular errors, which are made up of mechanical horizontal and vertical errors. +- The fourth noise mode is bias noise.It simulate Physical offsets. + +#### Mode for delay module +- Adding fixed time delays to sensor information. + +###3.2 Parameters for noise module + +```bash + "max_value_of_data": Maximum value of sensor information + "gauss_mean": Mean value of Gaussian noise + "gauss_sigma": Standard deviation range of Gaussian noise + "gauss_size": Size of gauss error + "bias_noise": Size of bias error + "offset_noise": Mean value of random error + "angle_noise": Angular error in radians.(mrad) +``` +The parameters can be modified in the noise_parameter.json file + +###3.3 Start-up commands for noise and delay modules +- In one terminal, start simulation. You can specify the following parameters: + + * noise_mode:=<0,1,2,3,4>(default 0,means without noise) #Different noises can be selected individually or together.eg.noise_mode:=123 It means that noise mode123 is added at the same time. + * delay:= (default 0) # Delay time + +```bash +roslaunch arena_bringup start_arena_flatland.launch train_mode:=false use_viz:=true local_planner:=mpc map_file:=map1 obs_vel:=0.3 noise_mode := 1 delay:= 10 +``` + +## 4.Location of function and how to merge. +- The functions are implemented in the realistic_modeling/scan_process folder. +- Changed parameters and started newly added sublaunch in start_arena_flatland.launch. +- Started new nodes and topics in scan_process.launch. +- Rename the original topic name in flatland_simulator.launch. + +The noise and delay modules can be added to any version of the program by simply making changes to the above sections. diff --git a/realistic_modeling/scan_process/CMakeLists.txt b/realistic_modeling/scan_process/CMakeLists.txt new file mode 100644 index 000000000..df981c7df --- /dev/null +++ b/realistic_modeling/scan_process/CMakeLists.txt @@ -0,0 +1,206 @@ +cmake_minimum_required(VERSION 3.0.2) +project(scan_process) + +## Compile as C++11, supported in ROS Kinetic and newer +# add_compile_options(-std=c++11) + +## Find catkin macros and libraries +## if COMPONENTS list like find_package(catkin REQUIRED COMPONENTS xyz) +## is used, also find other catkin packages +find_package(catkin REQUIRED COMPONENTS + roscpp + rospy + std_msgs +) + +## System dependencies are found with CMake's conventions +# find_package(Boost REQUIRED COMPONENTS system) + + +## Uncomment this if the package has a setup.py. This macro ensures +## modules and global scripts declared therein get installed +## See http://ros.org/doc/api/catkin/html/user_guide/setup_dot_py.html +# catkin_python_setup() + +################################################ +## Declare ROS messages, services and actions ## +################################################ + +## To declare and build messages, services or actions from within this +## package, follow these steps: +## * Let MSG_DEP_SET be the set of packages whose message types you use in +## your messages/services/actions (e.g. std_msgs, actionlib_msgs, ...). +## * In the file package.xml: +## * add a build_depend tag for "message_generation" +## * add a build_depend and a exec_depend tag for each package in MSG_DEP_SET +## * If MSG_DEP_SET isn't empty the following dependency has been pulled in +## but can be declared for certainty nonetheless: +## * add a exec_depend tag for "message_runtime" +## * In this file (CMakeLists.txt): +## * add "message_generation" and every package in MSG_DEP_SET to +## find_package(catkin REQUIRED COMPONENTS ...) +## * add "message_runtime" and every package in MSG_DEP_SET to +## catkin_package(CATKIN_DEPENDS ...) +## * uncomment the add_*_files sections below as needed +## and list every .msg/.srv/.action file to be processed +## * uncomment the generate_messages entry below +## * add every package in MSG_DEP_SET to generate_messages(DEPENDENCIES ...) + +## Generate messages in the 'msg' folder +# add_message_files( +# FILES +# Message1.msg +# Message2.msg +# ) + +## Generate services in the 'srv' folder +# add_service_files( +# FILES +# Service1.srv +# Service2.srv +# ) + +## Generate actions in the 'action' folder +# add_action_files( +# FILES +# Action1.action +# Action2.action +# ) + +## Generate added messages and services with any dependencies listed here +# generate_messages( +# DEPENDENCIES +# std_msgs # Or other packages containing msgs +# ) + +################################################ +## Declare ROS dynamic reconfigure parameters ## +################################################ + +## To declare and build dynamic reconfigure parameters within this +## package, follow these steps: +## * In the file package.xml: +## * add a build_depend and a exec_depend tag for "dynamic_reconfigure" +## * In this file (CMakeLists.txt): +## * add "dynamic_reconfigure" to +## find_package(catkin REQUIRED COMPONENTS ...) +## * uncomment the "generate_dynamic_reconfigure_options" section below +## and list every .cfg file to be processed + +## Generate dynamic reconfigure parameters in the 'cfg' folder +# generate_dynamic_reconfigure_options( +# cfg/DynReconf1.cfg +# cfg/DynReconf2.cfg +# ) + +################################### +## catkin specific configuration ## +################################### +## The catkin_package macro generates cmake config files for your package +## Declare things to be passed to dependent projects +## INCLUDE_DIRS: uncomment this if your package contains header files +## LIBRARIES: libraries you create in this project that dependent projects also need +## CATKIN_DEPENDS: catkin_packages dependent projects also need +## DEPENDS: system dependencies of this project that dependent projects also need +catkin_package( +# INCLUDE_DIRS include +# LIBRARIES laser_noise +# CATKIN_DEPENDS roscpp rospy std_msg +# DEPENDS system_lib +) + +########### +## Build ## +########### + +## Specify additional locations of header files +## Your package locations should be listed before other locations +include_directories( +# include + ${catkin_INCLUDE_DIRS} +) + +## Declare a C++ library +# add_library(${PROJECT_NAME} +# src/${PROJECT_NAME}/laser_noise.cpp +# ) + +## Add cmake target dependencies of the library +## as an example, code may need to be generated before libraries +## either from message generation or dynamic reconfigure +# add_dependencies(${PROJECT_NAME} ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS}) + +## Declare a C++ executable +## With catkin_make all packages are built within a single CMake context +## The recommended prefix ensures that target names across packages don't collide +# add_executable(${PROJECT_NAME}_node src/laser_noise_node.cpp) + +## Rename C++ executable without prefix +## The above recommended prefix causes long target names, the following renames the +## target back to the shorter version for ease of user use +## e.g. "rosrun someones_pkg node" instead of "rosrun someones_pkg someones_pkg_node" +# set_target_properties(${PROJECT_NAME}_node PROPERTIES OUTPUT_NAME node PREFIX "") + +## Add cmake target dependencies of the executable +## same as for the library above +# add_dependencies(${PROJECT_NAME}_node ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS}) + +## Specify libraries to link a library or executable target against +# target_link_libraries(${PROJECT_NAME}_node +# ${catkin_LIBRARIES} +# ) + +############# +## Install ## +############# + +# all install targets should use catkin DESTINATION variables +# See http://ros.org/doc/api/catkin/html/adv_user_guide/variables.html + +## Mark executable scripts (Python etc.) for installation +## in contrast to setup.py, you can choose the destination + catkin_install_python(PROGRAMS + scripts/scan_process.py + DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} + ) + +## Mark executables for installation +## See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_executables.html +# install(TARGETS ${PROJECT_NAME}_node +# RUNTIME DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} +# ) + +## Mark libraries for installation +## See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_libraries.html +# install(TARGETS ${PROJECT_NAME} +# ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} +# LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} +# RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION} +# ) + +## Mark cpp header files for installation +# install(DIRECTORY include/${PROJECT_NAME}/ +# DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION} +# FILES_MATCHING PATTERN "*.h" +# PATTERN ".svn" EXCLUDE +# ) + +## Mark other files for installation (e.g. launch and bag files, etc.) +# install(FILES +# # myfile1 +# # myfile2 +# DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION} +# ) + +############# +## Testing ## +############# + +## Add gtest based cpp test target and link libraries +# catkin_add_gtest(${PROJECT_NAME}-test test/test_laser_noise.cpp) +# if(TARGET ${PROJECT_NAME}-test) +# target_link_libraries(${PROJECT_NAME}-test ${PROJECT_NAME}) +# endif() + +## Add folders to be run by python nosetests +# catkin_add_nosetests(test) diff --git a/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise1.png b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise1.png new file mode 100644 index 000000000..c11fa5d5c Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise1.png differ diff --git a/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise2.png b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise2.png new file mode 100644 index 000000000..a502c84ce Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise2.png differ diff --git a/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise3.png b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise3.png new file mode 100644 index 000000000..fd2b3a826 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/CNN_NAVREP_2021_01_15__23_28_with_noise3.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise1.png b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise1.png new file mode 100644 index 000000000..e296d5418 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise1.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise2.png b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise2.png new file mode 100644 index 000000000..81df94f12 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise2.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise3.png b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise3.png new file mode 100644 index 000000000..f188187c3 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Comparison_results_different_agents_with_noise3.png differ diff --git a/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise1.png b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise1.png new file mode 100644 index 000000000..2e2e2c61b Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise1.png differ diff --git a/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise2.png b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise2.png new file mode 100644 index 000000000..4e7c84e67 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise2.png differ diff --git a/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise3.png b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise3.png new file mode 100644 index 000000000..2ec2a61e2 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/DRL_LOCAL_PLANNER_2021_01_25__22_56_with_noise3.png differ diff --git a/realistic_modeling/scan_process/Results_photo/MLP_ARENA2D_2021_02_18__13_13_with_noise1.png b/realistic_modeling/scan_process/Results_photo/MLP_ARENA2D_2021_02_18__13_13_with_noise1.png new file mode 100644 index 000000000..1abe9486b Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/MLP_ARENA2D_2021_02_18__13_13_with_noise1.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_15_23_28.png b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_15_23_28.png new file mode 100644 index 000000000..7d4368890 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_15_23_28.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_19_03_20.png b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_19_03_20.png new file mode 100644 index 000000000..714e53b66 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_CNN_NAVREP+2021_01_19_03_20.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_DRL_LOCAL_PLANNER_2021_01_25_22_56.png b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_DRL_LOCAL_PLANNER_2021_01_25_22_56.png new file mode 100644 index 000000000..90aaa6678 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_model_of_DRL_LOCAL_PLANNER_2021_01_25_22_56.png differ diff --git a/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_module.png b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_module.png new file mode 100644 index 000000000..04cf62146 Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/Test_results_with_delay_module.png differ diff --git a/realistic_modeling/scan_process/Results_photo/The values of noise and delay when the success rate is around 90%.png b/realistic_modeling/scan_process/Results_photo/The values of noise and delay when the success rate is around 90%.png new file mode 100644 index 000000000..311a670ed Binary files /dev/null and b/realistic_modeling/scan_process/Results_photo/The values of noise and delay when the success rate is around 90%.png differ diff --git a/realistic_modeling/scan_process/config/noise_parameter.json b/realistic_modeling/scan_process/config/noise_parameter.json new file mode 100644 index 000000000..615036c78 --- /dev/null +++ b/realistic_modeling/scan_process/config/noise_parameter.json @@ -0,0 +1,9 @@ +{ + "max_value_of_data": "0", + "gauss_mean": "0", + "gauss_sigma": "1", + "gauss_size": "0.015", + "bias_noise": "0.1", + "offset_noise": "0.01", + "angle_noise": "0.122" +} \ No newline at end of file diff --git a/realistic_modeling/scan_process/package.xml b/realistic_modeling/scan_process/package.xml new file mode 100644 index 000000000..5fb99a0c6 --- /dev/null +++ b/realistic_modeling/scan_process/package.xml @@ -0,0 +1,68 @@ + + + scan_process + 0.0.0 + The scan_process package + + + + + chang + + + + + + TODO + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + catkin + roscpp + rospy + std_msgs + roscpp + rospy + std_msgs + roscpp + rospy + std_msgs + + + + + + + + diff --git a/realistic_modeling/scan_process/scripts/__init__.py b/realistic_modeling/scan_process/scripts/__init__.py new file mode 100644 index 000000000..e69de29bb diff --git a/realistic_modeling/scan_process/scripts/noise.py b/realistic_modeling/scan_process/scripts/noise.py new file mode 100644 index 000000000..5821ac011 --- /dev/null +++ b/realistic_modeling/scan_process/scripts/noise.py @@ -0,0 +1,174 @@ +''' + @name: noise.py + @brief: This class adds noise to the received sensor signal + @author: Chang Liu + @version: 3.7 + @date: 2020/12/14 +''' +# python relevant +import numpy as np +import csv +import random + +class Noise: + """ + This class adds noise to the received sensor data. + """ + def __init__(self, + noise_mode, + max_value_of_data = 0, + gauss_mean = 0, + gauss_sigma = 1, + gauss_size = 0.015, + bias_noise = 0.1, + offset_noise = 0.01, + angle_noise = 0.122): + # Class variables + self._noise_mode = noise_mode # Mode of noise + self._max_value_of_data = max_value_of_data # usually dont need to change,it will update itself. max value of the sensor data,prepare for standaraization. + self._gauss_mean = gauss_mean + self._gauss_sigma = gauss_sigma + self._gauss_size = gauss_size + self._bias_noise = bias_noise + self._offset_noise = offset_noise + self._angle_noise = angle_noise + + self._noise_count = -1 + + def add_noise(self,scan_msg): + #caculate the size sf msg,and create file to save data + if self._noise_count == -1: + self.__initialsing_noise(scan_msg) + scan_msg_data = np.array(scan_msg.ranges) + scan_noise_msg = 0 + if 1 in self._noise_mode: + scan_noise_msg += self.__gaussian_noise(scan_msg_data) + scan_noise_msg -= scan_msg_data + +# print("Gaussian noise has been added") + if 2 in self._noise_mode: + scan_noise_msg += self.__offset_noise(scan_msg_data) + scan_noise_msg -= scan_msg_data +# print("offset noise has been added") + if 3 in self._noise_mode: + scan_noise_msg += self.__angle_noise(scan_msg_data) + scan_noise_msg -= scan_msg_data +# print("angle noise has been added") + if 4 in self._noise_mode: + scan_noise_msg += self.__bias_noise(scan_msg_data) + scan_noise_msg -= scan_msg_data +# print("bias noise has been added") + + scan_noise_msg += scan_msg_data + self.__save_data_for_plot(scan_msg.ranges,scan_noise_msg) + return scan_noise_msg + + def __gaussian_noise(self,scan_msg): + ''' + This function is used to simulate ranging noise.It is a noise that fits a Gaussian normal distribution. + This function will generate Gaussian white noise + input : + scan_msg : Original scan data + return: + gaussian_out : Gaussian noise data + ''' + # Generate Gaussian noise + noise = np.random.normal(self._gauss_mean, self._gauss_sigma, scan_msg.shape) + noise = noise * self._gauss_size + gaussian_out = scan_msg + noise + # Set more than 1 to 1, and less than 0 to 0 + gaussian_out = np.clip(gaussian_out, 0, self._max_value_of_data) + return gaussian_out + + def __bias_noise(self,scan_msg): + ''' + This function is used to simulate Physical offsets. + This function will generate a fixed value of noise. + input : + scan_msg : Original scan data + return: + bias_out : Bias noise data + ''' + # Generate bias noise + bias_out = scan_msg + self._bias_noise + bias_out = np.clip(bias_out, 0, self._max_value_of_data) + return bias_out + + def __offset_noise(self,scan_msg): + ''' + This function is used to model the linear error,it can be simulated by Random Walk errors. + This function will generate an average random noise within a set range. + input : + scan_msg : Original scan data + return: + offset_out : offset noise data + ''' + + # Generate offset noise + for i in range(len(scan_msg)): + step = self._offset_noise if random.randint(0, 1) else -self._offset_noise + self._distance[i] += step + offset_out = scan_msg + self._distance + offset_out= np.clip(offset_out, 0, self._max_value_of_data) + return offset_out + + def __angle_noise(self,scan_msg): + ''' + This function is used to model to simulate angular errors, which are made up of mechanical horizontal and vertical errors. + This function will generate Gaussian white noise + input : + scan_msg : Original scan data + return: + bias_out : angle noise data + ''' + # standardization + angle_noise = [0] * len(scan_msg) + # Generate angle noise + for i in range(len(scan_msg)): + noise = np.random.normal(0, 1) *scan_msg[i] * self._angle_noise*0.01 + angle_noise[i] = scan_msg[i] + noise + angle_noise[i] = np.clip(angle_noise[i], 0, self._max_value_of_data) + return angle_noise + + def __save_data_for_plot(self,scan_msg,scan_noise_msg): + ''' + This function is used to save the original and noise data,then programmer can use these to analyse + input : + scan_msg : the original scan data + scan_noise_msg : the noise scan data + return: + + ''' + self._list_for_noise[self._noise_count] = scan_noise_msg + self._list_for_original[self._noise_count] = scan_msg + + if self._noise_count % 50 == 0: + with open(self._Original_data_address,'w',newline='') as Original_data: + Original_writer = csv.writer(Original_data) + Original_writer.writerows(self._list_for_original) + Original_data.close() + + with open(self._Noise_data_address,'w',newline='') as Noise_data: + Noise_writer = csv.writer(Noise_data) + Noise_writer.writerows(self._list_for_noise) + Noise_data.close() + + self._noise_count = (self._noise_count+1) % 300 + + def __initialsing_noise(self,scan_msg): + self._max_value_of_data = scan_msg.range_max + self._noise_count += 1 + self._Original_data_address = 'Original_data_for_plot.csv' + self._Noise_data_address = 'Noise_data_for_plot.csv' + self.__initialising_csv_files() + + self._list_for_original = [([0] * len(scan_msg.ranges)) for _ in range(300)] + self._list_for_noise = [([0] * len(scan_msg.ranges)) for _ in range(300)] + + self._distance = [0] * len(scan_msg.ranges) #initial the error for the offset_noise + + def __initialising_csv_files(self): + with open(self._Original_data_address,'w') as Original_data: + Original_data.close() + with open(self._Noise_data_address,'w') as Noise_data: + Noise_data.close() diff --git a/realistic_modeling/scan_process/scripts/noise.pyc b/realistic_modeling/scan_process/scripts/noise.pyc new file mode 100644 index 000000000..712c6090a Binary files /dev/null and b/realistic_modeling/scan_process/scripts/noise.pyc differ diff --git a/realistic_modeling/scan_process/scripts/scan_process.py b/realistic_modeling/scan_process/scripts/scan_process.py new file mode 100644 index 000000000..771c41bf8 --- /dev/null +++ b/realistic_modeling/scan_process/scripts/scan_process.py @@ -0,0 +1,135 @@ +#!/usr/bin/env python +''' + @name: scan_process.py + @brief: This class accepts, processes and sends laser sensor information. + @author: Chang Liu Ke Wang Shaungrui Liu Jiajing Jiang + @version: 3.7 + @date: 2021/2/10 +''' + +## sensor data processing that listens to sensor_msgs/LaserScan published to the 'scan' topic + +import rospy +import json +import os +import collections + +# observation msgs +from sensor_msgs.msg import LaserScan + +#helper python +from noise import Noise + + +class Scan_process(): + + def __init__(self, noise_model,timedelay): + + self._noise_model = self._identify_noise_model(noise_model) + self._lst = collections.deque() #the storage "cache" for the data with noise + self._time_delay = timedelay #the delay in the data transfering + + self.noise_parameter_address =os.path.join( os.path.abspath(os.path.dirname(os.path.abspath(__file__)) + os.path.sep + ".."),'config/noise_parameter.json') + if 0 not in self._noise_model: + self._setup_by_configuration(self.noise_parameter_address) + self.Noise_Generation = Noise(noise_mode = self._noise_model, + gauss_mean = self._gauss_mean, + gauss_sigma = self._gauss_sigma, + gauss_size = self._gauss_size, + bias_noise = self._bias_noise, + offset_noise = self._offset_noise , + angle_noise = self._angle_noise) + + def _add_noise_and_publish(self,data): + ''' + This function adds noise to the incoming sensor information + ''' + if 0 not in self._noise_model: + data.ranges = self.Noise_Generation.add_noise(data) + + self._add_delay_and_publish(data) + + def _add_delay_and_publish(self,data): + ''' + This function adds delay to the incoming sensor information and then publishes + ''' + pub = rospy.Publisher('scan', LaserScan) +# self._change_timedelay() + if self._time_delay != 1: + self._lst.append(data) + if len(self._lst) == self._time_delay: + pub.publish(self._lst.popleft()) # creat publisher ,add time dalay to the publisher,every time the publisher publish the msgs, when there are 10 data in cache creat + else: + pub.publish(data) + + def _listener(self): + ''' + This function receives the data from the original scan sensor + ''' + rospy.Subscriber('scan_original', LaserScan, self._add_noise_and_publish) + rospy.spin() #simply keeps python from exiting until this node is stopped + + def _identify_noise_model(self,noise_model): + ''' + This function defines the type of noise + input : + noise_model : noise model + noise_model contains 0 means without noise + noise_model contains 1 means with gaussian noise + noise_model contains 2 means with offset noise + noise_model contains 3 means with angle noise + noise_model contains 4 means with bias noise + it can contain several different noises at the same time + ''' + ans = [] + if isinstance(noise_model,int): + if noise_model == 0: + ans.append(0) + while noise_model != 0: + ans.append(noise_model % 10) + noise_model = noise_model // 10 + elif isinstance(noise_model,str): #identify the noise_model is str + pass + + return ans + + def _setup_by_configuration(self, noise_parameter_json_path): + ''' + This function Read the noise parameter from the json file + ''' + with open(noise_parameter_json_path, 'r',encoding = 'utf-8_sig') as f: + lines = [] + for row in f.readlines(): + if row.strip().startswith("//"): + continue + lines.append(row) + d = json.loads("\n".join(lines)) + self._max_value_of_data = float(d['max_value_of_data']) + self._gauss_mean = float(d['gauss_mean']) + self._gauss_sigma = float(d['gauss_sigma']) + self._gauss_size = float(d['gauss_size']) + self._bias_noise = float(d['bias_noise']) + self._offset_noise = float(d['offset_noise']) + self._angle_noise = float(d['angle_noise']) + f.close() + + def _change_timedelay(self): + with open("/home/chang/catkin_ws/src/arena-rosnav/arena_navigation/arena_local_planner/learning_based/arena_local_planner_drl/delay_parameter",'r') as delay_data: + + self._time_delay = int(delay_data.read()) + print(self._time_delay) + delay_data.close() + + +if __name__ == '__main__': + + rospy.init_node('noise', anonymous = False) + noise_model = rospy.get_param('noise_mode') + timedelay = rospy.get_param('delay') + Scan_process = Scan_process(noise_model = noise_model,timedelay = timedelay) +# Scan_process = Scan_process() + + while not rospy.is_shutdown(): + Scan_process._listener() + +