diff --git a/wibotic_connector_can/src/wibotic_can_driver_node.cpp b/wibotic_connector_can/src/wibotic_can_driver_node.cpp index 67236e1..cefb2f8 100644 --- 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_info", 10);