Need help with generic vector math - C#