Drift: get velocity using const reference
Copter: add hybrid state struct, formatting changes