ROS2 Diagnostics

ToDo