fix[velocities]: Addresses #21 by changing the vicon callback.

[maxspahn]

In case the vicon system is used, we want the velocities to be in the vicons map frame, just like the positions. That solves this issue, see #21.