Now taking speed into account to handle motion (+bugfix)
Merge branch 'ben' of https://github.com/blefaudeux/qUKF into ben