@@ -76,9 +76,9 @@ constexpr sensor_t kInvalidSensorId =
76
76
// the reference frame since it is metric.
77
77
// 2) Not having a reference frame brings a 6 DoF Gauge for each rig, which is
78
78
// not ideal particularly when it comes to covariance estimation.
79
- class RigCalibration {
79
+ class RigCalib {
80
80
public:
81
- RigCalibration () = default ;
81
+ RigCalib () = default ;
82
82
83
83
// Access the unique identifier of the rig
84
84
inline rig_t RigId () const ;
@@ -130,28 +130,28 @@ class RigCalibration {
130
130
// Implementation
131
131
// //////////////////////////////////////////////////////////////////////////////
132
132
133
- rig_t RigCalibration ::RigId () const { return rig_id_; }
133
+ rig_t RigCalib ::RigId () const { return rig_id_; }
134
134
135
- void RigCalibration ::SetRigId (rig_t rig_id) { rig_id_ = rig_id; }
135
+ void RigCalib ::SetRigId (rig_t rig_id) { rig_id_ = rig_id; }
136
136
137
- bool RigCalibration ::HasSensor (sensor_t sensor_id) const {
137
+ bool RigCalib ::HasSensor (sensor_t sensor_id) const {
138
138
return sensor_id == ref_sensor_id_ ||
139
139
sensors_from_rig_.find (sensor_id) != sensors_from_rig_.end ();
140
140
}
141
141
142
- size_t RigCalibration ::NumSensors () const {
142
+ size_t RigCalib ::NumSensors () const {
143
143
size_t n_sensors = sensors_from_rig_.size ();
144
144
if (ref_sensor_id_ != kInvalidSensorId ) n_sensors += 1 ;
145
145
return n_sensors;
146
146
}
147
147
148
- sensor_t RigCalibration ::RefSensorId () const { return ref_sensor_id_; }
148
+ sensor_t RigCalib ::RefSensorId () const { return ref_sensor_id_; }
149
149
150
- bool RigCalibration ::IsRefSensor (sensor_t sensor_id) const {
150
+ bool RigCalib ::IsRefSensor (sensor_t sensor_id) const {
151
151
return sensor_id == ref_sensor_id_;
152
152
}
153
153
154
- Rigid3d& RigCalibration ::SensorFromRig (sensor_t sensor_id) {
154
+ Rigid3d& RigCalib ::SensorFromRig (sensor_t sensor_id) {
155
155
THROW_CHECK (!IsRefSensor (sensor_id))
156
156
<< " No reference is available for the SensorFromRig transformation of "
157
157
" the reference sensor, which is identity" ;
@@ -165,7 +165,7 @@ Rigid3d& RigCalibration::SensorFromRig(sensor_t sensor_id) {
165
165
return *sensors_from_rig_.at (sensor_id);
166
166
}
167
167
168
- const Rigid3d& RigCalibration ::SensorFromRig (sensor_t sensor_id) const {
168
+ const Rigid3d& RigCalib ::SensorFromRig (sensor_t sensor_id) const {
169
169
THROW_CHECK (!IsRefSensor (sensor_id))
170
170
<< " No reference is available for the SensorFromRig transformation of "
171
171
" the reference sensor, which is identity" ;
@@ -179,7 +179,7 @@ const Rigid3d& RigCalibration::SensorFromRig(sensor_t sensor_id) const {
179
179
return *sensors_from_rig_.at (sensor_id);
180
180
}
181
181
182
- std::optional<Rigid3d>& RigCalibration ::MaybeSensorFromRig (sensor_t sensor_id) {
182
+ std::optional<Rigid3d>& RigCalib ::MaybeSensorFromRig (sensor_t sensor_id) {
183
183
THROW_CHECK (!IsRefSensor (sensor_id))
184
184
<< " No reference is available for the SensorFromRig transformation of "
185
185
" the reference sensor, which is identity" ;
@@ -191,7 +191,7 @@ std::optional<Rigid3d>& RigCalibration::MaybeSensorFromRig(sensor_t sensor_id) {
191
191
return sensors_from_rig_.at (sensor_id);
192
192
}
193
193
194
- const std::optional<Rigid3d>& RigCalibration ::MaybeSensorFromRig (
194
+ const std::optional<Rigid3d>& RigCalib ::MaybeSensorFromRig (
195
195
sensor_t sensor_id) const {
196
196
THROW_CHECK (!IsRefSensor (sensor_id))
197
197
<< " No reference is available for the SensorFromRig transformation of "
@@ -204,8 +204,8 @@ const std::optional<Rigid3d>& RigCalibration::MaybeSensorFromRig(
204
204
return sensors_from_rig_.at (sensor_id);
205
205
}
206
206
207
- void RigCalibration ::SetSensorFromRig (sensor_t sensor_id,
208
- const Rigid3d& sensor_from_rig) {
207
+ void RigCalib ::SetSensorFromRig (sensor_t sensor_id,
208
+ const Rigid3d& sensor_from_rig) {
209
209
THROW_CHECK (!IsRefSensor (sensor_id))
210
210
<< " Cannot set the SensorFromRig transformation of the reference sensor, "
211
211
" which is fixed to identity" ;
@@ -217,8 +217,8 @@ void RigCalibration::SetSensorFromRig(sensor_t sensor_id,
217
217
sensors_from_rig_.at (sensor_id) = sensor_from_rig;
218
218
}
219
219
220
- void RigCalibration ::SetSensorFromRig (
221
- sensor_t sensor_id, const std::optional<Rigid3d>& sensor_from_rig) {
220
+ void RigCalib ::SetSensorFromRig (sensor_t sensor_id,
221
+ const std::optional<Rigid3d>& sensor_from_rig) {
222
222
THROW_CHECK (!IsRefSensor (sensor_id))
223
223
<< " Cannot set the SensorFromRig transformation of the reference sensor, "
224
224
" which is fixed to identity" ;
@@ -230,7 +230,7 @@ void RigCalibration::SetSensorFromRig(
230
230
sensors_from_rig_.at (sensor_id) = sensor_from_rig;
231
231
}
232
232
233
- bool RigCalibration ::HasSensorFromRig (sensor_t sensor_id) const {
233
+ bool RigCalib ::HasSensorFromRig (sensor_t sensor_id) const {
234
234
if (IsRefSensor (sensor_id))
235
235
return true ; // SensorFromRig for the reference sensor is always identity
236
236
if (sensors_from_rig_.find (sensor_id) == sensors_from_rig_.end ())
@@ -241,7 +241,7 @@ bool RigCalibration::HasSensorFromRig(sensor_t sensor_id) const {
241
241
return sensors_from_rig_.at (sensor_id).has_value ();
242
242
}
243
243
244
- void RigCalibration ::ResetSensorFromRig (sensor_t sensor_id) {
244
+ void RigCalib ::ResetSensorFromRig (sensor_t sensor_id) {
245
245
THROW_CHECK (!IsRefSensor (sensor_id))
246
246
<< " Cannot reset the SensorFromRig transformation of the reference "
247
247
" sensor, "
0 commit comments