Added cross product functions

Still needs to be tested