Update sr_ur_read_robot_state.cpp