Kalman filter: add acceleration variables for smoother velocity

Hi, I'm tweaking the Kalman filter API I implemented and noticed sometimes useful to take acceleration variables into account so that velocity variables (which can be acquired by `getVelocity()`) become smoother. I added `bool bUseAccel = false` argument into `init(...)` which is backward compatible.