We will eventually need to implement ros2_control. This is a good example. https://control.ros.org/humble/doc/ros2_control_demos/example_2/doc/userdoc.html