The read and write function should properly match the functions defined in the parent RobotHW class. See https://github.com/ros-controls/ros_control/blob/melodic-devel/hardware_interface/include/hardware_interface/robot_hw.h