Update srh_joint_position_controller.hpp