Add extract_units_drift_vector

[samuelgarcia]

This will be usefull for benchmark estimate_motion(). This give the summed of all units drift vector.

@yger

[samuelgarcia]

@alejoe91 : I think this is ready