Code for FFquad.
Stable_quat not tested yet.
Cruise mode not working yet.