I see. I implemented it in a [new pull req](https://github.com/ros-visualization/rqt_robot_plugins/pull/30).