Updated vector math

Updated vector math