|
max@0
|
1 // Copyright (C) 2010-2011 NICTA (www.nicta.com.au)
|
|
max@0
|
2 // Copyright (C) 2010-2011 Conrad Sanderson
|
|
max@0
|
3 //
|
|
max@0
|
4 // This file is part of the Armadillo C++ library.
|
|
max@0
|
5 // It is provided without any warranty of fitness
|
|
max@0
|
6 // for any purpose. You can redistribute this file
|
|
max@0
|
7 // and/or modify it under the terms of the GNU
|
|
max@0
|
8 // Lesser General Public License (LGPL) as published
|
|
max@0
|
9 // by the Free Software Foundation, either version 3
|
|
max@0
|
10 // of the License or (at your option) any later version.
|
|
max@0
|
11 // (see http://www.opensource.org/licenses for more info)
|
|
max@0
|
12
|
|
max@0
|
13
|
|
max@0
|
14
|
|
max@0
|
15 //! \addtogroup glue_cross
|
|
max@0
|
16 //! @{
|
|
max@0
|
17
|
|
max@0
|
18
|
|
max@0
|
19
|
|
max@0
|
20 template<typename T1, typename T2>
|
|
max@0
|
21 inline
|
|
max@0
|
22 void
|
|
max@0
|
23 glue_cross::apply(Mat<typename T1::elem_type>& out, const Glue<T1, T2, glue_cross>& X)
|
|
max@0
|
24 {
|
|
max@0
|
25 arma_extra_debug_sigprint();
|
|
max@0
|
26
|
|
max@0
|
27 typedef typename T1::elem_type eT;
|
|
max@0
|
28 typedef typename Proxy<T1>::ea_type ea_type1;
|
|
max@0
|
29 typedef typename Proxy<T2>::ea_type ea_type2;
|
|
max@0
|
30
|
|
max@0
|
31 const Proxy<T1> A(X.A);
|
|
max@0
|
32 const Proxy<T2> B(X.B);
|
|
max@0
|
33
|
|
max@0
|
34 arma_debug_check( ((A.get_n_elem() != 3) || (B.get_n_elem() != 3)), "cross(): input vectors must have 3 elements" );
|
|
max@0
|
35
|
|
max@0
|
36 out.set_size(A.get_n_rows(), A.get_n_cols());
|
|
max@0
|
37
|
|
max@0
|
38 eT* out_mem = out.memptr();
|
|
max@0
|
39 ea_type1 PA = A.get_ea();
|
|
max@0
|
40 ea_type2 PB = B.get_ea();
|
|
max@0
|
41
|
|
max@0
|
42 const eT ax = PA[0];
|
|
max@0
|
43 const eT ay = PA[1];
|
|
max@0
|
44 const eT az = PA[2];
|
|
max@0
|
45
|
|
max@0
|
46 const eT bx = PB[0];
|
|
max@0
|
47 const eT by = PB[1];
|
|
max@0
|
48 const eT bz = PB[2];
|
|
max@0
|
49
|
|
max@0
|
50 out_mem[0] = ay*bz - az*by;
|
|
max@0
|
51 out_mem[1] = az*bx - ax*bz;
|
|
max@0
|
52 out_mem[2] = ax*by - ay*bx;
|
|
max@0
|
53 }
|
|
max@0
|
54
|
|
max@0
|
55
|
|
max@0
|
56
|
|
max@0
|
57 //! @}
|
