-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathexample.yaml
215 lines (200 loc) · 13 KB
/
example.yaml
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
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
/EkfCalNode:
ros__parameters:
debug_log_level: 2 # Debug_Log_Level:
# 1: FATAL
# 2: ERROR
# 3: WARN
# 4: INFO
# 5: DEBUG
data_logging_on: true # Flag to enable data logging
data_log_rate: 10.0 # EKF body data logging rate
augmenting_type: 0 # Camera state augmentation type
# 0: All camera frames are augmented
# 1: Only the primary camera frames are augmented
# 2: Time-based frame augmentation
# 3: Linear Error-based frame augmentation
augmenting_delta_time: 0.0 # Maximum time between augments
augmenting_pos_error: 0.1 # Maximum position error between augments
augmenting_ang_error: 0.1 # Maximum angular error between augments
process_noise:
pos: 1.0e-0 # Position process noise
vel: 1.0e-1 # Velocity process noise
ang_pos: 1.0e-0 # Angular Position process noise
pos_l_in_g: [0.0, 0.0, 0.0] # Local frame position in global frame
ang_l_to_g: 0.0 # Local frame heading in global frame
gps_init_type: 0 # GPS Initialization Type
# 0: CONSTANT
# 1: BASELINE_DIST
# 2: ERROR_THRESHOLD
gps_init_baseline_dist: 100.0 # Baseline distance threshold to initialize
gps_init_pos_thresh: 1.0 # Local frame position error threshold
gps_init_ang_thresh: 0.1 # Local frame heading error threshold
use_root_covariance: true # Flag to utilize the square root form of covariance
sim_params:
seed: 1.0 # Seed to provide to random number generator
max_time: 10.0 # Maximum simulation time
number_of_runs: 10 # Number of runs for Multi-Threaded Simulation
run_number: 0 # Start run number (also used to initialize seed)
stationary_time: 0.1 # Time to be stationary before motion begins
truth_type: "cyclic" # TruthType:
# "cyclic"
# "spline"
# Cyclic Truth Parameters
pos_frequency: [0.3, 0.5, 0.7] # Cyclic position frequencies
ang_frequency: [0.2, 0.3, 0.4] # Cyclic angular frequencies
pos_offset: [0.0, 0.0, 0.0] # Position offset for cyclic position
ang_offset: [0.0, 0.0, 0.0] # Position offset for cyclic position
ang_amplitude: 0.1 # Amplitude of translational motion
pos_amplitude: 1.0 # Amplitude of rotational motion
pos_b_in_l_error: [0.5, 0.5, 0.5] # Initial body position error
ang_b_to_l_error: [0.3, 0.3, 0.3] # Initial body angular error
# Spline Truth Parameters:
positions: # A list of translational vectors
- [0.0, 0.0, 0.0]
- [0.1, 0.1, 0.1]
- [-0.1, -0.1, -0.1]
- [0.0, 0.0, 0.0]
angles: # A list of rotational vectors
- [0.00, 0.00, 0.00]
- [0.01, 0.01, 0.01]
- [0.00, 0.00, 0.00]
pos_errors: [1.0, 1.0, 1.0] # Error in achieving translational vectors
ang_errors: [0.1, 0.1, 0.1] # Error in achieving rotational vectors
pos_l_in_g_error: [1.0, 1.0, 1.0] # Local frame position error
ang_l_to_g_error: 0.1 # Local frame heading error
imu_list: # List of imu. Can be empty but list must exist
- "imu_1"
camera_list: # List of camera. Can be empty but list must exist
- "cam_1"
tracker_list: # List of tracker. Can be empty but list must exist
- "orb"
fiducial_list: # List of fiducial. Can be empty but list must exist
- "charuco"
gps_list: # List of gps. Can be empty but list must exist
- "gps_1"
imu:
imu_1:
is_extrinsic: false # Flag to calibrate IMU extrinsics
is_intrinsic: false # Flag to calibrate IMU intrinsics
rate: 1000.0 # Measurement update rate
topic: "/imu_1" # ROS topic to subscribe to
variance: [
0.01, 0.01, 0.01, # Position
0.01, 0.01, 0.01, # Orientation
0.01, 0.01, 0.01, # Accelerometer bias
0.01, 0.01, 0.01 # Gyroscope bias
]
pos_i_in_b: [0.0, 0.0, 0.0] # Initial position offset estimate
ang_i_to_b: [1.0, 0.0, 0.0, 0.0] # Initial angular offset estimate
acc_bias: [0.0, 0.0, 0.0] # Initial accelerometer bias estimate
omg_bias: [0.0, 0.0, 0.0] # Initial gyroscope bias estimate
pos_stability: 1.0e-2 # Position stability
ang_stability: 1.0e-2 # Orientation stability
acc_bias_stability: 1.0e-3 # Accelerometer bias stability
omg_bias_stability: 1.0e-3 # Gyroscope bias stability
sim_params:
no_errors: false # Flag to disable errors in simulation
time_bias_error: 1.0e-3 # Measurement time bias
time_error: 1.0e-6 # Measurement time error
pos_error: [0.0, 0.0, 0.0] # Error in position estimate
ang_error: [0.0, 0.0, 0.0] # Error in orientation estimate
acc_error: [1.0e-3, 1.0e-3, 1.0e-3] # Accelerometer error
omg_error: [1.0e-2, 1.0e-2, 1.0e-2] # Gyroscope error
acc_bias_error: [0.0, 0.0, 0.0] # Accelerometer bias error
omg_bias_error: [0.0, 0.0, 0.0] # Gyroscope bias error
camera:
cam_1:
rate: 20.0 # Sensor Rate
topic: "/cam_1" # ROS topic
pos_c_in_b: [0.0, 0.0, 0.0] # Position in body frame
ang_c_to_b: [-0.5, 0.5, -0.5, 0.5] # Orientation in body frame
variance: [
0.1, 0.1, 0.1, # Position
0.1, 0.1, 0.1 # Orientation
]
tracker: "orb" # Tracker to use
fiducial: "charuco" # Fiducial to use
pos_stability: 1.0e-9 # Position stability
ang_stability: 1.0e-9 # Orientation stability
intrinsics:
f_x: 0.01 # X focal length [m]
f_y: 0.01 # Y focal length [m]
k_1: 0.0 # Radial coefficient 1
k_2: 0.0 # Radial coefficient 2
p_1: 0.0 # Tangential coefficient 1
p_2: 0.0 # Tangential coefficient 1
pixel_size: 5.0e-6 # Pixel size
width: 1920 # Image width
height: 1080 # Image height
is_extrinsic: false # Flag to calibrate camera extrinsics
sim_params:
no_errors: false # Flag to disable errors in simulation
time_bias_error: 1.0e-3 # Measurement time bias error
time_error: 1.0e-6 # Measurement time error
pos_error: [0.0, 0.0, 0.0] # Position error
ang_error: [0.0, 0.0, 0.0] # Orientation error
tracker:
orb:
feature_detector: 2 # Feature Detector:
# 0: BRISK
# 1: FAST,
# 2: GFTT,
# 3: MSER,
# 4: ORB,
# 5: SIFT,
descriptor_extractor: 1 # Descriptor Extractor:
# 0: ORB
# 1: SIFT
descriptor_matcher: 0 # DescriptorMatcher:
# 0: BRUTE_FORCE
# 1: FLANN
detector_threshold: 10.0 # Threshold used for detection (if available)
pixel_error: 0.5 # Average pixel error
min_feature_distance: 1.0 # Minimum feature distance to consider
min_track_length: 2 # Minimum track length
max_track_length: 20 # Maximum track length
data_log_rate: 10.0 # Tracker data logging rate
sim_params:
no_errors: false # Flag to disable errors in simulation
feature_count: 500 # Total number of trackable features
room_size: 5.0 # Maximum distance of features
fiducial:
charuco:
fiducial_type: 1 # fiducial_type:
# 0: ARUCO_BOARD
# 1: CHARUCO_BOARD
squares_x: 5 # Board squares in x
squares_y: 7 # Board squares in y
square_length: 0.04 # Square length
marker_length: 0.02 # Marker length
id: 0 # Initial marker ID
pos_f_in_l: [5.0, 0.0, 0.0] # Board position in local frame
ang_f_to_l: [1.0, 0.0, 0.0, 0.0] # Board orientation in local frame
variance: [
0.1, 0.1, 0.1, # Position
0.1, 0.1, 0.1 # Orientation
]
min_track_length: 0 # Minimum track length
max_track_length: 1 # Maximum track length
is_extrinsic: false # Flag to calibrate fiducial extrinsics
data_log_rate: 10.0 # Fiducial data logging rate
sim_params:
no_errors: false # Flag to disable errors in simulation
pos_error: [0.0, 0.0, 0.0] # Position error
ang_error: [0.0, 0.0, 0.0] # Orientation error
t_vec_error: [1.0e-2, 1.0e-2, 1.0e-2] # Translation measurement error
r_vec_error: [1.0e-2, 1.0e-2, 1.0e-2] # Rotation measurement error
gps:
gps_1:
rate: 5.0 # Sensor Rate
topic: "/gps_1" # ROS topic
pos_a_in_b: [0.0, 0, 0] # Antenna position in body frame
variance: [5.0, 5.0, 5.0] # Antenna position variance
data_log_rate: 5.0 # Data log rate
is_extrinsic: false # Flag to calibrate GPS extrinsics
sim_params:
no_errors: false # Flag to disable errors in simulation
time_bias_error: 0.0 # Time bias error
time_error: 1.0e-9 # Measurement time error
lla_error: [5.0, 5.0, 5.0] # LLA measurement error
pos_a_in_b_err: [0.0, 0.0, 0.0] # Antenna position error