Added logger when no can device

Signed-off-by: Jakub Delicat <[email protected]>
husarion · Nov 5, 2024 · 290c4de · 290c4de
1 parent fc5d44f
commit 290c4de
Showing 1 changed file with 7 additions and 1 deletion.
diff --git a/wibotic_connector_can/src/wibotic_can_driver_node.cpp b/wibotic_connector_can/src/wibotic_can_driver_node.cpp
@@ -30,7 +30,13 @@ WiboticCanDriverNode::WiboticCanDriverNode(
   DeclareParameters();
   GetParameters();
 
-  CreateWiboticCanDriver();
+  try {
+    CreateWiboticCanDriver();
+  } catch (const uavcan_linux::Exception & e) {
+    RCLCPP_FATAL_STREAM(
+      this->get_logger(), "An occurred error during creating WiboticCanDriver: " << e.what());
+    throw;
+  }
 
   wibotic_info_pub_ = this->create_publisher<wibotic_msgs::msg::WiboticInfo>("wibotic_info", 10);