Lifted contact dynamics for efficient optimal control of rigid body systems with contacts