Toffoli function

Apply a Toffoli gate