Made speed test more realistic
Constructor wasn't using const reference for some reason
Added scale functions to vectors