-
Notifications
You must be signed in to change notification settings - Fork 11
/
Copy pathrun_simulation_experiments.py
76 lines (66 loc) · 3.32 KB
/
run_simulation_experiments.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
import os
import numpy as np
import subprocess
sequences = sorted([f for f in os.listdir("/workspace/raid/krb/boreas/robotica_sims")])
N = len(sequences)
for seq in sequences:
print(seq)
print("RUNNING DISCRETELIO...")
# DiscreteLIO
for i, seq in enumerate(sequences):
print(f"SEQUENCE: {seq} ({i + 1} / {N})")
arg = "ros2 run steam_icp steam_icp --ros-args --params-file /home/krb/Documents/steam_icp/steam_icp/config/boreas_simulation_discretelio_config.yaml"
arg += " -p dataset_options.root_path:=/workspace/raid/krb/boreas/robotica_sims"
arg += f" -p dataset_options.sequence:={seq}"
print(arg)
p = subprocess.Popen(arg.split(), stdout=None)
p.wait()
print(p.returncode)
print("RUNNING SINGERLIO...")
# SingerLIO
for i, seq in enumerate(sequences):
print(f"SEQUENCE: {seq} ({i + 1} / {N})")
arg = "ros2 run steam_icp steam_icp --ros-args --params-file /home/krb/Documents/steam_icp/steam_icp/config/boreas_simulation_steamlio_config.yaml"
arg += " -p output_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlio"
arg += " -p log_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlio"
arg += " -p odometry_options.debug_path:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlio"
arg += " -p dataset_options.root_path:=/workspace/raid/krb/boreas/robotica_sims"
arg += f" -p dataset_options.sequence:={seq}"
arg += " -p odometry_options.steam.use_imu:=true"
arg += " -p odometry_options.steam.use_accel:=true"
print(arg)
p = subprocess.Popen(arg.split(), stdout=None)
p.wait()
print(p.returncode)
print("RUNNING SINGERLOG...")
# SingerLOG
for i, seq in enumerate(sequences):
print(f"SEQUENCE: {seq} ({i + 1} / {N})")
arg = "ros2 run steam_icp steam_icp --ros-args --params-file /home/krb/Documents/steam_icp/steam_icp/config/boreas_simulation_steamlio_config.yaml"
arg += " -p output_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlog"
arg += " -p log_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlog"
arg += " -p odometry_options.debug_path:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlog"
arg += " -p dataset_options.root_path:=/workspace/raid/krb/boreas/robotica_sims"
arg += f" -p dataset_options.sequence:={seq}"
arg += " -p odometry_options.steam.use_imu:=true"
arg += " -p odometry_options.steam.use_accel:=false"
print(arg)
p = subprocess.Popen(arg.split(), stdout=None)
p.wait()
print(p.returncode)
print("RUNNING SINGERLO...")
# SingerLO
for i, seq in enumerate(sequences):
print(f"SEQUENCE: {seq} ({i + 1} / {N})")
arg = "ros2 run steam_icp steam_icp --ros-args --params-file /home/krb/Documents/steam_icp/steam_icp/config/boreas_simulation_steamlio_config.yaml"
arg += " -p output_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlo"
arg += " -p log_dir:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlo"
arg += " -p odometry_options.debug_path:=/home/krb/ASRL/temp/steam_icp/boreas_velodyne/singerlo"
arg += " -p dataset_options.root_path:=/workspace/raid/krb/boreas/robotica_sims"
arg += f" -p dataset_options.sequence:={seq}"
arg += " -p odometry_options.steam.use_imu:=false"
arg += " -p odometry_options.steam.use_accel:=false"
print(arg)
p = subprocess.Popen(arg.split(), stdout=None)
p.wait()
print(p.returncode)