diff --git a/orbbec_camera/src/ob_camera_node.cpp b/orbbec_camera/src/ob_camera_node.cpp index 26aa5ba1..b596df78 100644 --- a/orbbec_camera/src/ob_camera_node.cpp +++ b/orbbec_camera/src/ob_camera_node.cpp @@ -2169,7 +2169,7 @@ void OBCameraNode::onNewFrameCallback(const std::shared_ptr &frame, if (interleave_skip_color_index_ % 2 == 0) { return; } - updateStreamInfo(frame, color_stream_info_); + // updateStreamInfo(frame, color_stream_info_); } video_frame = frame->as(); } else if (frame->getType() == OB_FRAME_DEPTH) { @@ -2187,27 +2187,28 @@ void OBCameraNode::onNewFrameCallback(const std::shared_ptr &frame, if (interleave_frame_enable_ && interleave_skip_enable_) { if (video_frame->getMetadataValue(OB_FRAME_METADATA_TYPE_LASER_POWER_MODE) != interleave_skip_index_) { + return; + } else { if (frame->getType() == OB_FRAME_IR_LEFT) { if ((getFrameTimestampUs(frame) - left_last_time) > 37000) { - RCLCPP_INFO_STREAM(logger_, + RCLCPP_WARN_STREAM(logger_, "left this FrameTimestampUs: " << (getFrameTimestampUs(frame))); - RCLCPP_INFO_STREAM(logger_, "left last FrameTimestampUs: " << (left_last_time)); - RCLCPP_INFO_STREAM(logger_, "left-between current and previous fram " + RCLCPP_WARN_STREAM(logger_, "left last FrameTimestampUs: " << (left_last_time)); + RCLCPP_WARN_STREAM(logger_, "left-between current and previous fram " << (getFrameTimestampUs(frame) - left_last_time)); } left_last_time = getFrameTimestampUs(frame); } if (frame->getType() == OB_FRAME_IR_RIGHT) { if ((getFrameTimestampUs(frame) - right_last_time) > 37000) { - RCLCPP_INFO_STREAM(logger_, + RCLCPP_WARN_STREAM(logger_, "right this FrameTimestampUs: " << (getFrameTimestampUs(frame))); - RCLCPP_INFO_STREAM(logger_, "right last FrameTimestampUs: " << (right_last_time)); - RCLCPP_INFO_STREAM(logger_, "right-between current and previous fram " + RCLCPP_WARN_STREAM(logger_, "right last FrameTimestampUs: " << (right_last_time)); + RCLCPP_WARN_STREAM(logger_, "right-between current and previous fram " << (getFrameTimestampUs(frame) - right_last_time)); } right_last_time = getFrameTimestampUs(frame); } - return; } } } else {