EKF2: ev-vel refactoring

[haumarco]

Cleaning up EV-vel implementation.

I tried to keep controlEvVelFusion readable while defining the "sub-function" in individual classes based on the given velocity frame.

Alternative solution would be to have similar controlEvVelFusion functions for each frame...