mirror of
https://github.com/orbbec/OrbbecSDK_ROS2.git
synced 2026-10-04 03:57:46 +08:00
feat: Added Gemini 435Le color stream MJPG format metadata information
This commit is contained in:
@@ -134,5 +134,6 @@ const int32_t CUSTOM_ADVANTECH_GEMINI_336_PID = 0x0816; // Custom Advantech Ge
|
||||
const int32_t CUSTOM_ADVANTECH_GEMINI_336L_PID = 0x0817; // Custom Advantech Gemini 336L
|
||||
const int32_t DABAI_MAX_PID = 0x069a; // dabai max
|
||||
const int32_t GEMINI_338_PID = 0x0818; // Gemini 338
|
||||
const uint16_t GEMINI_435Le_PID = 0x815; // Gemini 435Le
|
||||
|
||||
} // namespace orbbec_camera
|
||||
|
||||
@@ -455,6 +455,8 @@ class OBCameraNode {
|
||||
|
||||
static bool isGemini335PID(uint32_t pid);
|
||||
|
||||
static bool isGemini435LePID(uint32_t pid);
|
||||
|
||||
void setupDepthPostProcessFilter();
|
||||
void setupColorPostProcessFilter();
|
||||
void setupRightIrPostProcessFilter();
|
||||
|
||||
@@ -2245,7 +2245,9 @@ void OBCameraNode::setupPublishers() {
|
||||
camera_info_publishers_[stream_index] = node_->create_publisher<CameraInfo>(
|
||||
topic, rclcpp::QoS(rclcpp::QoSInitialization::from_rmw(camera_info_qos_profile),
|
||||
camera_info_qos_profile));
|
||||
if (isGemini335PID(pid)) {
|
||||
if (isGemini335PID(pid) ||
|
||||
(isGemini435LePID(pid) && stream_index == COLOR &&
|
||||
(format_[stream_index] == OB_FORMAT_MJPG || format_[stream_index] == OB_FORMAT_UNKNOWN))) {
|
||||
metadata_publishers_[stream_index] =
|
||||
node_->create_publisher<orbbec_camera_msgs::msg::Metadata>(
|
||||
name + "/metadata",
|
||||
@@ -3736,6 +3738,8 @@ bool OBCameraNode::isGemini335PID(uint32_t pid) {
|
||||
pid == CUSTOM_ADVANTECH_GEMINI_336L_PID || pid == GEMINI_338_PID;
|
||||
}
|
||||
|
||||
bool OBCameraNode::isGemini435LePID(uint32_t pid) { return pid == GEMINI_435Le_PID; }
|
||||
|
||||
orbbec_camera_msgs::msg::IMUInfo OBCameraNode::createIMUInfo(
|
||||
const stream_index_pair &stream_index) {
|
||||
orbbec_camera_msgs::msg::IMUInfo imu_info;
|
||||
|
||||
Reference in New Issue
Block a user