Add lifted f_v in time freezing

[apozharski]

In CLS, we have the option to lift the velocity state for numerical inversion of M. Add analogous functionality to the cls time freezing reformulations.

I believe this is only easy to do for the multicontact reformulation, but this needs more thought.