More vectors

Added some vector calculation functions