Added some vector math utilities