Update sr_ur_controller.cpp