fixed bug in flow position estimate causing drift

solved an issue where the integration of velocity will always converge
to 0 due to truncation of values converting between fixed and floating
point values. All maths involving the actual estimation (not control)
has been converted to use floats instead