mirror of
https://github.com/orbbec/OrbbecSDK_ROS2.git
synced 2026-10-12 07:19:50 +08:00
chore: Improve error handling and logging in OBCameraNodeDriver
This commit is contained in:
@@ -343,7 +343,14 @@ std::shared_ptr<ob::Device> OBCameraNodeDriver::selectDeviceByUSBPort(
|
|||||||
std::lock_guard<decltype(device_lock_)> lock(device_lock_);
|
std::lock_guard<decltype(device_lock_)> lock(device_lock_);
|
||||||
RCLCPP_INFO_STREAM(logger_, "After lock: Select device usb port: " << usb_port);
|
RCLCPP_INFO_STREAM(logger_, "After lock: Select device usb port: " << usb_port);
|
||||||
auto device = list->getDeviceByUid(usb_port.c_str());
|
auto device = list->getDeviceByUid(usb_port.c_str());
|
||||||
RCLCPP_INFO_STREAM(logger_, "Device usb port " << usb_port << " done");
|
if (device) {
|
||||||
|
RCLCPP_INFO_STREAM(logger_, "getDeviceByUid device usb port " << usb_port << " done");
|
||||||
|
} else {
|
||||||
|
RCLCPP_ERROR_STREAM(logger_, "getDeviceByUid device usb port " << usb_port << " failed");
|
||||||
|
RCLCPP_ERROR_STREAM(logger_,
|
||||||
|
"Please use script to get usb port: "
|
||||||
|
"ros2 run orbbec_camera list_devices_node");
|
||||||
|
}
|
||||||
return device;
|
return device;
|
||||||
} catch (ob::Error &e) {
|
} catch (ob::Error &e) {
|
||||||
RCLCPP_ERROR_STREAM(logger_, "Failed to get device info " << e.getMessage());
|
RCLCPP_ERROR_STREAM(logger_, "Failed to get device info " << e.getMessage());
|
||||||
|
|||||||
Reference in New Issue
Block a user