| 38 | } |
| 39 | |
| 40 | void Rig::AddSensor(sensor_t sensor_id, |
| 41 | const std::optional<Rigid3d>& sensor_from_rig) { |
| 42 | THROW_CHECK_GE(NumSensors(), 1) |
| 43 | << "The reference sensor needs to be added first before other sensors."; |
| 44 | THROW_CHECK(!HasSensor(sensor_id)) |
| 45 | << "Sensor (" << sensor_id.type << ", " << sensor_id.id |
| 46 | << ") is inserted twice into the rig"; |
| 47 | sensors_from_rig_.emplace(sensor_id, sensor_from_rig); |
| 48 | } |
| 49 | |
| 50 | std::ostream& operator<<(std::ostream& stream, const Rig& rig) { |
| 51 | const std::string rig_id_str = |
no outgoing calls