3d vector math with good unit tests