moved vector math helpers to Utils.cpp/h