Did you consider to use [`gz_ros2_control`](https://github.com/ros-controls/gz_ros2_control) instead of custom plugins ? I will be happy to review the PRs or maybe go ahead make the changes.