Update sr_motor_robot_lib.hpp