comment start&& stop IMU

This commit is contained in:
Joe Dong
2023-05-08 17:52:57 +08:00
parent bca846a464
commit dc45022290
+9 -9
View File
@@ -470,15 +470,15 @@ void OBCameraNode::setupPublishers() {
topic, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(camera_info_qos_profile),
camera_info_qos_profile));
}
for (const auto& stream_index : HID_STREAMS) {
if (!enable_stream_[stream_index]) {
continue;
}
std::string data_topic_name = stream_name_[stream_index] + "/sample";
auto data_qos = getRMWQosProfileFromString(imu_qos_[stream_index]);
imu_publishers_[stream_index] = node_->create_publisher<sensor_msgs::msg::Imu>(
data_topic_name, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(data_qos), data_qos));
}
// for (const auto& stream_index : HID_STREAMS) {
// if (!enable_stream_[stream_index]) {
// continue;
// }
// std::string data_topic_name = stream_name_[stream_index] + "/sample";
// auto data_qos = getRMWQosProfileFromString(imu_qos_[stream_index]);
// imu_publishers_[stream_index] = node_->create_publisher<sensor_msgs::msg::Imu>(
// data_topic_name, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(data_qos), data_qos));
// }
if (enable_publish_extrinsic_) {
extrinsics_publisher_ = node_->create_publisher<orbbec_camera_msgs::msg::Extrinsics>(
"extrinsic/depth_to_color", rclcpp::QoS{1}.transient_local());