OP-1483 Added velocity filter to correct EKF's velocity estimate for static velocity offsets

(caused for example by sensor disagreement or calibration issues)