Move GetBodyVelocity into extension method