1 // This file is part of libigl, a simple c++ geometry processing library.
2 //
3 // Copyright (C) 2013 Alec Jacobson <alecjacobson@gmail.com>
4 //
5 // This Source Code Form is subject to the terms of the Mozilla Public License
6 // v. 2.0. If a copy of the MPL was not distributed with this file, You can
7 // obtain one at http://mozilla.org/MPL/2.0/.
8 #include "cross.h"
9
10 // http://www.antisphere.com/Wiki/tools:anttweakbar
cross(const double * a,const double * b,double * out)11 IGL_INLINE void igl::cross(
12 const double *a,
13 const double *b,
14 double *out)
15 {
16 out[0] = a[1]*b[2]-a[2]*b[1];
17 out[1] = a[2]*b[0]-a[0]*b[2];
18 out[2] = a[0]*b[1]-a[1]*b[0];
19 }
20
21 template <
22 typename DerivedA,
23 typename DerivedB,
24 typename DerivedC>
cross(const Eigen::PlainObjectBase<DerivedA> & A,const Eigen::PlainObjectBase<DerivedB> & B,Eigen::PlainObjectBase<DerivedC> & C)25 IGL_INLINE void igl::cross(
26 const Eigen::PlainObjectBase<DerivedA> & A,
27 const Eigen::PlainObjectBase<DerivedB> & B,
28 Eigen::PlainObjectBase<DerivedC> & C)
29 {
30 assert(A.cols() == 3 && "#cols should be 3");
31 assert(B.cols() == 3 && "#cols should be 3");
32 assert(A.rows() == B.rows() && "#rows in A and B should be equal");
33 C.resize(A.rows(),3);
34 for(int d = 0;d<3;d++)
35 {
36 C.col(d) =
37 A.col((d+1)%3).array() * B.col((d+2)%3).array() -
38 A.col((d+2)%3).array() * B.col((d+1)%3).array();
39 }
40 }
41
42 #ifdef IGL_STATIC_LIBRARY
43 template void igl::cross<Eigen::Matrix<double, -1, -1, 0, -1, -1>, Eigen::Matrix<double, -1, -1, 0, -1, -1>, Eigen::Matrix<double, -1, -1, 0, -1, -1> >(Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> >&);
44 template void igl::cross<Eigen::Matrix<double, 1, 3, 1, 1, 3>, Eigen::Matrix<double, 1, 3, 1, 1, 3>, Eigen::Matrix<double, -1, -1, 0, -1, -1> >(Eigen::PlainObjectBase<Eigen::Matrix<double, 1, 3, 1, 1, 3> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, 1, 3, 1, 1, 3> > const&, Eigen::PlainObjectBase<Eigen::Matrix<double, -1, -1, 0, -1, -1> >&);
45 #endif
46