Added vectorize functions
Added vectorized 3D tests
Optimized cross product, removed one shuffle