22
33namespace infinite_sense {
44
5+ std::map<TriggerDevice, std::string> device_map_topics{
6+ {IMU_1, " imu_1_trigger" },
7+ {IMU_2, " imu_2_trigger" },
8+ {CAM_1, " cam_1_trigger" },
9+ {CAM_2, " cam_2_trigger" },
10+ {CAM_3, " cam_3_trigger" },
11+ {CAM_4, " cam_4_trigger" },
12+ {LASER, " laser_trigger" },
13+ {GPS, " gps_trigger" }};
14+
515TriggerManger::TriggerManger () {
616 uint64_t time = std::numeric_limits<uint64_t >::max ();
717 const std::tuple<bool , uint64_t > empty = std::tuple (0 , time);
@@ -47,9 +57,9 @@ void TriggerManger::PublishDeviceStatus(const TriggerDevice dev, const uint64_t
4757 uint64_t timestamp;
4858 bool status;
4959 } dev_data{time, status};
50- Messenger::GetInstance ().PubStruct (device_topics [dev], &dev_data, sizeof (DeviceStatus));
60+ Messenger::GetInstance ().PubStruct (device_map_topics [dev], &dev_data, sizeof (DeviceStatus));
5161 } catch (const std::exception& e) {
52- LOG (ERROR) << " Failed to publish " << device_topics [dev] << " status: " << e.what ();
62+ LOG (ERROR) << " Failed to publish " << device_map_topics [dev] << " status: " << e.what ();
5363 }
5464}
5565} // namespace infinite_sense
0 commit comments