Replace SetAngle with SetPosition for gazebo 4 and up