Update sr_muscle_robot_lib.hpp