fixed bug: advertise unsupported streams. (IntelRealSense#811)

* fixed bug: advertise unsupported streams. * constraints on accel_up test - loosen up a bit to compensate for different in frames arriving from file.
damien-petit · Jul 4, 2019 · 387f12b · 387f12b
1 parent c1010ab
commit 387f12b
Show file tree

Hide file tree

Showing 2 changed files with 3 additions and 2 deletions.
diff --git a/realsense2_camera/scripts/rs2_test.py b/realsense2_camera/scripts/rs2_test.py
@@ -39,7 +39,7 @@ def AccelGetData(rec_filename):
 def AccelGetDataDeviceStandStraight(rec_filename):
     gt_data = AccelGetData(rec_filename)
     gt_data['ros_value'] = np.array([0.63839424, 0.05380408, 9.85343552])
-    gt_data['ros_max_diff'] = np.array([1.97013582e-02, 4.65862500e-09, 2.06165277e-02])
+    gt_data['ros_max_diff'] = np.array([1.97013582e-02, 4.65862500e-09, 4.06165277e-02])
     return gt_data
 
 def ImuTest(data, gt_data):

diff --git a/realsense2_camera/src/base_realsense_node.cpp b/realsense2_camera/src/base_realsense_node.cpp
@@ -170,6 +170,7 @@ void BaseRealSenseNode::publishTopics()
     getParameters();
     setupDevice();
     setupErrorCallback();
+    enable_devices();
     setupPublishers();
     setupStreams();
     setupFilters();
@@ -866,6 +867,7 @@ void BaseRealSenseNode::enable_devices()
                     if (profile.stream_type() != elem.first) continue;
                     ROS_WARN_STREAM("fps: " << profile.fps() << ". format: " << profile.format());
                 }
+                _enable[elem] = false;
             }
         }
     }
@@ -1550,7 +1552,6 @@ void BaseRealSenseNode::setBaseTime(double frame_time, bool warn_no_metadata)
 void BaseRealSenseNode::setupStreams()
 {
 	ROS_INFO("setupStreams...");
-	enable_devices();
     try{
 		// Publish image stream info
         for (auto& profiles : _enabled_profiles)