Send (debug) messages to QGC

ROS 1 / ROS 2
2

I did it now this way.

If anybody has a different solution, let me know.