i/OrbbecSDK_ROS2
1
0
Fork 0
mirror of https://github.com/orbbec/OrbbecSDK_ROS2.git synced 2026-10-13 07:49:49 +08:00
Code Issues Packages Projects Releases Wiki Activity

uncomment IMU code

Browse Source
This commit is contained in:
Joe Dong
2023-07-06 15:58:53 +08:00
parent 450d1c4da2
commit 0f74de9158
1 changed files with 10 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
orbbec_camera/src/ob_camera_node.cpp
+10 -9
View File
@@ -298,6 +298,7 @@ void OBCameraNode::stopIMU() {
for (const auto& stream_index : HID_STREAMS) { for (const auto& stream_index : HID_STREAMS) {
if (imu_started_[stream_index]) { if (imu_started_[stream_index]) {
CHECK(sensors_.count(stream_index)); CHECK(sensors_.count(stream_index));
RCLCPP_INFO_STREAM(logger_, "stop " << stream_name_[stream_index] << " stream");
sensors_[stream_index]->stop(); sensors_[stream_index]->stop();
imu_started_[stream_index] = false; imu_started_[stream_index] = false;
} }
@@ -473,15 +474,15 @@ void OBCameraNode::setupPublishers() {
topic, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(camera_info_qos_profile), topic, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(camera_info_qos_profile),
camera_info_qos_profile)); camera_info_qos_profile));
} }
// for (const auto& stream_index : HID_STREAMS) { for (const auto& stream_index : HID_STREAMS) {
// if (!enable_stream_[stream_index]) { if (!enable_stream_[stream_index]) {
// continue; continue;
// } }
// std::string data_topic_name = stream_name_[stream_index] + "/sample"; std::string data_topic_name = stream_name_[stream_index] + "/sample";
// auto data_qos = getRMWQosProfileFromString(imu_qos_[stream_index]); auto data_qos = getRMWQosProfileFromString(imu_qos_[stream_index]);
// imu_publishers_[stream_index] = node_->create_publisher<sensor_msgs::msg::Imu>( imu_publishers_[stream_index] = node_->create_publisher<sensor_msgs::msg::Imu>(
// data_topic_name, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(data_qos), data_qos)); data_topic_name, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(data_qos), data_qos));
// } }
if (enable_publish_extrinsic_) { if (enable_publish_extrinsic_) {
extrinsics_publisher_ = node_->create_publisher<orbbec_camera_msgs::msg::Extrinsics>( extrinsics_publisher_ = node_->create_publisher<orbbec_camera_msgs::msg::Extrinsics>(
"extrinsic/depth_to_color", rclcpp::QoS{1}.transient_local()); "extrinsic/depth_to_color", rclcpp::QoS{1}.transient_local());