Added method to transform SD velocities to inertial frame.
Merge branch 'master' of https://github.com/asreimer/canorock_phd_2013