Add basic 3d vector functions.

Still need to go back and add cross-products and rotation.